media: v4l2-fwnode: add initial connector parsing support
The patch adds the initial connector parsing code, so we can move from a driver specific parsing code to a generic one. Currently only the generic fields and the analog-connector specific fields are parsed. Parsing the other connector specific fields can be added by a simple callbacks. Signed-off-by: Marco Felsch <m.felsch@pengutronix.de> [hverkuil-cisco@xs4all.nl: replace ; with break; in a empty case] Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>alistair/sensors
Marco Felsch
Mauro Carvalho Chehab
parent
a5e1deec4e
commit
dfc22c073b
|
|
@ -591,6 +591,171 @@ void v4l2_fwnode_put_link(struct v4l2_fwnode_link *link)
|
|||
}
|
||||
EXPORT_SYMBOL_GPL(v4l2_fwnode_put_link);
|
||||
|
||||
static const struct v4l2_fwnode_connector_conv {
|
||||
enum v4l2_connector_type type;
|
||||
const char *compatible;
|
||||
} connectors[] = {
|
||||
{
|
||||
.type = V4L2_CONN_COMPOSITE,
|
||||
.compatible = "composite-video-connector",
|
||||
}, {
|
||||
.type = V4L2_CONN_SVIDEO,
|
||||
.compatible = "svideo-connector",
|
||||
},
|
||||
};
|
||||
|
||||
static enum v4l2_connector_type
|
||||
v4l2_fwnode_string_to_connector_type(const char *con_str)
|
||||
{
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(connectors); i++)
|
||||
if (!strcmp(con_str, connectors[i].compatible))
|
||||
return connectors[i].type;
|
||||
|
||||
return V4L2_CONN_UNKNOWN;
|
||||
}
|
||||
|
||||
static void
|
||||
v4l2_fwnode_connector_parse_analog(struct fwnode_handle *fwnode,
|
||||
struct v4l2_fwnode_connector *vc)
|
||||
{
|
||||
u32 stds;
|
||||
int ret;
|
||||
|
||||
ret = fwnode_property_read_u32(fwnode, "sdtv-standards", &stds);
|
||||
|
||||
/* The property is optional. */
|
||||
vc->connector.analog.sdtv_stds = ret ? V4L2_STD_ALL : stds;
|
||||
}
|
||||
|
||||
void v4l2_fwnode_connector_free(struct v4l2_fwnode_connector *connector)
|
||||
{
|
||||
struct v4l2_connector_link *link, *tmp;
|
||||
|
||||
if (IS_ERR_OR_NULL(connector) || connector->type == V4L2_CONN_UNKNOWN)
|
||||
return;
|
||||
|
||||
list_for_each_entry_safe(link, tmp, &connector->links, head) {
|
||||
v4l2_fwnode_put_link(&link->fwnode_link);
|
||||
list_del(&link->head);
|
||||
kfree(link);
|
||||
}
|
||||
|
||||
kfree(connector->label);
|
||||
connector->label = NULL;
|
||||
connector->type = V4L2_CONN_UNKNOWN;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(v4l2_fwnode_connector_free);
|
||||
|
||||
static enum v4l2_connector_type
|
||||
v4l2_fwnode_get_connector_type(struct fwnode_handle *fwnode)
|
||||
{
|
||||
const char *type_name;
|
||||
int err;
|
||||
|
||||
if (!fwnode)
|
||||
return V4L2_CONN_UNKNOWN;
|
||||
|
||||
/* The connector-type is stored within the compatible string. */
|
||||
err = fwnode_property_read_string(fwnode, "compatible", &type_name);
|
||||
if (err)
|
||||
return V4L2_CONN_UNKNOWN;
|
||||
|
||||
return v4l2_fwnode_string_to_connector_type(type_name);
|
||||
}
|
||||
|
||||
int v4l2_fwnode_connector_parse(struct fwnode_handle *fwnode,
|
||||
struct v4l2_fwnode_connector *connector)
|
||||
{
|
||||
struct fwnode_handle *connector_node;
|
||||
enum v4l2_connector_type connector_type;
|
||||
const char *label;
|
||||
int err;
|
||||
|
||||
if (!fwnode)
|
||||
return -EINVAL;
|
||||
|
||||
memset(connector, 0, sizeof(*connector));
|
||||
|
||||
INIT_LIST_HEAD(&connector->links);
|
||||
|
||||
connector_node = fwnode_graph_get_port_parent(fwnode);
|
||||
connector_type = v4l2_fwnode_get_connector_type(connector_node);
|
||||
if (connector_type == V4L2_CONN_UNKNOWN) {
|
||||
fwnode_handle_put(connector_node);
|
||||
connector_node = fwnode_graph_get_remote_port_parent(fwnode);
|
||||
connector_type = v4l2_fwnode_get_connector_type(connector_node);
|
||||
}
|
||||
|
||||
if (connector_type == V4L2_CONN_UNKNOWN) {
|
||||
pr_err("Unknown connector type\n");
|
||||
err = -ENOTCONN;
|
||||
goto out;
|
||||
}
|
||||
|
||||
connector->type = connector_type;
|
||||
connector->name = fwnode_get_name(connector_node);
|
||||
err = fwnode_property_read_string(connector_node, "label", &label);
|
||||
connector->label = err ? NULL : kstrdup_const(label, GFP_KERNEL);
|
||||
|
||||
/* Parse the connector specific properties. */
|
||||
switch (connector->type) {
|
||||
case V4L2_CONN_COMPOSITE:
|
||||
case V4L2_CONN_SVIDEO:
|
||||
v4l2_fwnode_connector_parse_analog(connector_node, connector);
|
||||
break;
|
||||
/* Avoid compiler warnings */
|
||||
case V4L2_CONN_UNKNOWN:
|
||||
break;
|
||||
}
|
||||
|
||||
out:
|
||||
fwnode_handle_put(connector_node);
|
||||
|
||||
return err;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(v4l2_fwnode_connector_parse);
|
||||
|
||||
int v4l2_fwnode_connector_add_link(struct fwnode_handle *fwnode,
|
||||
struct v4l2_fwnode_connector *connector)
|
||||
{
|
||||
struct fwnode_handle *connector_ep;
|
||||
struct v4l2_connector_link *link;
|
||||
int err;
|
||||
|
||||
if (!fwnode || !connector || connector->type == V4L2_CONN_UNKNOWN)
|
||||
return -EINVAL;
|
||||
|
||||
connector_ep = fwnode_graph_get_remote_endpoint(fwnode);
|
||||
if (!connector_ep)
|
||||
return -ENOTCONN;
|
||||
|
||||
link = kzalloc(sizeof(*link), GFP_KERNEL);
|
||||
if (!link) {
|
||||
err = -ENOMEM;
|
||||
goto err;
|
||||
}
|
||||
|
||||
err = v4l2_fwnode_parse_link(connector_ep, &link->fwnode_link);
|
||||
if (err)
|
||||
goto err;
|
||||
|
||||
fwnode_handle_put(connector_ep);
|
||||
|
||||
list_add(&link->head, &connector->links);
|
||||
connector->nr_of_links++;
|
||||
|
||||
return 0;
|
||||
|
||||
err:
|
||||
kfree(link);
|
||||
fwnode_handle_put(connector_ep);
|
||||
|
||||
return err;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(v4l2_fwnode_connector_add_link);
|
||||
|
||||
static int
|
||||
v4l2_async_notifier_fwnode_parse_endpoint(struct device *dev,
|
||||
struct v4l2_async_notifier *notifier,
|
||||
|
|
|
|||
|
|
@ -294,6 +294,66 @@ int v4l2_fwnode_parse_link(struct fwnode_handle *fwnode,
|
|||
*/
|
||||
void v4l2_fwnode_put_link(struct v4l2_fwnode_link *link);
|
||||
|
||||
/**
|
||||
* v4l2_fwnode_connector_free() - free the V4L2 connector acquired memory
|
||||
* @connector: the V4L2 connector resources of which are to be released
|
||||
*
|
||||
* Free all allocated memory and put all links acquired by
|
||||
* v4l2_fwnode_connector_parse() and v4l2_fwnode_connector_add_link().
|
||||
*
|
||||
* It is safe to call this function with NULL argument or on a V4L2 connector
|
||||
* the parsing of which failed.
|
||||
*/
|
||||
void v4l2_fwnode_connector_free(struct v4l2_fwnode_connector *connector);
|
||||
|
||||
/**
|
||||
* v4l2_fwnode_connector_parse() - initialize the 'struct v4l2_fwnode_connector'
|
||||
* @fwnode: pointer to the subdev endpoint's fwnode handle where the connector
|
||||
* is connected to or to the connector endpoint fwnode handle.
|
||||
* @connector: pointer to the V4L2 fwnode connector data structure
|
||||
*
|
||||
* Fill the &struct v4l2_fwnode_connector with the connector type, label and
|
||||
* all &enum v4l2_connector_type specific connector data. The label is optional
|
||||
* so it is set to %NULL if no one was found. The function initialize the links
|
||||
* to zero. Adding links to the connector is done by calling
|
||||
* v4l2_fwnode_connector_add_link().
|
||||
*
|
||||
* The memory allocated for the label must be freed when no longer needed.
|
||||
* Freeing the memory is done by v4l2_fwnode_connector_free().
|
||||
*
|
||||
* Return:
|
||||
* * %0 on success or a negative error code on failure:
|
||||
* * %-EINVAL if @fwnode is invalid
|
||||
* * %-ENOTCONN if connector type is unknown or connector device can't be found
|
||||
*/
|
||||
int v4l2_fwnode_connector_parse(struct fwnode_handle *fwnode,
|
||||
struct v4l2_fwnode_connector *connector);
|
||||
|
||||
/**
|
||||
* v4l2_fwnode_connector_add_link - add a link between a connector node and
|
||||
* a v4l2-subdev node.
|
||||
* @fwnode: pointer to the subdev endpoint's fwnode handle where the connector
|
||||
* is connected to
|
||||
* @connector: pointer to the V4L2 fwnode connector data structure
|
||||
*
|
||||
* Add a new &struct v4l2_connector_link link to the
|
||||
* &struct v4l2_fwnode_connector connector links list. The link local_node
|
||||
* points to the connector node, the remote_node to the host v4l2 (sub)dev.
|
||||
*
|
||||
* The taken references to remote_node and local_node must be dropped and the
|
||||
* allocated memory must be freed when no longer needed. Both is done by calling
|
||||
* v4l2_fwnode_connector_free().
|
||||
*
|
||||
* Return:
|
||||
* * %0 on success or a negative error code on failure:
|
||||
* * %-EINVAL if @fwnode or @connector is invalid or @connector type is unknown
|
||||
* * %-ENOMEM on link memory allocation failure
|
||||
* * %-ENOTCONN if remote connector device can't be found
|
||||
* * %-ENOLINK if link parsing between v4l2 (sub)dev and connector fails
|
||||
*/
|
||||
int v4l2_fwnode_connector_add_link(struct fwnode_handle *fwnode,
|
||||
struct v4l2_fwnode_connector *connector);
|
||||
|
||||
/**
|
||||
* typedef parse_endpoint_func - Driver's callback function to be called on
|
||||
* each V4L2 fwnode endpoint.
|
||||
|
|
@ -467,4 +527,26 @@ v4l2_async_register_fwnode_subdev(struct v4l2_subdev *sd,
|
|||
unsigned int num_ports,
|
||||
parse_endpoint_func parse_endpoint);
|
||||
|
||||
/* Helper macros to access the connector links. */
|
||||
|
||||
/** v4l2_connector_last_link - Helper macro to get the first
|
||||
* &struct v4l2_fwnode_connector link
|
||||
* @v4l2c: &struct v4l2_fwnode_connector owning the connector links
|
||||
*
|
||||
* This marco returns the first added &struct v4l2_connector_link connector
|
||||
* link or @NULL if the connector has no links.
|
||||
*/
|
||||
#define v4l2_connector_first_link(v4l2c) \
|
||||
list_first_entry_or_null(&(v4l2c)->links, \
|
||||
struct v4l2_connector_link, head)
|
||||
|
||||
/** v4l2_connector_last_link - Helper macro to get the last
|
||||
* &struct v4l2_fwnode_connector link
|
||||
* @v4l2c: &struct v4l2_fwnode_connector owning the connector links
|
||||
*
|
||||
* This marco returns the last &struct v4l2_connector_link added connector link.
|
||||
*/
|
||||
#define v4l2_connector_last_link(v4l2c) \
|
||||
list_last_entry(&(v4l2c)->links, struct v4l2_connector_link, head)
|
||||
|
||||
#endif /* _V4L2_FWNODE_H */
|
||||
|
|
|
|||
Loading…
Reference in New Issue