1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Ingenic JZ47xx remoteproc driver 4 * Copyright 2019, Paul Cercueil <paul@crapouillou.net> 5 */ 6 7 #include <linux/bitops.h> 8 #include <linux/clk.h> 9 #include <linux/err.h> 10 #include <linux/interrupt.h> 11 #include <linux/io.h> 12 #include <linux/module.h> 13 #include <linux/platform_device.h> 14 #include <linux/remoteproc.h> 15 16 #include "remoteproc_internal.h" 17 18 #define REG_AUX_CTRL 0x0 19 #define REG_AUX_MSG_ACK 0x10 20 #define REG_AUX_MSG 0x14 21 #define REG_CORE_MSG_ACK 0x18 22 #define REG_CORE_MSG 0x1C 23 24 #define AUX_CTRL_SLEEP BIT(31) 25 #define AUX_CTRL_MSG_IRQ_EN BIT(3) 26 #define AUX_CTRL_NMI_RESETS BIT(2) 27 #define AUX_CTRL_NMI BIT(1) 28 #define AUX_CTRL_SW_RESET BIT(0) 29 30 static bool auto_boot; 31 module_param(auto_boot, bool, 0400); 32 MODULE_PARM_DESC(auto_boot, 33 "Auto-boot the remote processor [default=false]"); 34 35 struct vpu_mem_map { 36 const char *name; 37 unsigned int da; 38 }; 39 40 struct vpu_mem_info { 41 const struct vpu_mem_map *map; 42 unsigned long len; 43 void __iomem *base; 44 }; 45 46 static const struct vpu_mem_map vpu_mem_map[] = { 47 { "tcsm0", 0x132b0000 }, 48 { "tcsm1", 0xf4000000 }, 49 { "sram", 0x132f0000 }, 50 }; 51 52 /** 53 * struct vpu - Ingenic VPU remoteproc private structure 54 * @irq: interrupt number 55 * @clks: pointers to the VPU and AUX clocks 56 * @aux_base: raw pointer to the AUX interface registers 57 * @mem_info: array of struct vpu_mem_info, which contain the mapping info of 58 * each of the external memories 59 * @dev: private pointer to the device 60 */ 61 struct vpu { 62 int irq; 63 struct clk_bulk_data clks[2]; 64 void __iomem *aux_base; 65 struct vpu_mem_info mem_info[ARRAY_SIZE(vpu_mem_map)]; 66 struct device *dev; 67 }; 68 69 static int ingenic_rproc_prepare(struct rproc *rproc) 70 { 71 struct vpu *vpu = rproc->priv; 72 int ret; 73 74 /* The clocks must be enabled for the firmware to be loaded in TCSM */ 75 ret = clk_bulk_prepare_enable(ARRAY_SIZE(vpu->clks), vpu->clks); 76 if (ret) 77 dev_err(vpu->dev, "Unable to start clocks: %d\n", ret); 78 79 return ret; 80 } 81 82 static int ingenic_rproc_unprepare(struct rproc *rproc) 83 { 84 struct vpu *vpu = rproc->priv; 85 86 clk_bulk_disable_unprepare(ARRAY_SIZE(vpu->clks), vpu->clks); 87 88 return 0; 89 } 90 91 static int ingenic_rproc_start(struct rproc *rproc) 92 { 93 struct vpu *vpu = rproc->priv; 94 u32 ctrl; 95 96 enable_irq(vpu->irq); 97 98 /* Reset the AUX and enable message IRQ */ 99 ctrl = AUX_CTRL_NMI_RESETS | AUX_CTRL_NMI | AUX_CTRL_MSG_IRQ_EN; 100 writel(ctrl, vpu->aux_base + REG_AUX_CTRL); 101 102 return 0; 103 } 104 105 static int ingenic_rproc_stop(struct rproc *rproc) 106 { 107 struct vpu *vpu = rproc->priv; 108 109 disable_irq(vpu->irq); 110 111 /* Keep AUX in reset mode */ 112 writel(AUX_CTRL_SW_RESET, vpu->aux_base + REG_AUX_CTRL); 113 114 return 0; 115 } 116 117 static void ingenic_rproc_kick(struct rproc *rproc, int vqid) 118 { 119 struct vpu *vpu = rproc->priv; 120 121 writel(vqid, vpu->aux_base + REG_CORE_MSG); 122 } 123 124 static void *ingenic_rproc_da_to_va(struct rproc *rproc, u64 da, size_t len) 125 { 126 struct vpu *vpu = rproc->priv; 127 void __iomem *va = NULL; 128 unsigned int i; 129 130 for (i = 0; i < ARRAY_SIZE(vpu_mem_map); i++) { 131 const struct vpu_mem_info *info = &vpu->mem_info[i]; 132 const struct vpu_mem_map *map = info->map; 133 134 if (da >= map->da && (da + len) < (map->da + info->len)) { 135 va = info->base + (da - map->da); 136 break; 137 } 138 } 139 140 return (__force void *)va; 141 } 142 143 static const struct rproc_ops ingenic_rproc_ops = { 144 .prepare = ingenic_rproc_prepare, 145 .unprepare = ingenic_rproc_unprepare, 146 .start = ingenic_rproc_start, 147 .stop = ingenic_rproc_stop, 148 .kick = ingenic_rproc_kick, 149 .da_to_va = ingenic_rproc_da_to_va, 150 }; 151 152 static irqreturn_t vpu_interrupt(int irq, void *data) 153 { 154 struct rproc *rproc = data; 155 struct vpu *vpu = rproc->priv; 156 u32 vring; 157 158 vring = readl(vpu->aux_base + REG_AUX_MSG); 159 160 /* Ack the interrupt */ 161 writel(0, vpu->aux_base + REG_AUX_MSG_ACK); 162 163 return rproc_vq_interrupt(rproc, vring); 164 } 165 166 static int ingenic_rproc_probe(struct platform_device *pdev) 167 { 168 struct device *dev = &pdev->dev; 169 struct resource *mem; 170 struct rproc *rproc; 171 struct vpu *vpu; 172 unsigned int i; 173 int ret; 174 175 rproc = devm_rproc_alloc(dev, "ingenic-vpu", 176 &ingenic_rproc_ops, NULL, sizeof(*vpu)); 177 if (!rproc) 178 return -ENOMEM; 179 180 rproc->auto_boot = auto_boot; 181 182 vpu = rproc->priv; 183 vpu->dev = &pdev->dev; 184 platform_set_drvdata(pdev, vpu); 185 186 mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "aux"); 187 vpu->aux_base = devm_ioremap_resource(dev, mem); 188 if (IS_ERR(vpu->aux_base)) { 189 dev_err(dev, "Failed to ioremap\n"); 190 return PTR_ERR(vpu->aux_base); 191 } 192 193 for (i = 0; i < ARRAY_SIZE(vpu_mem_map); i++) { 194 mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, 195 vpu_mem_map[i].name); 196 197 vpu->mem_info[i].base = devm_ioremap_resource(dev, mem); 198 if (IS_ERR(vpu->mem_info[i].base)) { 199 ret = PTR_ERR(vpu->mem_info[i].base); 200 dev_err(dev, "Failed to ioremap\n"); 201 return ret; 202 } 203 204 vpu->mem_info[i].len = resource_size(mem); 205 vpu->mem_info[i].map = &vpu_mem_map[i]; 206 } 207 208 vpu->clks[0].id = "vpu"; 209 vpu->clks[1].id = "aux"; 210 211 ret = devm_clk_bulk_get(dev, ARRAY_SIZE(vpu->clks), vpu->clks); 212 if (ret) { 213 dev_err(dev, "Failed to get clocks\n"); 214 return ret; 215 } 216 217 vpu->irq = platform_get_irq(pdev, 0); 218 if (vpu->irq < 0) 219 return vpu->irq; 220 221 ret = devm_request_irq(dev, vpu->irq, vpu_interrupt, 0, "VPU", rproc); 222 if (ret < 0) { 223 dev_err(dev, "Failed to request IRQ\n"); 224 return ret; 225 } 226 227 disable_irq(vpu->irq); 228 229 ret = devm_rproc_add(dev, rproc); 230 if (ret) { 231 dev_err(dev, "Failed to register remote processor\n"); 232 return ret; 233 } 234 235 return 0; 236 } 237 238 static const struct of_device_id ingenic_rproc_of_matches[] = { 239 { .compatible = "ingenic,jz4770-vpu-rproc", }, 240 {} 241 }; 242 MODULE_DEVICE_TABLE(of, ingenic_rproc_of_matches); 243 244 static struct platform_driver ingenic_rproc_driver = { 245 .probe = ingenic_rproc_probe, 246 .driver = { 247 .name = "ingenic-vpu", 248 .of_match_table = ingenic_rproc_of_matches, 249 }, 250 }; 251 module_platform_driver(ingenic_rproc_driver); 252 253 MODULE_LICENSE("GPL"); 254 MODULE_AUTHOR("Paul Cercueil <paul@crapouillou.net>"); 255 MODULE_DESCRIPTION("Ingenic JZ47xx Remote Processor control driver"); 256