On 10/26/2016 01:55 AM, Kevin Hilman wrote: > First pass at getting subdevs from DT ports and endpoints. > > The _get_pdata() function was larely inspired by (i.e. stolen from) > am437x-vpfe.c > > Questions: > - Legacy board file passes subdev input & output routes via pdata > (e.g. tvp514x svideo or composite selection.) How is this supposed > to be done via DT? We have plans to model connectors as well in the device tree, but no implementation exists yet. I think Laurent has some code in progress for this, but I may be mistaken. Anyway, hard-coding it like you do now is for now the only way. Hans > > Not-Yet-Signed-off-by: Kevin Hilman <khilman@xxxxxxxxxxxx> > --- > drivers/media/platform/davinci/vpif_capture.c | 132 +++++++++++++++++++++++++- > include/media/davinci/vpif_types.h | 9 +- > 2 files changed, 134 insertions(+), 7 deletions(-) > > diff --git a/drivers/media/platform/davinci/vpif_capture.c b/drivers/media/platform/davinci/vpif_capture.c > index becc3e63b472..df2af5cda37a 100644 > --- a/drivers/media/platform/davinci/vpif_capture.c > +++ b/drivers/media/platform/davinci/vpif_capture.c > @@ -26,6 +26,8 @@ > #include <linux/slab.h> > > #include <media/v4l2-ioctl.h> > +#include <media/v4l2-of.h> > +#include <media/i2c/tvp514x.h> /* FIXME: how to pass the INPUT_* OUTPUT* fields? */ > > #include "vpif.h" > #include "vpif_capture.h" > @@ -651,6 +653,10 @@ static int vpif_input_to_subdev( > > vpif_dbg(2, debug, "vpif_input_to_subdev\n"); > > + if (!chan_cfg) > + return -1; > + if (input_index >= chan_cfg->input_count) > + return -1; > subdev_name = chan_cfg->inputs[input_index].subdev_name; > if (subdev_name == NULL) > return -1; > @@ -658,7 +664,7 @@ static int vpif_input_to_subdev( > /* loop through the sub device list to get the sub device info */ > for (i = 0; i < vpif_cfg->subdev_count; i++) { > subdev_info = &vpif_cfg->subdev_info[i]; > - if (!strcmp(subdev_info->name, subdev_name)) > + if (subdev_info && !strcmp(subdev_info->name, subdev_name)) > return i; > } > return -1; > @@ -1328,13 +1334,25 @@ static int vpif_async_bound(struct v4l2_async_notifier *notifier, > { > int i; > > + for (i = 0; i < vpif_obj.config->asd_sizes[0]; i++) { > + const struct device_node *node = vpif_obj.config->asd[i]->match.of.node; > + > + if (node == subdev->of_node) { > + vpif_obj.sd[i] = subdev; > + vpif_obj.config->chan_config->inputs[i].subdev_name = subdev->of_node->full_name; > + vpif_dbg(2, debug, "%s: setting input %d subdev_name = %s\n", __func__, > + i, subdev->of_node->full_name); > + return 0; > + } > + } > + > for (i = 0; i < vpif_obj.config->subdev_count; i++) > if (!strcmp(vpif_obj.config->subdev_info[i].name, > subdev->name)) { > vpif_obj.sd[i] = subdev; > return 0; > } > - > + > return -EINVAL; > } > > @@ -1423,6 +1441,113 @@ static int vpif_async_complete(struct v4l2_async_notifier *notifier) > return vpif_probe_complete(); > } > > +static struct vpif_capture_config * > +vpif_capture_get_pdata(struct platform_device *pdev) > +{ > + struct device_node *endpoint = NULL; > + struct v4l2_of_endpoint bus_cfg; > + struct vpif_capture_config *pdata; > + struct vpif_subdev_info *sdinfo; > + struct vpif_capture_chan_config *chan; > + unsigned int i; > + > + dev_dbg(&pdev->dev, "vpif_get_pdata\n"); > + > + if (!IS_ENABLED(CONFIG_OF) || !pdev->dev.of_node) > + return pdev->dev.platform_data; > + > + pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); > + if (!pdata) > + return NULL; > + pdata->subdev_info = devm_kzalloc(&pdev->dev, > + sizeof(*pdata->subdev_info) * > + VPIF_CAPTURE_MAX_CHANNELS, GFP_KERNEL); > + if (!pdata->subdev_info) > + return NULL; > + dev_dbg(&pdev->dev, "%s\n", __func__); > + > + for (i = 0; ; i++) { > + struct device_node *rem; > + unsigned int flags; > + int err; > + > + endpoint = of_graph_get_next_endpoint(pdev->dev.of_node, > + endpoint); > + if (!endpoint) > + break; > + > + dev_dbg(&pdev->dev, "found endpoint %s, %s\n", > + endpoint->name, endpoint->full_name); > + > + sdinfo = &pdata->subdev_info[i]; > + chan = &pdata->chan_config[i]; > + chan->inputs = devm_kzalloc(&pdev->dev, > + sizeof(*chan->inputs) * > + VPIF_DISPLAY_MAX_CHANNELS, > + GFP_KERNEL); > + > + /* sdinfo->name = devm_kzalloc(&pdev->dev, 16, GFP_KERNEL); */ > + /* snprintf(sdinfo->name, 16, "VPIF input %d", i); */ > + chan->input_count++; > + chan->inputs[i].input.type = V4L2_INPUT_TYPE_CAMERA; > + chan->inputs[i].input.std = V4L2_STD_ALL; > + chan->inputs[i].input.capabilities = V4L2_IN_CAP_STD; > + > + /* FIXME: need a new property? ch0:composite ch1: s-video */ > + if (i == 0) > + chan->inputs[i].input_route = INPUT_CVBS_VI2B; > + else > + chan->inputs[i].input_route = INPUT_SVIDEO_VI2C_VI1C; > + chan->inputs[i].output_route = OUTPUT_10BIT_422_EMBEDDED_SYNC; > + > + err = v4l2_of_parse_endpoint(endpoint, &bus_cfg); > + if (err) { > + dev_err(&pdev->dev, "Could not parse the endpoint\n"); > + goto done; > + } > + dev_dbg(&pdev->dev, "Endpoint %s, bus_width = %d\n", > + endpoint->full_name, bus_cfg.bus.parallel.bus_width); > + flags = bus_cfg.bus.parallel.flags; > + > + if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > + chan->vpif_if.hd_pol = 1; > + > + if (flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH) > + chan->vpif_if.vd_pol = 1; > + > + chan->vpif_if.if_type = VPIF_IF_BT656; > + rem = of_graph_get_remote_port_parent(endpoint); > + if (!rem) { > + dev_dbg(&pdev->dev, "Remote device at %s not found\n", > + endpoint->full_name); > + goto done; > + } > + > + dev_dbg(&pdev->dev, "Remote device %s, %s found\n", rem->name, rem->full_name); > + sdinfo->name = rem->full_name; > + > + pdata->asd[i] = devm_kzalloc(&pdev->dev, > + sizeof(struct v4l2_async_subdev), > + GFP_KERNEL); > + if (!pdata->asd[i]) { > + of_node_put(rem); > + pdata = NULL; > + goto done; > + } > + > + pdata->asd[i]->match_type = V4L2_ASYNC_MATCH_OF; > + pdata->asd[i]->match.of.node = rem; > + of_node_put(rem); > + } > + > +done: > + pdata->asd_sizes[0] = i; > + pdata->subdev_count = i; > + pdata->card_name = "DA850/OMAP-L138 Video Capture"; > + > + return pdata; > +} > + > /** > * vpif_probe : This function probes the vpif capture driver > * @pdev: platform device pointer > @@ -1439,6 +1564,7 @@ static __init int vpif_probe(struct platform_device *pdev) > int res_idx = 0; > int i, err; > > + pdev->dev.platform_data = vpif_capture_get_pdata(pdev);; > if (!pdev->dev.platform_data) { > dev_warn(&pdev->dev, "Missing platform data. Giving up.\n"); > return -EINVAL; > @@ -1481,7 +1607,7 @@ static __init int vpif_probe(struct platform_device *pdev) > goto vpif_unregister; > } > > - if (!vpif_obj.config->asd_sizes) { > + if (!vpif_obj.config->asd_sizes[0]) { > i2c_adap = i2c_get_adapter(1); > for (i = 0; i < subdev_count; i++) { > subdevdata = &vpif_obj.config->subdev_info[i]; > diff --git a/include/media/davinci/vpif_types.h b/include/media/davinci/vpif_types.h > index 3cb1704a0650..4ee3b41975db 100644 > --- a/include/media/davinci/vpif_types.h > +++ b/include/media/davinci/vpif_types.h > @@ -65,14 +65,14 @@ struct vpif_display_config { > > struct vpif_input { > struct v4l2_input input; > - const char *subdev_name; > + char *subdev_name; > u32 input_route; > u32 output_route; > }; > > struct vpif_capture_chan_config { > struct vpif_interface vpif_if; > - const struct vpif_input *inputs; > + struct vpif_input *inputs; > int input_count; > }; > > @@ -83,7 +83,8 @@ struct vpif_capture_config { > struct vpif_subdev_info *subdev_info; > int subdev_count; > const char *card_name; > - struct v4l2_async_subdev **asd; /* Flat array, arranged in groups */ > - int *asd_sizes; /* 0-terminated array of asd group sizes */ > + > + struct v4l2_async_subdev *asd[VPIF_CAPTURE_MAX_CHANNELS]; > + int asd_sizes[VPIF_CAPTURE_MAX_CHANNELS]; > }; > #endif /* _VPIF_TYPES_H */ > -- To unsubscribe from this list: send the line "unsubscribe linux-media" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html