Re: [PATCH 19/22] [media] tvp5150: add input source selection of_graph support

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



Hi Mauro,

On 18-08-08 15:52, Mauro Carvalho Chehab wrote:
> Em Wed, 8 Aug 2018 17:29:49 +0200
> Marco Felsch <m.felsch@xxxxxxxxxxxxxx> escreveu:
> 
> > Hi Mauro,
> > 
> > the discussion about the correct binding was spread around some patches.
> > So I will try use the correct thread for that theme. I did my rework for
> > the of_graph support on your suggestions [1] and [2]. I attached my work
> > as RFC patch. Can you review it, so I can prepare a v2?
> > 
> > [1] https://www.spinics.net/lists/linux-media/msg138545.html
> > [2] https://www.spinics.net/lists/linux-media/msg138546.html
> 
> Thanks for the patch.
> 
> Added my comments below.

Thanks for your quick response.

I integrated the most of your comments and added some more comments below.

> 
> > 
> > On 18-07-30 15:29, Mauro Carvalho Chehab wrote:
> > > Em Thu, 28 Jun 2018 18:20:51 +0200
> > > Marco Felsch <m.felsch@xxxxxxxxxxxxxx> escreveu:
> > > 
> > > > The currrent driver layout had the following layout:
> > > >                +----------------+
> > > >  +-------+     |    TVP5150     |
> > > >  | Comp0 +--+  |                |
> > > >  +-------+  |  |          +-----+
> > > >  +-------+  |  +------+   | Src |
> > > >  | Comp1 +--+--|Sink  |   +-----+
> > > >  +-------+  |  +------+   +-----+
> > > > +--------+  |  |          | Src |
> > > > | SVideo +--+  |          +-----+
> > > > +--------+     +----------------+
> > > > 
> > > > Since the device tree abstracts the real hardware this layout is not
> > > > correct, because the TVP5150 has 3 physical ports (2 input, 1 output).
> > > > Furthermore this layout assumes that there is an additional external mux
> > > > in front of the TVP5150. This is not correct because the TVP5150 does
> > > > the muxing work. The corresponding of_graph layout will look like:
> > > > 	tvp5150 {
> > > > 		....
> > > > 		port {
> > > > 			reg = <0>;
> > > > 			endpoint@0 {...};
> > > > 			endpoint@1 {...};
> > > > 			endpoint@2 {...};
> > > > 		};
> > > > 
> > > > 	};
> > > > 
> > > > This patch change the layout to:
> > > >              +----------------+
> > > >              |    TVP5150     |
> > > >  +-------+   +------+         |
> > > >  | Comp0 +---+ Sink |         |
> > > >  +-------+   +------+         |
> > > >  +-------+   +------+   +-----+
> > > >  | Comp1 +---+ Sink |   | Src |
> > > >  +-------+   +------+   +-----+
> > > > +--------+   +------+         |
> > > > | SVideo +---+ Sink |         |
> > > > +--------+   +------+         |
> > > >              +----------------+
> > > > 
> > > > To keep things easy an additional 'virtual' S-Video port is added. More
> > > > information about the port mapping can be found in the device tree
> > > > binding documentation. The connector entities Comp0/1, SVideo are created
> > > > only if they are connected to the correct port. If more than one connector
> > > > is available the media_entity_operations.link_setup() callback ensures that
> > > > only one connector is active. To change the input src the link between
> > > > the TVP5150 pad and the connector must be disabled, then a new link can
> > > > be enabled.
> > > > 
> > > > The patch tries to reduce the '#ifdef CONFIG_MEDIA_CONTROLLER' usage to
> > > > a minimum.
> > > > 
> > > > Signed-off-by: Marco Felsch <m.felsch@xxxxxxxxxxxxxx>
> > > > ---
> > > >  drivers/media/i2c/tvp5150.c | 322 ++++++++++++++++++++++++++++++++----
> > > >  1 file changed, 287 insertions(+), 35 deletions(-)
> > > > 
> > > > diff --git a/drivers/media/i2c/tvp5150.c b/drivers/media/i2c/tvp5150.c
> > > > index a6fec569a610..6ac29c62d99b 100644
> > > > --- a/drivers/media/i2c/tvp5150.c
> > > > +++ b/drivers/media/i2c/tvp5150.c
> > > > @@ -44,10 +44,30 @@ MODULE_PARM_DESC(debug, "Debug level (0-2)");
> > > >  
> > > >  #define dprintk0(__dev, __arg...) dev_dbg_lvl(__dev, 0, 0, __arg)
> > > >  
> > > > +enum tvp5150_ports {
> > > > +	TVP5150_PORT_AIP1A = TVP5150_COMPOSITE0,
> > > > +	TVP5150_PORT_AIP1B,
> > > > +	/* s-video port is a virtual port */
> > > > +	TVP5150_PORT_SVIDEO,
> > > > +	TVP5150_PORT_YOUT,
> > > > +	TVP5150_PORT_NUM,
> > > > +};
> > > > +
> > > > +#ifdef CONFIG_MEDIA_CONTROLLER
> > > > +struct tvp5150_connector {
> > > > +	struct media_entity con;
> > > > +	struct media_pad pad;
> > > > +	unsigned int port_num;
> > > > +};
> > > > +#endif
> > > > +
> > > >  struct tvp5150 {
> > > >  	struct v4l2_subdev sd;
> > > > +	struct device_node *endpoints[TVP5150_PORT_NUM];
> > > >  #ifdef CONFIG_MEDIA_CONTROLLER
> > > > -	struct media_pad pads[DEMOD_NUM_PADS];
> > > > +	struct media_pad pads[TVP5150_PORT_NUM];
> > > 
> > > This will cause problems with the current code.
> > > 
> > > When we designed the MC version 2 code, the idea were to allow
> > > set properties to entities and to the inputs, but the code
> > > was never submitted upstream.
> > > 
> > > A decoder may have several different types of inputs and outputs.
> > > Several designs allow using different types of decoders, being
> > > saa711x and tvp5150 the most popular ones. Well, depending on
> > > the device, the number of PADs and the signals they carry can
> > > be different.
> > > 
> > > Without a way to "taint" a pad to the signal it contains, 
> > > while waiting for the properties API, we added a code that
> > > "fixed" the PADs to a certain number. This way, Kernelspace could
> > > use the pad "number" as a way to identify the type of signal a
> > > PAD carries.
> > > 
> > > The PC consumer drivers use those numbers in order to build the
> > > MC graph[1].
> > > 
> > > A change on this would require adding a property to the pad, in
> > > order to indicate the type of signal it provides (RF, luminance IF,
> > > chroma IF, audio IF, I2S audio, ...), and to change
> > > v4l2_mc_create_media_graph() accordingly.
> > > 
> > > 
> > > [1] See drivers/media/v4l2-core/v4l2-mc.c at v4l2_mc_create_media_graph() func.
> > > 
> > > 
> > 
> > [ snip ]
> > 
> > From d3eb8a7de65fe2f8dd10ced85e4baca8e7898434 Mon Sep 17 00:00:00 2001
> > From: Marco Felsch <m.felsch@xxxxxxxxxxxxxx>
> > Date: Thu, 28 Jun 2018 18:20:51 +0200
> > Subject: [RFC] [media] tvp5150: add input source selection of_graph
> >  support
> > 
> > This patch adds the of_graph support to describe the tvp connections.
> > Physical the TVP5150 has three ports: AIP1A, AIP1B and YOUT. As result
> > of discussion [1],[2] the device-tree maps these ports 1:1 with one
> > deviation. The svideo connector must be conneted to port@0/endpoint@1,
> > look at the Documentation for more information. Since the TVP5150 is a
> > converter the device-tree must contain at least 1-input and 1-output port.
> > The mc-connectors and mc-links are only created if the device-tree
> > contains the corresponding connector nodes. If more than one connector is
> > available the media_entity_operations.link_setup() callback ensures that
> > only one connector is active. To change the input src the active link must
> > disabled first, then a new link can be established.
> > 
> > [1] https://www.spinics.net/lists/linux-media/msg138545.html
> > [2] https://www.spinics.net/lists/linux-media/msg138546.html
> > 
> > Signed-off-by: Marco Felsch <m.felsch@xxxxxxxxxxxxxx>
> > 
> > ---
> > Changelog:
> > 
> > v2:
> > - adapt commit message
> > - mc: use 2-input and 1-output pad
> > - mc: enable svideo on tvp only if both tvp-input pads have a active
> >       link to the svideo src pad
> > - mc: disable svideo on tvp only if both tvp-input pads are inactive
> > - dt-support: drop svideo dt port
> > - dt-support: move svideo connector to port@0/endpoint@1
> > - dt-support: require at least 1-in and 1-out endpoint
> > ---
> >  drivers/media/i2c/tvp5150.c | 413 ++++++++++++++++++++++++++++++++----
> >  1 file changed, 377 insertions(+), 36 deletions(-)
> > 
> > diff --git a/drivers/media/i2c/tvp5150.c b/drivers/media/i2c/tvp5150.c
> > index b5d44c25d1da..be755c5e63a9 100644
> > --- a/drivers/media/i2c/tvp5150.c
> > +++ b/drivers/media/i2c/tvp5150.c
> > @@ -43,16 +43,38 @@ MODULE_PARM_DESC(debug, "Debug level (0-2)");
> >  
> >  #define dprintk0(__dev, __arg...) dev_dbg_lvl(__dev, 0, 0, __arg)
> >  
> > +#ifdef CONFIG_MEDIA_CONTROLLER
> >  enum tvp5150_pads {
> > -       TVP5150_PAD_IF_INPUT,
> > -       TVP5150_PAD_VID_OUT,
> > -       TVP5150_NUM_PADS
> > +	TVP5150_PAD_AIP1A = TVP5150_COMPOSITE0,
> > +	TVP5150_PAD_AIP1B,
> > +	TVP5150_PAD_VID_OUT,
> > +	TVP5150_NUM_PADS
> > +};
> > +
> > +enum tvp5150_pads_state {
> > +	TVP5150_PAD_INACTIVE,
> > +	TVP5150_PAD_ACTIVE_COMPOSITE,
> > +	TVP5150_PAD_ACTIVE_SVIDEO,
> > +};
> > +
> > +struct tvp5150_connector {
> > +	struct media_entity ent;
> > +	struct media_pad pad;
> > +	unsigned int port_num;
> > +	bool is_svideo;
> >  };
> > +#endif
> >  
> >  struct tvp5150 {
> >  	struct v4l2_subdev sd;
> > +	/* additional additional endpoint for the svideo connector */
> > +	struct device_node *endpoints[TVP5150_NUM_PADS + 1];
> > +	unsigned int endpoints_num;
> >  #ifdef CONFIG_MEDIA_CONTROLLER
> >  	struct media_pad pads[TVP5150_NUM_PADS];
> > +	int pads_state[TVP5150_NUM_PADS];
> > +	struct tvp5150_connector *connectors;
> > +	int connectors_num;
> >  #endif
> >  	struct v4l2_ctrl_handler hdl;
> >  	struct v4l2_rect rect;
> > @@ -1168,6 +1190,135 @@ static int tvp5150_enum_frame_size(struct v4l2_subdev *sd,
> >  	return 0;
> >  }
> >  
> > +/****************************************************************************
> > + *			Media entity ops
> > + ****************************************************************************/
> > +#ifdef CONFIG_MEDIA_CONTROLLER
> > +static int tvp5150_s_routing(struct v4l2_subdev *sd, u32 input, u32 output,
> > +			     u32 config);
> > +static int tvp5150_link_setup(struct media_entity *entity,
> > +			      const struct media_pad *local,
> > +			      const struct media_pad *remote, u32 flags)
> > +{
> > +	struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
> > +	struct tvp5150 *decoder = to_tvp5150(sd);
> > +	int *pad_state = &decoder->pads_state[0];
> > +	int i, ret = 0, active_pad = -1;
> > +	bool is_svideo = false;
> > +
> > +	/*
> > +	 * The tvp state is determined by the enabled sink pad link.
> > +	 * Enabling or disabling the source pad link has no effect.
> > +	 */
> > +	if (local->flags & MEDIA_PAD_FL_SOURCE)
> > +		return 0;
> > +
> > +	/* check if the svideo connector should be enabled */
> > +	for (i = 0; i < decoder->connectors_num; i++) {
> > +		if (remote->entity == &decoder->connectors[i].ent) {
> > +			is_svideo = decoder->connectors[i].is_svideo;
> > +			break;
> > +		}
> > +	}
> > +
> > +	/* check if there is enabled link */
> > +	for (i = 0; i < TVP5150_NUM_PADS - 1; i++) {
> > +		if ((pad_state[i] == TVP5150_PAD_ACTIVE_COMPOSITE) ||
> > +		    (pad_state[i] == TVP5150_PAD_ACTIVE_SVIDEO)) {
> > +			active_pad = i;
> > +			break;
> > +		}
> > +	}
> > +
> > +	dev_dbg(sd->dev, "link setup '%s':%d->'%s':%d[%d]",
> > +		remote->entity->name, remote->index, local->entity->name,
> > +		local->index, flags & MEDIA_LNK_FL_ENABLED);
> 
> Hmm... the remote is the connector, right? I would switch the
> print message to point from the connector to tvp5150, as this is
> the signal flow.

I don't know what you mean, I tought that's what I'm already do. If I
change it it will print something like: tvp5150 2-005d :0 -> Comp0 :0[1]

> 
> Btw, it would likely be better to call it "connector" or "conn_entity",
> to make it clearer.

I tought remote is the common nomenclature. Also the remote mustn't be a
connector. In my case it's a soldered camera. With this in mind, you think
it should be still changed?

> 
> > +
> > +	if (flags & MEDIA_LNK_FL_ENABLED) {
> > +		/*
> > +		 * Composite activation: all links must be inactive.
> > +		 * Svideo activation: one link can be active if it is a svideo
> > +		 * link. Return error in case of a active composite link or both
> > +		 * svideo links are active.
> > +		 */
> > +		if (active_pad >= 0 && !is_svideo) {
> > +			ret = -EBUSY;
> > +			goto out;
> > +		} else if (active_pad >= 0 && is_svideo &&
> > +			   pad_state[active_pad] ==
> > +			   TVP5150_PAD_ACTIVE_COMPOSITE) {
> > +			ret = -EBUSY;
> > +			goto out;
> > +		} else if (active_pad >= 0) {
> > +			/* check if 2nd svideo link is active too */
> > +			for (i = 0; i < TVP5150_NUM_PADS - 1; i++) {
> > +				if (pad_state[i] == TVP5150_PAD_ACTIVE_SVIDEO) {
> > +					if (i != active_pad) {
> > +						ret = -EBUSY;
> > +						goto out;
> > +					}
> > +				}
> > +			}
> > +		}
> 
> That may require some additional discussions.
> 
> I guess this is not the way it should be. I mean, it should be possible
> to change the routing while streaming, without disabling the video
> output. That's the behavior that TV generic applications like tvtime,
> xawtv, etc rely on.
> 
> So, probably, the right thing to do here is to disable the active_pad
> and  enable the newer one, if there is an active pad.
> 
> This way, it would work both if the userspace first disables the link
> and then enables a new one, or if it switches without explicitly
> disabling the previous one.

Okay I change this behaviour.

> 
> > +
> > +		dev_dbg(sd->dev, "Setting %d active [%s]\n", local->index,
> > +			is_svideo ? "svideo": "composite");
> > +		pad_state[local->index] = is_svideo ?
> > +			TVP5150_PAD_ACTIVE_SVIDEO : TVP5150_PAD_ACTIVE_COMPOSITE;
> > +
> > +		if (is_svideo) {
> > +			unsigned int active_link_cnt = 0;
> > +
> > +			/* enable svideo only if we have two active links */
> > +			for (i = 0; i > TVP5150_NUM_PADS - 1; i++)
> > +				if (pad_state[i] == TVP5150_PAD_ACTIVE_SVIDEO)
> > +					active_link_cnt++;
> > +			if (active_link_cnt == 2)
> > +				tvp5150_s_routing(sd, TVP5150_SVIDEO,
> > +						  TVP5150_NORMAL, 0);
> > +		} else {
> > +			tvp5150_s_routing(sd, local->index, TVP5150_NORMAL, 0);
> > +		}
> > +	} else {
> > +		/*
> > +		 * Svideo streams on two pads and user can disable AIP1A or
> > +		 * AIP1B first. So check only if user wants to disable a not
> > +		 * enabled composite pad.
> > +		 */
> > +		if (!is_svideo && active_pad != local->index)
> > +				goto out;
> > +
> > +		dev_dbg(sd->dev, "going inactive\n");
> > +		pad_state[local->index] = TVP5150_PAD_INACTIVE;
> > +
> > +		/*
> > +		 * Output black screen for deselected input if TVP5150 variant
> > +		 * supports this.
> > +		 */
> > +		if (is_svideo) {
> > +			unsigned int inactive_link_cnt = 0;
> > +
> > +			/* disable svideo only if we have two inactive links */
> > +			for (i = 0; i > TVP5150_NUM_PADS - 1; i++)
> > +				if (pad_state[i] == TVP5150_PAD_INACTIVE)
> > +					inactive_link_cnt++;
> > +			if (inactive_link_cnt == 2)
> > +				tvp5150_s_routing(sd, TVP5150_SVIDEO,
> > +						  TVP5150_BLACK_SCREEN, 0);
> > +
> > +		} else {
> > +			tvp5150_s_routing(sd, local->index,
> > +					  TVP5150_BLACK_SCREEN, 0);
> > +		}
> > +	}
> > +out:
> > +	return ret;
> > +}
> > +
> > +static const struct media_entity_operations tvp5150_sd_media_ops = {
> > +	.link_setup = tvp5150_link_setup,
> > +};
> > +#endif
> >  /****************************************************************************
> >  			I2C Command
> >   ****************************************************************************/
> > @@ -1315,6 +1466,50 @@ static int tvp5150_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
> >  	return 0;
> >  }
> >  
> > +static int tvp5150_registered(struct v4l2_subdev *sd)
> > +{
> > +#ifdef CONFIG_MEDIA_CONTROLLER
> > +	struct tvp5150 *decoder = to_tvp5150(sd);
> > +	unsigned int i;
> > +	int ret;
> > +
> > +	for (i = 0; i < decoder->connectors_num; i++) {
> > +		struct media_entity *con = &decoder->connectors[i].ent;
> > +		struct media_pad *pad = &decoder->connectors[i].pad;
> > +		unsigned int port = decoder->connectors[i].port_num;
> > +		bool is_svideo = decoder->connectors[i].is_svideo;
> > +
> > +		pad->flags = MEDIA_PAD_FL_SOURCE;
> > +		ret = media_entity_pads_init(con, 1, pad);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = media_device_register_entity(sd->v4l2_dev->mdev, con);
> > +		if (ret < 0)
> > +			return ret;
> > +
> > +		ret = media_create_pad_link(con, 0, &sd->entity, port, 0);
> > +		if (ret < 0) {
> > +			media_device_unregister_entity(con);
> > +			return ret;
> > +		}
> > +
> > +		if (is_svideo) {
> > +			/* svideo links to both aip1a and aip1b */
> > +			ret = media_create_pad_link(con, 0, &sd->entity,
> > +						    port + 1, 0);
> > +			if (ret < 0) {
> > +				media_device_unregister_entity(con);
> > +				return ret;
> > +			}
> > +		}
> > +
> > +	}
> 
> IMO, it should route to the first available connector.

Did you mean to set the link status to enabled? If so I have one
question else can you tell me what you mean?

Should I use the media_entity_setup_link() helper or should I mark it as
enabled during media_create_pad_link()? Now I did something like:

if (i == 0) {
	list_for_each_entry(link, &con->links, list) {
		media_entity_setup_link(link, MEDIA_LNK_FL_ENABLED);
	}
}

> 
> > +#endif
> > +	return 0;
> > +}
> > +
> > +
> >  /* ----------------------------------------------------------------------- */
> >  
> >  static const struct v4l2_ctrl_ops tvp5150_ctrl_ops = {
> > @@ -1368,6 +1563,10 @@ static const struct v4l2_subdev_ops tvp5150_ops = {
> >  	.pad = &tvp5150_pad_ops,
> >  };
> >  
> > +static const struct v4l2_subdev_internal_ops tvp5150_internal_ops = {
> > +	.registered = tvp5150_registered,
> > +};
> > +
> >  /****************************************************************************
> >  			I2C Client & Driver
> >   ****************************************************************************/
> > @@ -1516,38 +1715,186 @@ static int tvp5150_init(struct i2c_client *c)
> >  	return 0;
> >  }
> >  
> > -static int tvp5150_parse_dt(struct tvp5150 *decoder, struct device_node *np)
> > +static int tvp5150_mc_init(struct v4l2_subdev *sd)
> >  {
> > -	struct v4l2_fwnode_endpoint bus_cfg;
> > -	struct device_node *ep;
> > -	unsigned int flags;
> > -	int ret = 0;
> > +#if defined(CONFIG_MEDIA_CONTROLLER)
> > +	struct tvp5150 *decoder = to_tvp5150(sd);
> > +	struct device *dev = decoder->sd.dev;
> > +	unsigned int i;
> > +	int ret;
> >  
> > -	ep = of_graph_get_next_endpoint(np, NULL);
> > -	if (!ep)
> > -		return -EINVAL;
> > +	sd->entity.ops = &tvp5150_sd_media_ops;
> > +	sd->entity.function = MEDIA_ENT_F_ATV_DECODER;
> >  
> > -	ret = v4l2_fwnode_endpoint_parse(of_fwnode_handle(ep), &bus_cfg);
> > -	if (ret)
> > -		goto err;
> > +	/* Initialize all TVP5150 pads */
> > +	for (i = 0; i < TVP5150_NUM_PADS; i++) {
> > +		if (i < TVP5150_NUM_PADS - 1) {
> > +			decoder->pads[i].flags = MEDIA_PAD_FL_SINK;
> > +			decoder->pads[i].sig_type = PAD_SIGNAL_ANALOG;
> > +		} else {
> > +			decoder->pads[i].flags = MEDIA_PAD_FL_SOURCE;
> > +			decoder->pads[i].sig_type = PAD_SIGNAL_DV;
> > +		}
> > +	}
> > +	ret = media_entity_pads_init(&sd->entity, TVP5150_NUM_PADS,
> > +				     decoder->pads);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	/* in case of no oftree support */
> > +	if (!decoder->endpoints[0])
> > +		return 0;
> 
> Hmm...
> 
> > +
> > +	/* Allocate and initialize all available input connectors */
> > +	decoder->connectors = devm_kcalloc(dev, decoder->connectors_num,
> > +					   sizeof(*decoder->connectors),
> > +					   GFP_KERNEL);
> > +	if (!decoder->connectors)
> > +		return -ENOMEM;
> > +
> > +	for (i = 0; i < decoder->connectors_num; i++) {
> > +		struct device_node *rp;
> > +		struct of_endpoint ep;
> > +
> > +		rp = of_graph_get_remote_port_parent(decoder->endpoints[i]);
> > +		of_graph_parse_endpoint(decoder->endpoints[i], &ep);
> > +		decoder->connectors[i].port_num = ep.port;
> > +		decoder->connectors[i].is_svideo = !!of_device_is_compatible(rp,
> > +							    "svideo-connector");
> > +
> > +		if (decoder->connectors[i].is_svideo)
> > +			decoder->connectors[i].ent.function =
> > +						MEDIA_ENT_F_CONN_SVIDEO;
> > +		else
> > +			decoder->connectors[i].ent.function =
> > +						MEDIA_ENT_F_CONN_COMPOSITE;
> > +
> > +		decoder->connectors[i].ent.flags = MEDIA_ENT_FL_CONNECTOR;
> > +		ret = of_property_read_string(rp, "label",
> > +					      &decoder->connectors[i].ent.name);
> > +		if (ret < 0)
> > +			return ret;
> 
> I would prefer, instead, to have a separate routine for OF. I'll probably
> use something like the above for the non-DT devices (e. g. the ones using
> em28xx driver).

Okay, I refactored it.

> 
> > +	}
> > +#endif
> > +	return 0;
> > +}
> > +
> > +static bool tvp5150_valid_input(struct device_node *endpoint,
> > +				unsigned int port, unsigned int id)
> 
> Please call it as tvp5150_of_valid_input(). We may need something similar
> for devices based on em28xx (passing info via platform_data).

Okay, I changed it.

> 
> > +{
> > +	struct device_node *rp = of_graph_get_remote_port_parent(endpoint);
> > +	const char *input;
> > +	int ret;
> > +
> > +	/* perform some basic checks needed for later mc_init */
> > +	switch (port) {
> > +	case TVP5150_PAD_AIP1A:
> > +		/* svideo must be connected to endpoint@1  */
> > +		ret = id ? of_device_is_compatible(rp, "svideo-connector") :
> > +			   of_device_is_compatible(rp, "composite-video-connector");
> > +		if (!ret)
> > +			return false;
> > +		break;
> > +	case TVP5150_PAD_AIP1B:
> > +		ret = of_device_is_compatible(rp, "composite-video-connector");
> > +		if (!ret)
> > +			return false;
> > +		break;
> > +	}
> > +
> > +	ret = of_property_read_string(rp, "label", &input);
> > +	if (ret < 0)
> > +		return false;
> > +
> > +	return true;
> > +}
> >  
> > -	flags = bus_cfg.bus.parallel.flags;
> > +static int tvp5150_parse_dt(struct tvp5150 *decoder, struct device_node *np)
> > +{
> > +	struct device *dev = decoder->sd.dev;
> > +	struct v4l2_fwnode_endpoint bus_cfg;
> > +	struct device_node *ep_np;
> > +	unsigned int flags;
> > +	int ret, i = 0, in = 0;
> > +	bool found = false;
> >  
> > -	if (bus_cfg.bus_type == V4L2_MBUS_PARALLEL &&
> > -	    !(flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH &&
> > -	      flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH &&
> > -	      flags & V4L2_MBUS_FIELD_EVEN_LOW)) {
> > +	/* at least 1 output and 1 input */
> > +	decoder->endpoints_num = of_graph_get_endpoint_count(np);
> > +	if (decoder->endpoints_num < 2 || decoder->endpoints_num > 4) {
> >  		ret = -EINVAL;
> >  		goto err;
> >  	}
> >  
> > -	decoder->mbus_type = bus_cfg.bus_type;
> > +	for_each_endpoint_of_node(np, ep_np) {
> > +		struct of_endpoint ep;
> >  
> > +		of_graph_parse_endpoint(ep_np, &ep);
> > +		if (decoder->endpoints[i]) {
> > +			/* this should never happen */
> > +			dev_err(dev, "Invalid endpoint %pOF on port %d\n",
> > +				ep.local_node, ep.port);
> > +				ret = -EINVAL;
> > +				goto err;
> > +		}
> > +
> > +		switch (ep.port) {
> > +		case TVP5150_PAD_AIP1A:
> > +		case TVP5150_PAD_AIP1B:
> > +			if (!tvp5150_valid_input(ep_np, ep.port, ep.id)) {
> > +				dev_err(dev,
> > +					"Invalid endpoint %pOF on port %d\n",
> > +					ep.local_node, ep.port);
> > +				ret = -EINVAL;
> > +				goto err;
> > +			}
> > +			in++;
> > +			break;
> > +		case TVP5150_PAD_VID_OUT:
> > +			ret = v4l2_fwnode_endpoint_parse(of_fwnode_handle(ep_np),
> > +							 &bus_cfg);
> > +			if (ret)
> > +				goto err;
> > +
> > +			flags = bus_cfg.bus.parallel.flags;
> > +
> > +			if (bus_cfg.bus_type == V4L2_MBUS_PARALLEL &&
> > +			    !(flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH &&
> > +			      flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH &&
> > +			      flags & V4L2_MBUS_FIELD_EVEN_LOW)) {
> > +				ret = -EINVAL;
> > +				goto err;
> > +			}
> > +
> > +			decoder->mbus_type = bus_cfg.bus_type;
> > +			break;
> > +		default:
> > +			dev_err(dev, "Invalid port %d for endpoint %pOF\n",
> > +				ep.port, ep.local_node);
> > +			ret = -EINVAL;
> > +			goto err;
> > +		}
> > +
> > +		of_node_get(ep_np);
> > +		decoder->endpoints[i] = ep_np;
> > +		i++;
> > +
> > +		found = true;
> > +	}
> > +
> > +	decoder->connectors_num = in;
> > +	return found ? 0 : -ENODEV;
> >  err:
> > -	of_node_put(ep);
> >  	return ret;
> >  }
> >  
> > +static void tvp5150_dt_cleanup(struct tvp5150 *decoder)
> > +{
> > +	unsigned int i;
> > +
> > +	for (i = 0; i < TVP5150_NUM_PADS; i++)
> > +		of_node_put(decoder->endpoints[i]);
> > +}
> > +
> >  static const char * const tvp5150_test_patterns[2] = {
> >  	"Disabled",
> >  	"Black screen"
> > @@ -1586,7 +1933,7 @@ static int tvp5150_probe(struct i2c_client *c,
> >  		res = tvp5150_parse_dt(core, np);
> >  		if (res) {
> >  			dev_err(sd->dev, "DT parsing error: %d\n", res);
> > -			return res;
> > +			goto err_cleanup_dt;
> >  		}
> >  	} else {
> >  		/* Default to BT.656 embedded sync */
> > @@ -1594,25 +1941,16 @@ static int tvp5150_probe(struct i2c_client *c,
> >  	}
> >  
> >  	v4l2_i2c_subdev_init(sd, c, &tvp5150_ops);
> > +	sd->internal_ops = &tvp5150_internal_ops;
> >  	sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> >  
> > -#if defined(CONFIG_MEDIA_CONTROLLER)
> > -	core->pads[TVP5150_PAD_IF_INPUT].flags = MEDIA_PAD_FL_SINK;
> > -	core->pads[TVP5150_PAD_IF_INPUT].sig_type = PAD_SIGNAL_ANALOG;
> > -	core->pads[TVP5150_PAD_VID_OUT].flags = MEDIA_PAD_FL_SOURCE;
> > -	core->pads[TVP5150_PAD_VID_OUT].sig_type = PAD_SIGNAL_DV;
> > -
> > -	sd->entity.function = MEDIA_ENT_F_ATV_DECODER;
> > -
> > -	res = media_entity_pads_init(&sd->entity, TVP5150_NUM_PADS, core->pads);
> > -	if (res < 0)
> > -		return res;
> > -
> > -#endif
> > +	res = tvp5150_mc_init(sd);
> > +	if (res)
> > +		goto err_cleanup_dt;
> >  
> >  	res = tvp5150_detect_version(core);
> >  	if (res < 0)
> > -		return res;
> > +		goto err_cleanup_dt;
> >  
> >  	core->norm = V4L2_STD_ALL;	/* Default is autodetect */
> >  	core->detected_norm = V4L2_STD_UNKNOWN;
> > @@ -1664,6 +2002,9 @@ static int tvp5150_probe(struct i2c_client *c,
> >  err:
> >  	v4l2_ctrl_handler_free(&core->hdl);
> >  	return res;
> > +err_cleanup_dt:
> > +	tvp5150_dt_cleanup(core);
> > +	return res;
> >  }
> >  
> >  static int tvp5150_remove(struct i2c_client *c)
> 
> 
> 
> Thanks,
> Mauro

Regards,
Marco



[Index of Archives]     [Linux Input]     [Video for Linux]     [Gstreamer Embedded]     [Mplayer Users]     [Linux USB Devel]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [Yosemite Backpacking]

  Powered by Linux