Blame view
drivers/remoteproc/ti_power_proc.c
4.32 KB
d41ce506b Initial Release, ... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 |
/* * (C) Copyright 2015-2016 * Texas Instruments Incorporated - http://www.ti.com/ * SPDX-License-Identifier: GPL-2.0+ */ #define pr_fmt(fmt) "%s: " fmt, __func__ #include <common.h> #include <dm.h> #include <errno.h> #include <fdtdec.h> #include <remoteproc.h> #include <mach/psc_defs.h> DECLARE_GLOBAL_DATA_PTR; /** * struct ti_powerproc_privdata - power processor private data * @loadaddr: base address for loading the power processor * @psc_module: psc module address. */ struct ti_powerproc_privdata { phys_addr_t loadaddr; u32 psc_module; }; /** * ti_of_to_priv() - generate private data from device tree * @dev: corresponding ti remote processor device * @priv: pointer to driver specific private data * * Return: 0 if all went ok, else corresponding -ve error */ static int ti_of_to_priv(struct udevice *dev, struct ti_powerproc_privdata *priv) { int node = dev_of_offset(dev); const void *blob = gd->fdt_blob; int tmp; if (!blob) { debug("'%s' no dt? ", dev->name); return -EINVAL; } priv->loadaddr = fdtdec_get_addr(blob, node, "reg"); if (priv->loadaddr == FDT_ADDR_T_NONE) { debug("'%s': no 'reg' property ", dev->name); return -EINVAL; } tmp = fdtdec_get_int(blob, node, "ti,lpsc_module", -EINVAL); if (tmp < 0) { debug("'%s': no 'ti,lpsc_module' property ", dev->name); return tmp; } priv->psc_module = tmp; return 0; } /** * ti_powerproc_probe() - Basic probe * @dev: corresponding ti remote processor device * * Return: 0 if all went ok, else corresponding -ve error */ static int ti_powerproc_probe(struct udevice *dev) { struct dm_rproc_uclass_pdata *uc_pdata; struct ti_powerproc_privdata *priv; int ret; uc_pdata = dev_get_uclass_platdata(dev); priv = dev_get_priv(dev); ret = ti_of_to_priv(dev, priv); debug("%s probed with slave_addr=0x%08lX module=%d(%d) ", uc_pdata->name, priv->loadaddr, priv->psc_module, ret); return ret; } /** * ti_powerproc_load() - Loadup the TI remote processor * @dev: corresponding ti remote processor device * @addr: Address in memory where image binary is stored * @size: Size in bytes of the image binary * * Return: 0 if all went ok, else corresponding -ve error */ static int ti_powerproc_load(struct udevice *dev, ulong addr, ulong size) { struct dm_rproc_uclass_pdata *uc_pdata; struct ti_powerproc_privdata *priv; int ret; uc_pdata = dev_get_uclass_platdata(dev); if (!uc_pdata) { debug("%s: no uc pdata! ", dev->name); return -EINVAL; } priv = dev_get_priv(dev); ret = psc_module_keep_in_reset_enabled(priv->psc_module, false); if (ret) { debug("%s Unable to disable module '%d'(ret=%d) ", uc_pdata->name, priv->psc_module, ret); return ret; } debug("%s: Loading binary from 0x%08lX, size 0x%08lX to 0x%08lX ", uc_pdata->name, addr, size, priv->loadaddr); memcpy((void *)priv->loadaddr, (void *)addr, size); debug("%s: Complete! ", uc_pdata->name); return 0; } /** * ti_powerproc_start() - (replace: short desc) * @dev: corresponding ti remote processor device * * Return: 0 if all went ok, else corresponding -ve error */ static int ti_powerproc_start(struct udevice *dev) { struct dm_rproc_uclass_pdata *uc_pdata; struct ti_powerproc_privdata *priv; int ret; uc_pdata = dev_get_uclass_platdata(dev); if (!uc_pdata) { debug("%s: no uc pdata! ", dev->name); return -EINVAL; } priv = dev_get_priv(dev); ret = psc_disable_module(priv->psc_module); if (ret) { debug("%s Unable to disable module '%d'(ret=%d) ", uc_pdata->name, priv->psc_module, ret); return ret; } ret = psc_module_release_from_reset(priv->psc_module); if (ret) { debug("%s Failed to wait for module '%d'(ret=%d) ", uc_pdata->name, priv->psc_module, ret); return ret; } ret = psc_enable_module(priv->psc_module); if (ret) { debug("%s Unable to disable module '%d'(ret=%d) ", uc_pdata->name, priv->psc_module, ret); return ret; } return 0; } static const struct dm_rproc_ops ti_powerproc_ops = { .load = ti_powerproc_load, .start = ti_powerproc_start, }; static const struct udevice_id ti_powerproc_ids[] = { {.compatible = "ti,power-processor"}, {} }; U_BOOT_DRIVER(ti_powerproc) = { .name = "ti_power_proc", .of_match = ti_powerproc_ids, .id = UCLASS_REMOTEPROC, .ops = &ti_powerproc_ops, .probe = ti_powerproc_probe, .priv_auto_alloc_size = sizeof(struct ti_powerproc_privdata), }; |