[media] smiapp: Use v4l2_of_alloc_parse_endpoint()
Instead of parsing the link-frequencies property in the driver, let v4l2_of_alloc_parse_endpoint() do it. Signed-off-by: Sakari Ailus <sakari.ailus@iki.fi> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Reviewed-by: Sylwester Nawrocki <s.nawrocki@samsung.com> Reviewed-by: Lad, Prabhakar <prabhakar.csengg@gmail.com> Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>
This commit is contained in:
Родитель
698da18e08
Коммит
cb0c9e1f67
|
@ -2975,9 +2975,9 @@ static int smiapp_resume(struct device *dev)
|
||||||
static struct smiapp_platform_data *smiapp_get_pdata(struct device *dev)
|
static struct smiapp_platform_data *smiapp_get_pdata(struct device *dev)
|
||||||
{
|
{
|
||||||
struct smiapp_platform_data *pdata;
|
struct smiapp_platform_data *pdata;
|
||||||
struct v4l2_of_endpoint bus_cfg;
|
struct v4l2_of_endpoint *bus_cfg;
|
||||||
struct device_node *ep;
|
struct device_node *ep;
|
||||||
uint32_t asize;
|
int i;
|
||||||
int rval;
|
int rval;
|
||||||
|
|
||||||
if (!dev->of_node)
|
if (!dev->of_node)
|
||||||
|
@ -2987,13 +2987,15 @@ static struct smiapp_platform_data *smiapp_get_pdata(struct device *dev)
|
||||||
if (!ep)
|
if (!ep)
|
||||||
return NULL;
|
return NULL;
|
||||||
|
|
||||||
|
bus_cfg = v4l2_of_alloc_parse_endpoint(ep);
|
||||||
|
if (IS_ERR(bus_cfg))
|
||||||
|
goto out_err;
|
||||||
|
|
||||||
pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
|
pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
|
||||||
if (!pdata)
|
if (!pdata)
|
||||||
goto out_err;
|
goto out_err;
|
||||||
|
|
||||||
v4l2_of_parse_endpoint(ep, &bus_cfg);
|
switch (bus_cfg->bus_type) {
|
||||||
|
|
||||||
switch (bus_cfg.bus_type) {
|
|
||||||
case V4L2_MBUS_CSI2:
|
case V4L2_MBUS_CSI2:
|
||||||
pdata->csi_signalling_mode = SMIAPP_CSI_SIGNALLING_MODE_CSI2;
|
pdata->csi_signalling_mode = SMIAPP_CSI_SIGNALLING_MODE_CSI2;
|
||||||
break;
|
break;
|
||||||
|
@ -3002,7 +3004,7 @@ static struct smiapp_platform_data *smiapp_get_pdata(struct device *dev)
|
||||||
goto out_err;
|
goto out_err;
|
||||||
}
|
}
|
||||||
|
|
||||||
pdata->lanes = bus_cfg.bus.mipi_csi2.num_data_lanes;
|
pdata->lanes = bus_cfg->bus.mipi_csi2.num_data_lanes;
|
||||||
dev_dbg(dev, "lanes %u\n", pdata->lanes);
|
dev_dbg(dev, "lanes %u\n", pdata->lanes);
|
||||||
|
|
||||||
/* xshutdown GPIO is optional */
|
/* xshutdown GPIO is optional */
|
||||||
|
@ -3022,34 +3024,30 @@ static struct smiapp_platform_data *smiapp_get_pdata(struct device *dev)
|
||||||
dev_dbg(dev, "reset %d, nvm %d, clk %d, csi %d\n", pdata->xshutdown,
|
dev_dbg(dev, "reset %d, nvm %d, clk %d, csi %d\n", pdata->xshutdown,
|
||||||
pdata->nvm_size, pdata->ext_clk, pdata->csi_signalling_mode);
|
pdata->nvm_size, pdata->ext_clk, pdata->csi_signalling_mode);
|
||||||
|
|
||||||
rval = of_get_property(ep, "link-frequencies", &asize) ? 0 : -ENOENT;
|
if (!bus_cfg->nr_of_link_frequencies) {
|
||||||
if (rval) {
|
dev_warn(dev, "no link frequencies defined\n");
|
||||||
dev_warn(dev, "can't get link-frequencies array size\n");
|
|
||||||
goto out_err;
|
goto out_err;
|
||||||
}
|
}
|
||||||
|
|
||||||
pdata->op_sys_clock = devm_kzalloc(dev, asize, GFP_KERNEL);
|
pdata->op_sys_clock = devm_kcalloc(
|
||||||
|
dev, bus_cfg->nr_of_link_frequencies + 1 /* guardian */,
|
||||||
|
sizeof(*pdata->op_sys_clock), GFP_KERNEL);
|
||||||
if (!pdata->op_sys_clock) {
|
if (!pdata->op_sys_clock) {
|
||||||
rval = -ENOMEM;
|
rval = -ENOMEM;
|
||||||
goto out_err;
|
goto out_err;
|
||||||
}
|
}
|
||||||
|
|
||||||
asize /= sizeof(*pdata->op_sys_clock);
|
for (i = 0; i < bus_cfg->nr_of_link_frequencies; i++) {
|
||||||
rval = of_property_read_u64_array(
|
pdata->op_sys_clock[i] = bus_cfg->link_frequencies[i];
|
||||||
ep, "link-frequencies", pdata->op_sys_clock, asize);
|
dev_dbg(dev, "freq %d: %lld\n", i, pdata->op_sys_clock[i]);
|
||||||
if (rval) {
|
|
||||||
dev_warn(dev, "can't get link-frequencies\n");
|
|
||||||
goto out_err;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
for (; asize > 0; asize--)
|
v4l2_of_free_endpoint(bus_cfg);
|
||||||
dev_dbg(dev, "freq %d: %lld\n", asize - 1,
|
|
||||||
pdata->op_sys_clock[asize - 1]);
|
|
||||||
|
|
||||||
of_node_put(ep);
|
of_node_put(ep);
|
||||||
return pdata;
|
return pdata;
|
||||||
|
|
||||||
out_err:
|
out_err:
|
||||||
|
v4l2_of_free_endpoint(bus_cfg);
|
||||||
of_node_put(ep);
|
of_node_put(ep);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
Загрузка…
Ссылка в новой задаче