mirror of
https://github.com/rd-stuffs/msm-4.14.git
synced 2025-02-20 11:45:48 +08:00
remoteproc updates for v4.6
New driver for controlling ST's remote processors and a couple of minor fixes. Also includes the addition of myself as co-maintainer. -----BEGIN PGP SIGNATURE----- Version: GnuPG v1 iQIcBAABAgAGBQJW559TAAoJEAsfOT8Nma3FsXwP/Am3lkIaJ+FLd3tbKBxfodkx ww4cgbo4bz0IPQKFTJVo0pvtQ+GzRkJnOWJTbX3qhFXv6SaHhTiX4cVdUXS2QARz 5irb3p5PJCRhx9ZH+4jZ4vJbweCk8rQEaubgYMajVMamgLGbO3o39pzN/82l3hBG Fd4vtttkw6f3a/y2Oq3ShAN3auSRbOvzOxPpr0+VmOYfSwaoyvP2fU4lT3YtVPNA hVurFrt8HSALDCL1Igj9lDsHjzVORqTsZPnyvNU1OrdoIi1DaVRKmnApgxEBKHgS AObCDwXDR9kybQ0BQ3GpRMYv5KZw4KdfA3a1R7z8ab1Iny86ncMAt4L7ksrKvXrm pCYZbpPRdKZMTnXdLTXlm76HRxwW0Q6ExyKJC6V1tixsL/KsnXMnjaxfUDeBwMAG B7ydy0YX4rm95veDDFZFBaOP0oFg3mm9v/snYoNOOAp7spoiGKXolQENS/zlyhBR R6vTw35Goqpcb5jHBlo7QdMpaRhqUAIHUoX/z1OJpg9eeFfFErWCfrSZJSZDQ9rL TA2m7q6pb+S5hmCKvXox2DIdRgTGYMiloG3W2FNmc0SwW4pT4pN8pdqFJaa9C3qX /p5uR7Geak0KBLTYWd6IHd4fILX0ktpuRKF+lbzNaG+40ato/C8U7l78kcIQemY2 Nlz65X3c8ZTuNy08UprT =2rNj -----END PGP SIGNATURE----- Merge tag 'rproc-v4.6' of git://github.com/andersson/remoteproc Pull remoteproc updates from Bjorn Andersson: "New driver for controlling ST's remote processors and a couple of minor fixes. Also includes the addition of myself as co-maintainer" Acked-by: Ohad Ben-Cohen <ohad@wizery.com> * tag 'rproc-v4.6' of git://github.com/andersson/remoteproc: MAINTAINERS: Add co-maintainer for remoteproc subsystems remoteproc: Supply controller driver for ST's Remote Processors remoteproc: debugfs: Add ability to boot remote processor using debugfs remoteproc: dt: Provide bindings for ST's Remote Processor Controller driver remoteproc: debugfs: Return error on invalid 'count' value remoteproc/wkup_m3: Use MODULE_DEVICE_TABLE to export alias remoteproc: report error if resource table doesn't exist
This commit is contained in:
commit
c7eec380e8
41
Documentation/devicetree/bindings/remoteproc/st-rproc.txt
Normal file
41
Documentation/devicetree/bindings/remoteproc/st-rproc.txt
Normal file
@ -0,0 +1,41 @@
|
|||||||
|
STMicroelectronics Co-Processor Bindings
|
||||||
|
----------------------------------------
|
||||||
|
|
||||||
|
This binding provides support for adjunct processors found on ST SoCs.
|
||||||
|
|
||||||
|
Co-processors can be controlled from the bootloader or the primary OS. If
|
||||||
|
the bootloader starts a co-processor, the primary OS must detect its state
|
||||||
|
and act accordingly.
|
||||||
|
|
||||||
|
Required properties:
|
||||||
|
- compatible Should be one of:
|
||||||
|
"st,st231-rproc"
|
||||||
|
"st,st40-rproc"
|
||||||
|
- memory-region Reserved memory (See: ../reserved-memory/reserved-memory.txt)
|
||||||
|
- resets Reset lines (See: ../reset/reset.txt)
|
||||||
|
- reset-names Must be "sw_reset" and "pwr_reset"
|
||||||
|
- clocks Clock for co-processor (See: ../clock/clock-bindings.txt)
|
||||||
|
- clock-frequency Clock frequency to set co-processor at if the bootloader
|
||||||
|
hasn't already done so
|
||||||
|
- st,syscfg System configuration register which holds the boot vector
|
||||||
|
for the co-processor
|
||||||
|
1st cell: Phandle to syscon block
|
||||||
|
2nd cell: Boot vector register offset
|
||||||
|
|
||||||
|
Example:
|
||||||
|
|
||||||
|
audio_reserved: rproc@42000000 {
|
||||||
|
compatible = "shared-dma-pool";
|
||||||
|
reg = <0x42000000 0x01000000>;
|
||||||
|
no-map;
|
||||||
|
};
|
||||||
|
|
||||||
|
st231-audio {
|
||||||
|
compatible = "st,st231-rproc";
|
||||||
|
memory-region = <&audio_reserved>;
|
||||||
|
resets = <&softreset STIH407_ST231_AUD_SOFTRESET>;
|
||||||
|
reset-names = "sw_reset";
|
||||||
|
clocks = <&clk_s_c0_flexgen CLK_ST231_AUD_0>;
|
||||||
|
clock-frequency = <600000000>;
|
||||||
|
st,syscfg = <&syscfg_core 0x228>;
|
||||||
|
};
|
@ -4979,6 +4979,7 @@ F: include/linux/hw_random.h
|
|||||||
|
|
||||||
HARDWARE SPINLOCK CORE
|
HARDWARE SPINLOCK CORE
|
||||||
M: Ohad Ben-Cohen <ohad@wizery.com>
|
M: Ohad Ben-Cohen <ohad@wizery.com>
|
||||||
|
M: Bjorn Andersson <bjorn.andersson@linaro.org>
|
||||||
S: Maintained
|
S: Maintained
|
||||||
T: git git://git.kernel.org/pub/scm/linux/kernel/git/ohad/hwspinlock.git
|
T: git git://git.kernel.org/pub/scm/linux/kernel/git/ohad/hwspinlock.git
|
||||||
F: Documentation/hwspinlock.txt
|
F: Documentation/hwspinlock.txt
|
||||||
@ -9169,6 +9170,7 @@ F: include/linux/regmap.h
|
|||||||
|
|
||||||
REMOTE PROCESSOR (REMOTEPROC) SUBSYSTEM
|
REMOTE PROCESSOR (REMOTEPROC) SUBSYSTEM
|
||||||
M: Ohad Ben-Cohen <ohad@wizery.com>
|
M: Ohad Ben-Cohen <ohad@wizery.com>
|
||||||
|
M: Bjorn Andersson <bjorn.andersson@linaro.org>
|
||||||
T: git git://git.kernel.org/pub/scm/linux/kernel/git/ohad/remoteproc.git
|
T: git git://git.kernel.org/pub/scm/linux/kernel/git/ohad/remoteproc.git
|
||||||
S: Maintained
|
S: Maintained
|
||||||
F: drivers/remoteproc/
|
F: drivers/remoteproc/
|
||||||
@ -9177,6 +9179,7 @@ F: include/linux/remoteproc.h
|
|||||||
|
|
||||||
REMOTE PROCESSOR MESSAGING (RPMSG) SUBSYSTEM
|
REMOTE PROCESSOR MESSAGING (RPMSG) SUBSYSTEM
|
||||||
M: Ohad Ben-Cohen <ohad@wizery.com>
|
M: Ohad Ben-Cohen <ohad@wizery.com>
|
||||||
|
M: Bjorn Andersson <bjorn.andersson@linaro.org>
|
||||||
T: git git://git.kernel.org/pub/scm/linux/kernel/git/ohad/rpmsg.git
|
T: git git://git.kernel.org/pub/scm/linux/kernel/git/ohad/rpmsg.git
|
||||||
S: Maintained
|
S: Maintained
|
||||||
F: drivers/rpmsg/
|
F: drivers/rpmsg/
|
||||||
|
@ -77,4 +77,13 @@ config DA8XX_REMOTEPROC
|
|||||||
It's safe to say n here if you're not interested in multimedia
|
It's safe to say n here if you're not interested in multimedia
|
||||||
offloading.
|
offloading.
|
||||||
|
|
||||||
|
config ST_REMOTEPROC
|
||||||
|
tristate "ST remoteproc support"
|
||||||
|
depends on ARCH_STI
|
||||||
|
select REMOTEPROC
|
||||||
|
help
|
||||||
|
Say y here to support ST's adjunct processors via the remote
|
||||||
|
processor framework.
|
||||||
|
This can be either built-in or a loadable module.
|
||||||
|
|
||||||
endmenu
|
endmenu
|
||||||
|
@ -11,3 +11,4 @@ obj-$(CONFIG_OMAP_REMOTEPROC) += omap_remoteproc.o
|
|||||||
obj-$(CONFIG_STE_MODEM_RPROC) += ste_modem_rproc.o
|
obj-$(CONFIG_STE_MODEM_RPROC) += ste_modem_rproc.o
|
||||||
obj-$(CONFIG_WKUP_M3_RPROC) += wkup_m3_rproc.o
|
obj-$(CONFIG_WKUP_M3_RPROC) += wkup_m3_rproc.o
|
||||||
obj-$(CONFIG_DA8XX_REMOTEPROC) += da8xx_remoteproc.o
|
obj-$(CONFIG_DA8XX_REMOTEPROC) += da8xx_remoteproc.o
|
||||||
|
obj-$(CONFIG_ST_REMOTEPROC) += st_remoteproc.o
|
||||||
|
@ -823,8 +823,10 @@ static int rproc_fw_boot(struct rproc *rproc, const struct firmware *fw)
|
|||||||
|
|
||||||
/* look for the resource table */
|
/* look for the resource table */
|
||||||
table = rproc_find_rsc_table(rproc, fw, &tablesz);
|
table = rproc_find_rsc_table(rproc, fw, &tablesz);
|
||||||
if (!table)
|
if (!table) {
|
||||||
|
dev_err(dev, "Failed to find resource table\n");
|
||||||
goto clean_up;
|
goto clean_up;
|
||||||
|
}
|
||||||
|
|
||||||
/* Verify that resource table in loaded fw is unchanged */
|
/* Verify that resource table in loaded fw is unchanged */
|
||||||
if (rproc->table_csum != crc32(0, table, tablesz)) {
|
if (rproc->table_csum != crc32(0, table, tablesz)) {
|
||||||
|
@ -88,8 +88,42 @@ static ssize_t rproc_state_read(struct file *filp, char __user *userbuf,
|
|||||||
return simple_read_from_buffer(userbuf, count, ppos, buf, i);
|
return simple_read_from_buffer(userbuf, count, ppos, buf, i);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static ssize_t rproc_state_write(struct file *filp, const char __user *userbuf,
|
||||||
|
size_t count, loff_t *ppos)
|
||||||
|
{
|
||||||
|
struct rproc *rproc = filp->private_data;
|
||||||
|
char buf[10];
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (count > sizeof(buf) || count <= 0)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
ret = copy_from_user(buf, userbuf, count);
|
||||||
|
if (ret)
|
||||||
|
return -EFAULT;
|
||||||
|
|
||||||
|
if (buf[count - 1] == '\n')
|
||||||
|
buf[count - 1] = '\0';
|
||||||
|
|
||||||
|
if (!strncmp(buf, "start", count)) {
|
||||||
|
ret = rproc_boot(rproc);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(&rproc->dev, "Boot failed: %d\n", ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
} else if (!strncmp(buf, "stop", count)) {
|
||||||
|
rproc_shutdown(rproc);
|
||||||
|
} else {
|
||||||
|
dev_err(&rproc->dev, "Unrecognised option: %s\n", buf);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return count;
|
||||||
|
}
|
||||||
|
|
||||||
static const struct file_operations rproc_state_ops = {
|
static const struct file_operations rproc_state_ops = {
|
||||||
.read = rproc_state_read,
|
.read = rproc_state_read,
|
||||||
|
.write = rproc_state_write,
|
||||||
.open = simple_open,
|
.open = simple_open,
|
||||||
.llseek = generic_file_llseek,
|
.llseek = generic_file_llseek,
|
||||||
};
|
};
|
||||||
@ -157,7 +191,7 @@ rproc_recovery_write(struct file *filp, const char __user *user_buf,
|
|||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
if (count < 1 || count > sizeof(buf))
|
if (count < 1 || count > sizeof(buf))
|
||||||
return count;
|
return -EINVAL;
|
||||||
|
|
||||||
ret = copy_from_user(buf, user_buf, count);
|
ret = copy_from_user(buf, user_buf, count);
|
||||||
if (ret)
|
if (ret)
|
||||||
|
297
drivers/remoteproc/st_remoteproc.c
Normal file
297
drivers/remoteproc/st_remoteproc.c
Normal file
@ -0,0 +1,297 @@
|
|||||||
|
/*
|
||||||
|
* ST's Remote Processor Control Driver
|
||||||
|
*
|
||||||
|
* Copyright (C) 2015 STMicroelectronics - All Rights Reserved
|
||||||
|
*
|
||||||
|
* Author: Ludovic Barre <ludovic.barre@st.com>
|
||||||
|
*
|
||||||
|
* This program is free software; you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License version 2 as
|
||||||
|
* published by the Free Software Foundation.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <linux/clk.h>
|
||||||
|
#include <linux/dma-mapping.h>
|
||||||
|
#include <linux/err.h>
|
||||||
|
#include <linux/interrupt.h>
|
||||||
|
#include <linux/kernel.h>
|
||||||
|
#include <linux/mfd/syscon.h>
|
||||||
|
#include <linux/module.h>
|
||||||
|
#include <linux/of.h>
|
||||||
|
#include <linux/of_device.h>
|
||||||
|
#include <linux/of_reserved_mem.h>
|
||||||
|
#include <linux/platform_device.h>
|
||||||
|
#include <linux/regmap.h>
|
||||||
|
#include <linux/remoteproc.h>
|
||||||
|
#include <linux/reset.h>
|
||||||
|
|
||||||
|
struct st_rproc_config {
|
||||||
|
bool sw_reset;
|
||||||
|
bool pwr_reset;
|
||||||
|
unsigned long bootaddr_mask;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct st_rproc {
|
||||||
|
struct st_rproc_config *config;
|
||||||
|
struct reset_control *sw_reset;
|
||||||
|
struct reset_control *pwr_reset;
|
||||||
|
struct clk *clk;
|
||||||
|
u32 clk_rate;
|
||||||
|
struct regmap *boot_base;
|
||||||
|
u32 boot_offset;
|
||||||
|
};
|
||||||
|
|
||||||
|
static int st_rproc_start(struct rproc *rproc)
|
||||||
|
{
|
||||||
|
struct st_rproc *ddata = rproc->priv;
|
||||||
|
int err;
|
||||||
|
|
||||||
|
regmap_update_bits(ddata->boot_base, ddata->boot_offset,
|
||||||
|
ddata->config->bootaddr_mask, rproc->bootaddr);
|
||||||
|
|
||||||
|
err = clk_enable(ddata->clk);
|
||||||
|
if (err) {
|
||||||
|
dev_err(&rproc->dev, "Failed to enable clock\n");
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ddata->config->sw_reset) {
|
||||||
|
err = reset_control_deassert(ddata->sw_reset);
|
||||||
|
if (err) {
|
||||||
|
dev_err(&rproc->dev, "Failed to deassert S/W Reset\n");
|
||||||
|
goto sw_reset_fail;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ddata->config->pwr_reset) {
|
||||||
|
err = reset_control_deassert(ddata->pwr_reset);
|
||||||
|
if (err) {
|
||||||
|
dev_err(&rproc->dev, "Failed to deassert Power Reset\n");
|
||||||
|
goto pwr_reset_fail;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
dev_info(&rproc->dev, "Started from 0x%x\n", rproc->bootaddr);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
|
||||||
|
pwr_reset_fail:
|
||||||
|
if (ddata->config->pwr_reset)
|
||||||
|
reset_control_assert(ddata->sw_reset);
|
||||||
|
sw_reset_fail:
|
||||||
|
clk_disable(ddata->clk);
|
||||||
|
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int st_rproc_stop(struct rproc *rproc)
|
||||||
|
{
|
||||||
|
struct st_rproc *ddata = rproc->priv;
|
||||||
|
int sw_err = 0, pwr_err = 0;
|
||||||
|
|
||||||
|
if (ddata->config->sw_reset) {
|
||||||
|
sw_err = reset_control_assert(ddata->sw_reset);
|
||||||
|
if (sw_err)
|
||||||
|
dev_err(&rproc->dev, "Failed to assert S/W Reset\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ddata->config->pwr_reset) {
|
||||||
|
pwr_err = reset_control_assert(ddata->pwr_reset);
|
||||||
|
if (pwr_err)
|
||||||
|
dev_err(&rproc->dev, "Failed to assert Power Reset\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
clk_disable(ddata->clk);
|
||||||
|
|
||||||
|
return sw_err ?: pwr_err;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct rproc_ops st_rproc_ops = {
|
||||||
|
.start = st_rproc_start,
|
||||||
|
.stop = st_rproc_stop,
|
||||||
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Fetch state of the processor: 0 is off, 1 is on.
|
||||||
|
*/
|
||||||
|
static int st_rproc_state(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
struct rproc *rproc = platform_get_drvdata(pdev);
|
||||||
|
struct st_rproc *ddata = rproc->priv;
|
||||||
|
int reset_sw = 0, reset_pwr = 0;
|
||||||
|
|
||||||
|
if (ddata->config->sw_reset)
|
||||||
|
reset_sw = reset_control_status(ddata->sw_reset);
|
||||||
|
|
||||||
|
if (ddata->config->pwr_reset)
|
||||||
|
reset_pwr = reset_control_status(ddata->pwr_reset);
|
||||||
|
|
||||||
|
if (reset_sw < 0 || reset_pwr < 0)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
return !reset_sw && !reset_pwr;
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct st_rproc_config st40_rproc_cfg = {
|
||||||
|
.sw_reset = true,
|
||||||
|
.pwr_reset = true,
|
||||||
|
.bootaddr_mask = GENMASK(28, 1),
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct st_rproc_config st231_rproc_cfg = {
|
||||||
|
.sw_reset = true,
|
||||||
|
.pwr_reset = false,
|
||||||
|
.bootaddr_mask = GENMASK(31, 6),
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct of_device_id st_rproc_match[] = {
|
||||||
|
{ .compatible = "st,st40-rproc", .data = &st40_rproc_cfg },
|
||||||
|
{ .compatible = "st,st231-rproc", .data = &st231_rproc_cfg },
|
||||||
|
{},
|
||||||
|
};
|
||||||
|
MODULE_DEVICE_TABLE(of, st_rproc_match);
|
||||||
|
|
||||||
|
static int st_rproc_parse_dt(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
struct device *dev = &pdev->dev;
|
||||||
|
struct rproc *rproc = platform_get_drvdata(pdev);
|
||||||
|
struct st_rproc *ddata = rproc->priv;
|
||||||
|
struct device_node *np = dev->of_node;
|
||||||
|
int err;
|
||||||
|
|
||||||
|
if (ddata->config->sw_reset) {
|
||||||
|
ddata->sw_reset = devm_reset_control_get(dev, "sw_reset");
|
||||||
|
if (IS_ERR(ddata->sw_reset)) {
|
||||||
|
dev_err(dev, "Failed to get S/W Reset\n");
|
||||||
|
return PTR_ERR(ddata->sw_reset);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ddata->config->pwr_reset) {
|
||||||
|
ddata->pwr_reset = devm_reset_control_get(dev, "pwr_reset");
|
||||||
|
if (IS_ERR(ddata->pwr_reset)) {
|
||||||
|
dev_err(dev, "Failed to get Power Reset\n");
|
||||||
|
return PTR_ERR(ddata->pwr_reset);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
ddata->clk = devm_clk_get(dev, NULL);
|
||||||
|
if (IS_ERR(ddata->clk)) {
|
||||||
|
dev_err(dev, "Failed to get clock\n");
|
||||||
|
return PTR_ERR(ddata->clk);
|
||||||
|
}
|
||||||
|
|
||||||
|
err = of_property_read_u32(np, "clock-frequency", &ddata->clk_rate);
|
||||||
|
if (err) {
|
||||||
|
dev_err(dev, "failed to get clock frequency\n");
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
ddata->boot_base = syscon_regmap_lookup_by_phandle(np, "st,syscfg");
|
||||||
|
if (!ddata->boot_base) {
|
||||||
|
dev_err(dev, "Boot base not found\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
err = of_property_read_u32_index(np, "st,syscfg", 1,
|
||||||
|
&ddata->boot_offset);
|
||||||
|
if (err) {
|
||||||
|
dev_err(dev, "Boot offset not found\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
err = of_reserved_mem_device_init(dev);
|
||||||
|
if (err) {
|
||||||
|
dev_err(dev, "Failed to obtain shared memory\n");
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
err = clk_prepare(ddata->clk);
|
||||||
|
if (err)
|
||||||
|
dev_err(dev, "failed to get clock\n");
|
||||||
|
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int st_rproc_probe(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
struct device *dev = &pdev->dev;
|
||||||
|
const struct of_device_id *match;
|
||||||
|
struct st_rproc *ddata;
|
||||||
|
struct device_node *np = dev->of_node;
|
||||||
|
struct rproc *rproc;
|
||||||
|
int enabled;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
match = of_match_device(st_rproc_match, dev);
|
||||||
|
if (!match || !match->data) {
|
||||||
|
dev_err(dev, "No device match found\n");
|
||||||
|
return -ENODEV;
|
||||||
|
}
|
||||||
|
|
||||||
|
rproc = rproc_alloc(dev, np->name, &st_rproc_ops, NULL, sizeof(*ddata));
|
||||||
|
if (!rproc)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
rproc->has_iommu = false;
|
||||||
|
ddata = rproc->priv;
|
||||||
|
ddata->config = (struct st_rproc_config *)match->data;
|
||||||
|
|
||||||
|
platform_set_drvdata(pdev, rproc);
|
||||||
|
|
||||||
|
ret = st_rproc_parse_dt(pdev);
|
||||||
|
if (ret)
|
||||||
|
goto free_rproc;
|
||||||
|
|
||||||
|
enabled = st_rproc_state(pdev);
|
||||||
|
if (enabled < 0)
|
||||||
|
goto free_rproc;
|
||||||
|
|
||||||
|
if (enabled) {
|
||||||
|
atomic_inc(&rproc->power);
|
||||||
|
rproc->state = RPROC_RUNNING;
|
||||||
|
} else {
|
||||||
|
clk_set_rate(ddata->clk, ddata->clk_rate);
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = rproc_add(rproc);
|
||||||
|
if (ret)
|
||||||
|
goto free_rproc;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
free_rproc:
|
||||||
|
rproc_put(rproc);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int st_rproc_remove(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
struct rproc *rproc = platform_get_drvdata(pdev);
|
||||||
|
struct st_rproc *ddata = rproc->priv;
|
||||||
|
|
||||||
|
rproc_del(rproc);
|
||||||
|
|
||||||
|
clk_disable_unprepare(ddata->clk);
|
||||||
|
|
||||||
|
of_reserved_mem_device_release(&pdev->dev);
|
||||||
|
|
||||||
|
rproc_put(rproc);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct platform_driver st_rproc_driver = {
|
||||||
|
.probe = st_rproc_probe,
|
||||||
|
.remove = st_rproc_remove,
|
||||||
|
.driver = {
|
||||||
|
.name = "st-rproc",
|
||||||
|
.of_match_table = of_match_ptr(st_rproc_match),
|
||||||
|
},
|
||||||
|
};
|
||||||
|
module_platform_driver(st_rproc_driver);
|
||||||
|
|
||||||
|
MODULE_DESCRIPTION("ST Remote Processor Control Driver");
|
||||||
|
MODULE_AUTHOR("Ludovic Barre <ludovic.barre@st.com>");
|
||||||
|
MODULE_LICENSE("GPL v2");
|
@ -122,6 +122,7 @@ static const struct of_device_id wkup_m3_rproc_of_match[] = {
|
|||||||
{ .compatible = "ti,am4372-wkup-m3", },
|
{ .compatible = "ti,am4372-wkup-m3", },
|
||||||
{},
|
{},
|
||||||
};
|
};
|
||||||
|
MODULE_DEVICE_TABLE(of, wkup_m3_rproc_of_match);
|
||||||
|
|
||||||
static int wkup_m3_rproc_probe(struct platform_device *pdev)
|
static int wkup_m3_rproc_probe(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
|
Loading…
x
Reference in New Issue
Block a user