Commit cb0c9e1f authored by Sakari Ailus's avatar Sakari Ailus Committed by Mauro Carvalho Chehab

[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: default avatarSakari Ailus <sakari.ailus@iki.fi>
Acked-by: default avatarLaurent Pinchart <laurent.pinchart@ideasonboard.com>
Reviewed-by: default avatarSylwester Nawrocki <s.nawrocki@samsung.com>
Reviewed-by: default avatarLad, Prabhakar <prabhakar.csengg@gmail.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@osg.samsung.com>
parent 698da18e
...@@ -2975,9 +2975,9 @@ static int smiapp_resume(struct device *dev) ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment