Messages in this thread | | | Subject | Re: [PATCH 2/2] remoteproc: Ingenic: Add support for new Ingenic SoCs. | From | Zhou Yanjie <> | Date | Sat, 24 Jul 2021 21:32:52 +0800 |
| |
Hi Paul,
On 2021/7/24 下午7:15, Paul Cercueil wrote: > Hi Zhou, > > Le sam., juil. 24 2021 at 17:11:38 +0800, 周琰杰 (Zhou Yanjie) > <zhouyanjie@wanyeetech.com> a écrit : >> Add support for probing the ingenic_rproc driver on the JZ4760 SoC, >> the JZ4760B SoC, the JZ4775 SoC, and the JZ4780 SoC from Ingenic. >> >> Signed-off-by: 周琰杰 (Zhou Yanjie) <zhouyanjie@wanyeetech.com> >> --- >> drivers/remoteproc/ingenic_rproc.c | 115 >> +++++++++++++++++++++++++++++-------- >> 1 file changed, 91 insertions(+), 24 deletions(-) >> >> diff --git a/drivers/remoteproc/ingenic_rproc.c >> b/drivers/remoteproc/ingenic_rproc.c >> index a356738..6a2e864 100644 >> --- a/drivers/remoteproc/ingenic_rproc.c >> +++ b/drivers/remoteproc/ingenic_rproc.c >> @@ -2,6 +2,7 @@ >> /* >> * Ingenic JZ47xx remoteproc driver >> * Copyright 2019, Paul Cercueil <paul@crapouillou.net> >> + * Copyright 2021, 周琰杰 (Zhou Yanjie) <zhouyanjie@wanyeetech.com> >> */ >> >> #include <linux/bitops.h> >> @@ -17,7 +18,7 @@ >> >> #define REG_AUX_CTRL 0x0 >> #define REG_AUX_MSG_ACK 0x10 >> -#define REG_AUX_MSG 0x14 >> +#define REG_AUX_MSG 0x14 >> #define REG_CORE_MSG_ACK 0x18 >> #define REG_CORE_MSG 0x1C >> >> @@ -32,6 +33,20 @@ module_param(auto_boot, bool, 0400); >> MODULE_PARM_DESC(auto_boot, >> "Auto-boot the remote processor [default=false]"); >> >> +enum ingenic_vpu_version { >> + ID_JZ4760, >> + ID_JZ4770, >> + ID_JZ4775, >> +}; > > The "version" field of ingenic_so_cinfo is not used anywhere, so you > can drop this enum completely.
Sure, I will remove it.
> >> + >> +struct ingenic_soc_info { >> + enum ingenic_vpu_version version; >> + const struct vpu_mem_map *mem_map; >> + >> + unsigned int num_clks; >> + unsigned int num_mems; >> +}; >> + >> struct vpu_mem_map { >> const char *name; >> unsigned int da; >> @@ -43,26 +58,21 @@ struct vpu_mem_info { >> void __iomem *base; >> }; >> >> -static const struct vpu_mem_map vpu_mem_map[] = { >> - { "tcsm0", 0x132b0000 }, >> - { "tcsm1", 0xf4000000 }, >> - { "sram", 0x132f0000 }, >> -}; >> - >> /** >> * struct vpu - Ingenic VPU remoteproc private structure >> * @irq: interrupt number >> * @clks: pointers to the VPU and AUX clocks >> * @aux_base: raw pointer to the AUX interface registers >> - * @mem_info: array of struct vpu_mem_info, which contain the >> mapping info of >> + * @mem_info: pointers to the struct vpu_mem_info, which contain the >> mapping info of >> * each of the external memories >> * @dev: private pointer to the device >> */ >> struct vpu { >> int irq; >> - struct clk_bulk_data clks[2]; >> void __iomem *aux_base; >> - struct vpu_mem_info mem_info[ARRAY_SIZE(vpu_mem_map)]; >> + const struct ingenic_soc_info *soc_info; >> + struct clk_bulk_data *clks; >> + struct vpu_mem_info *mem_info; >> struct device *dev; >> }; >> >> @@ -72,7 +82,7 @@ static int ingenic_rproc_prepare(struct rproc *rproc) >> int ret; >> >> /* The clocks must be enabled for the firmware to be loaded in >> TCSM */ >> - ret = clk_bulk_prepare_enable(ARRAY_SIZE(vpu->clks), vpu->clks); >> + ret = clk_bulk_prepare_enable(vpu->soc_info->num_clks, vpu->clks); >> if (ret) >> dev_err(vpu->dev, "Unable to start clocks: %d\n", ret); >> >> @@ -83,7 +93,7 @@ static int ingenic_rproc_unprepare(struct rproc >> *rproc) >> { >> struct vpu *vpu = rproc->priv; >> >> - clk_bulk_disable_unprepare(ARRAY_SIZE(vpu->clks), vpu->clks); >> + clk_bulk_disable_unprepare(vpu->soc_info->num_clks, vpu->clks); >> >> return 0; >> } >> @@ -127,7 +137,7 @@ static void *ingenic_rproc_da_to_va(struct rproc >> *rproc, u64 da, size_t len, boo >> void __iomem *va = NULL; >> unsigned int i; >> >> - for (i = 0; i < ARRAY_SIZE(vpu_mem_map); i++) { >> + for (i = 0; i < vpu->soc_info->num_mems; i++) { >> const struct vpu_mem_info *info = &vpu->mem_info[i]; >> const struct vpu_mem_map *map = info->map; >> >> @@ -163,8 +173,60 @@ static irqreturn_t vpu_interrupt(int irq, void >> *data) >> return rproc_vq_interrupt(rproc, vring); >> } >> >> +static const struct vpu_mem_map jz4760_vpu_mem_map[] = { >> + { "tcsm0", 0x132b0000 }, >> + { "tcsm1", 0xf4000000 }, >> + { "sram", 0x132d0000 }, >> +}; >> + >> +static const struct vpu_mem_map jz4770_vpu_mem_map[] = { >> + { "tcsm0", 0x132b0000 }, >> + { "tcsm1", 0xf4000000 }, >> + { "sram", 0x132f0000 }, >> +}; >> + >> +static const struct vpu_mem_map jz4775_vpu_mem_map[] = { >> + { "tcsm", 0xf4000000 }, >> + { "sram", 0x132f0000 }, >> +}; >> + >> +static const struct ingenic_soc_info jz4760_soc_info = { >> + .version = ID_JZ4760, >> + .mem_map = jz4760_vpu_mem_map, >> + >> + .num_clks = 2, >> + .num_mems = 3, > > .num_mems = ARRAY_SIZE(jz4760_vpu_mem_map), > > And the same for the other ingenic_soc_info below.
Sure.
> >> +}; >> + >> +static const struct ingenic_soc_info jz4770_soc_info = { >> + .version = ID_JZ4770, >> + .mem_map = jz4770_vpu_mem_map, >> + >> + .num_clks = 2, >> + .num_mems = 3, >> +}; >> + >> +static const struct ingenic_soc_info jz4775_soc_info = { >> + .version = ID_JZ4775, >> + .mem_map = jz4775_vpu_mem_map, >> + >> + .num_clks = 1, >> + .num_mems = 2, >> +}; >> + >> +static const struct of_device_id ingenic_rproc_of_matches[] = { >> + { .compatible = "ingenic,jz4760-vpu-rproc", .data = >> &jz4760_soc_info }, >> + { .compatible = "ingenic,jz4760b-vpu-rproc", .data = >> &jz4760_soc_info }, >> + { .compatible = "ingenic,jz4770-vpu-rproc", .data = >> &jz4770_soc_info }, >> + { .compatible = "ingenic,jz4775-vpu-rproc", .data = >> &jz4775_soc_info }, >> + { .compatible = "ingenic,jz4780-vpu-rproc", .data = >> &jz4775_soc_info }, >> + {} >> +}; >> +MODULE_DEVICE_TABLE(of, ingenic_rproc_of_matches); >> + >> static int ingenic_rproc_probe(struct platform_device *pdev) >> { >> + const struct of_device_id *id = >> of_match_node(ingenic_rproc_of_matches, pdev->dev.of_node); >> struct device *dev = &pdev->dev; >> struct resource *mem; >> struct rproc *rproc; >> @@ -181,6 +243,7 @@ static int ingenic_rproc_probe(struct >> platform_device *pdev) >> >> vpu = rproc->priv; >> vpu->dev = &pdev->dev; >> + vpu->soc_info = id->data; > > Use of_device_get_match_data(dev). > > Then you can get rid of the "id" variable, and you won't have to move > the "ingenic_rproc_of_matches" array.
Sure, I will try.
> >> platform_set_drvdata(pdev, vpu); >> >> mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "aux"); >> @@ -190,9 +253,13 @@ static int ingenic_rproc_probe(struct >> platform_device *pdev) >> return PTR_ERR(vpu->aux_base); >> } >> >> - for (i = 0; i < ARRAY_SIZE(vpu_mem_map); i++) { >> + vpu->mem_info = kzalloc(sizeof(struct vpu_mem_info) * >> vpu->soc_info->num_mems, GFP_KERNEL); > > You are leaking memory here. > > Also, why not just fix the current mem_info array size to 3? That > sounds way simpler.
Sure.
> >> + if (!vpu->mem_info) >> + return -ENOMEM; >> + >> + for (i = 0; i < vpu->soc_info->num_mems; i++) { >> mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, >> - vpu_mem_map[i].name); >> + vpu->soc_info->mem_map[i].name); >> >> vpu->mem_info[i].base = devm_ioremap_resource(dev, mem); >> if (IS_ERR(vpu->mem_info[i].base)) { >> @@ -202,13 +269,19 @@ static int ingenic_rproc_probe(struct >> platform_device *pdev) >> } >> >> vpu->mem_info[i].len = resource_size(mem); >> - vpu->mem_info[i].map = &vpu_mem_map[i]; >> + vpu->mem_info[i].map = &vpu->soc_info->mem_map[i]; >> } >> >> + vpu->clks = kzalloc(sizeof(struct clk_bulk_data) * >> vpu->soc_info->num_clks, GFP_KERNEL); > > Same here, the "clks" array is already size 2, so it won't be a > problem if you have only one clock. No need to alloc "clks" dynamically.
Sure.
> >> + if (!vpu->clks) >> + return -ENOMEM; >> + >> vpu->clks[0].id = "vpu"; >> - vpu->clks[1].id = "aux"; >> >> - ret = devm_clk_bulk_get(dev, ARRAY_SIZE(vpu->clks), vpu->clks); >> + if (vpu->soc_info->version == ID_JZ4770) >> + vpu->clks[1].id = "aux"; >> + >> + ret = devm_clk_bulk_get(dev, vpu->soc_info->num_clks, vpu->clks); >> if (ret) { >> dev_err(dev, "Failed to get clocks\n"); >> return ret; >> @@ -235,12 +308,6 @@ static int ingenic_rproc_probe(struct >> platform_device *pdev) >> return 0; >> } >> >> -static const struct of_device_id ingenic_rproc_of_matches[] = { >> - { .compatible = "ingenic,jz4770-vpu-rproc", }, >> - {} >> -}; >> -MODULE_DEVICE_TABLE(of, ingenic_rproc_of_matches); > > As I wrote above - you don't need to move this.
Sure.
Thanks and best regards!
> > Cheers, > -Paul > >> - >> static struct platform_driver ingenic_rproc_driver = { >> .probe = ingenic_rproc_probe, >> .driver = { >> -- >> 2.7.4 >> >
| |