|
@@ -39,6 +39,7 @@
|
|
|
#include <media/v4l2-device.h>
|
|
|
#include <media/v4l2-common.h>
|
|
|
#include <media/v4l2-mediabus.h>
|
|
|
+#include <media/v4l2-of.h>
|
|
|
#include <media/v4l2-ctrls.h>
|
|
|
#include <media/tvp514x.h>
|
|
|
#include <media/media-entity.h>
|
|
@@ -1056,6 +1057,42 @@ static struct tvp514x_decoder tvp514x_dev = {
|
|
|
|
|
|
};
|
|
|
|
|
|
+static struct tvp514x_platform_data *
|
|
|
+tvp514x_get_pdata(struct i2c_client *client)
|
|
|
+{
|
|
|
+ struct tvp514x_platform_data *pdata;
|
|
|
+ struct v4l2_of_endpoint bus_cfg;
|
|
|
+ struct device_node *endpoint;
|
|
|
+ unsigned int flags;
|
|
|
+
|
|
|
+ if (!IS_ENABLED(CONFIG_OF) || !client->dev.of_node)
|
|
|
+ return client->dev.platform_data;
|
|
|
+
|
|
|
+ endpoint = v4l2_of_get_next_endpoint(client->dev.of_node, NULL);
|
|
|
+ if (!endpoint)
|
|
|
+ return NULL;
|
|
|
+
|
|
|
+ pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
|
|
|
+ if (!pdata)
|
|
|
+ goto done;
|
|
|
+
|
|
|
+ v4l2_of_parse_endpoint(endpoint, &bus_cfg);
|
|
|
+ flags = bus_cfg.bus.parallel.flags;
|
|
|
+
|
|
|
+ if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH)
|
|
|
+ pdata->hs_polarity = 1;
|
|
|
+
|
|
|
+ if (flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH)
|
|
|
+ pdata->vs_polarity = 1;
|
|
|
+
|
|
|
+ if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING)
|
|
|
+ pdata->clk_polarity = 1;
|
|
|
+
|
|
|
+done:
|
|
|
+ of_node_put(endpoint);
|
|
|
+ return pdata;
|
|
|
+}
|
|
|
+
|
|
|
/**
|
|
|
* tvp514x_probe() - decoder driver i2c probe handler
|
|
|
* @client: i2c driver client device structure
|
|
@@ -1067,19 +1104,20 @@ static struct tvp514x_decoder tvp514x_dev = {
|
|
|
static int
|
|
|
tvp514x_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|
|
{
|
|
|
+ struct tvp514x_platform_data *pdata = tvp514x_get_pdata(client);
|
|
|
struct tvp514x_decoder *decoder;
|
|
|
struct v4l2_subdev *sd;
|
|
|
int ret;
|
|
|
|
|
|
+ if (pdata == NULL) {
|
|
|
+ dev_err(&client->dev, "No platform data\n");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
/* Check if the adapter supports the needed features */
|
|
|
if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
|
|
|
return -EIO;
|
|
|
|
|
|
- if (!client->dev.platform_data) {
|
|
|
- v4l2_err(client, "No platform data!!\n");
|
|
|
- return -ENODEV;
|
|
|
- }
|
|
|
-
|
|
|
decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL);
|
|
|
if (!decoder)
|
|
|
return -ENOMEM;
|
|
@@ -1091,7 +1129,7 @@ tvp514x_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|
|
sizeof(tvp514x_reg_list_default));
|
|
|
|
|
|
/* Copy board specific information here */
|
|
|
- decoder->pdata = client->dev.platform_data;
|
|
|
+ decoder->pdata = pdata;
|
|
|
|
|
|
/**
|
|
|
* Fetch platform specific data, and configure the
|
|
@@ -1231,8 +1269,20 @@ static const struct i2c_device_id tvp514x_id[] = {
|
|
|
|
|
|
MODULE_DEVICE_TABLE(i2c, tvp514x_id);
|
|
|
|
|
|
+#if IS_ENABLED(CONFIG_OF)
|
|
|
+static const struct of_device_id tvp514x_of_match[] = {
|
|
|
+ { .compatible = "ti,tvp5146", },
|
|
|
+ { .compatible = "ti,tvp5146m2", },
|
|
|
+ { .compatible = "ti,tvp5147", },
|
|
|
+ { .compatible = "ti,tvp5147m1", },
|
|
|
+ { /* sentinel */ },
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(of, tvp514x_of_match);
|
|
|
+#endif
|
|
|
+
|
|
|
static struct i2c_driver tvp514x_driver = {
|
|
|
.driver = {
|
|
|
+ .of_match_table = of_match_ptr(tvp514x_of_match),
|
|
|
.owner = THIS_MODULE,
|
|
|
.name = TVP514X_MODULE_NAME,
|
|
|
},
|