linux-imx

/*

 * SLIM core rproc driver

 *

 * Copyright (C) 2016 STMicroelectronics

 *

 * Author: Peter Griffin <peter.griffin@linaro.org>

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation; either version 2 of the License, or

 * (at your option) any later version.

 */

​

#include <linux/clk.h>

#include <linux/err.h>

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/of.h>

#include <linux/of_device.h>

#include <linux/platform_device.h>

#include <linux/remoteproc.h>

#include <linux/remoteproc/st_slim_rproc.h>

#include "remoteproc_internal.h"

​

/* SLIM core registers */

#define SLIM_ID_OFST        0x0

#define SLIM_VER_OFST       0x4

​

#define SLIM_EN_OFST        0x8

#define SLIM_EN_RUN         BIT(0)

​

#define SLIM_CLK_GATE_OFST  0xC

#define SLIM_CLK_GATE_DIS       BIT(0)

#define SLIM_CLK_GATE_RESET     BIT(2)

​

#define SLIM_SLIM_PC_OFST   0x20

​

/* DMEM registers */

#define SLIM_REV_ID_OFST    0x0

#define SLIM_REV_ID_MIN_MASK        GENMASK(15, 8)

#define SLIM_REV_ID_MIN(id)     ((id & SLIM_REV_ID_MIN_MASK) >> 8)

#define SLIM_REV_ID_MAJ_MASK        GENMASK(23, 16)

#define SLIM_REV_ID_MAJ(id)     ((id & SLIM_REV_ID_MAJ_MASK) >> 16)

​

​

/* peripherals registers */

#define SLIM_STBUS_SYNC_OFST    0xF88

#define SLIM_STBUS_SYNC_DIS     BIT(0)

​

#define SLIM_INT_SET_OFST   0xFD4

#define SLIM_INT_CLR_OFST   0xFD8

#define SLIM_INT_MASK_OFST  0xFDC

​

#define SLIM_CMD_CLR_OFST   0xFC8

#define SLIM_CMD_MASK_OFST  0xFCC

​

static const char *mem_names[ST_SLIM_MEM_MAX] = {

    [ST_SLIM_DMEM]  = "dmem",

    [ST_SLIM_IMEM]  = "imem",

};

​

static int slim_clk_get(struct st_slim_rproc *slim_rproc, struct device *dev)

{

    int clk, err;

​

    for (clk = 0; clk < ST_SLIM_MAX_CLK; clk++) {

        slim_rproc->clks[clk] = of_clk_get(dev->of_node, clk);

        if (IS_ERR(slim_rproc->clks[clk])) {

            err = PTR_ERR(slim_rproc->clks[clk]);

            if (err == -EPROBE_DEFER)

                goto err_put_clks;

            slim_rproc->clks[clk] = NULL;

            break;

        }

    }

​

    return 0;

​

err_put_clks:

    while (--clk >= 0)

        clk_put(slim_rproc->clks[clk]);

​

    return err;

}

​

static void slim_clk_disable(struct st_slim_rproc *slim_rproc)

{

    int clk;

​

    for (clk = 0; clk < ST_SLIM_MAX_CLK && slim_rproc->clks[clk]; clk++)

        clk_disable_unprepare(slim_rproc->clks[clk]);

}