|
@@ -35,6 +35,8 @@
|
|
|
#include <media/v4l2-device.h>
|
|
|
#include <media/v4l2-common.h>
|
|
|
#include <media/v4l2-ctrls.h>
|
|
|
+#include <media/v4l2-of.h>
|
|
|
+
|
|
|
#include "tvp7002_reg.h"
|
|
|
|
|
|
MODULE_DESCRIPTION("TI TVP7002 Video and Graphics Digitizer driver");
|
|
@@ -943,6 +945,48 @@ static const struct v4l2_subdev_ops tvp7002_ops = {
|
|
|
.pad = &tvp7002_pad_ops,
|
|
|
};
|
|
|
|
|
|
+static struct tvp7002_config *
|
|
|
+tvp7002_get_pdata(struct i2c_client *client)
|
|
|
+{
|
|
|
+ struct v4l2_of_endpoint bus_cfg;
|
|
|
+ struct tvp7002_config *pdata;
|
|
|
+ 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;
|
|
|
+
|
|
|
+ if (flags & V4L2_MBUS_FIELD_EVEN_HIGH)
|
|
|
+ pdata->fid_polarity = 1;
|
|
|
+
|
|
|
+ if (flags & V4L2_MBUS_VIDEO_SOG_ACTIVE_HIGH)
|
|
|
+ pdata->sog_polarity = 1;
|
|
|
+
|
|
|
+done:
|
|
|
+ of_node_put(endpoint);
|
|
|
+ return pdata;
|
|
|
+}
|
|
|
+
|
|
|
/*
|
|
|
* tvp7002_probe - Probe a TVP7002 device
|
|
|
* @c: ptr to i2c_client struct
|
|
@@ -954,32 +998,32 @@ static const struct v4l2_subdev_ops tvp7002_ops = {
|
|
|
*/
|
|
|
static int tvp7002_probe(struct i2c_client *c, const struct i2c_device_id *id)
|
|
|
{
|
|
|
+ struct tvp7002_config *pdata = tvp7002_get_pdata(c);
|
|
|
struct v4l2_subdev *sd;
|
|
|
struct tvp7002 *device;
|
|
|
struct v4l2_dv_timings timings;
|
|
|
int polarity_a;
|
|
|
int polarity_b;
|
|
|
u8 revision;
|
|
|
-
|
|
|
int error;
|
|
|
|
|
|
+ if (pdata == NULL) {
|
|
|
+ dev_err(&c->dev, "No platform data\n");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
/* Check if the adapter supports the needed features */
|
|
|
if (!i2c_check_functionality(c->adapter,
|
|
|
I2C_FUNC_SMBUS_READ_BYTE | I2C_FUNC_SMBUS_WRITE_BYTE_DATA))
|
|
|
return -EIO;
|
|
|
|
|
|
- if (!c->dev.platform_data) {
|
|
|
- v4l_err(c, "No platform data!!\n");
|
|
|
- return -ENODEV;
|
|
|
- }
|
|
|
-
|
|
|
device = devm_kzalloc(&c->dev, sizeof(struct tvp7002), GFP_KERNEL);
|
|
|
|
|
|
if (!device)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
sd = &device->sd;
|
|
|
- device->pdata = c->dev.platform_data;
|
|
|
+ device->pdata = pdata;
|
|
|
device->current_timings = tvp7002_timings;
|
|
|
|
|
|
/* Tell v4l2 the device is ready */
|
|
@@ -1084,9 +1128,18 @@ static const struct i2c_device_id tvp7002_id[] = {
|
|
|
};
|
|
|
MODULE_DEVICE_TABLE(i2c, tvp7002_id);
|
|
|
|
|
|
+#if IS_ENABLED(CONFIG_OF)
|
|
|
+static const struct of_device_id tvp7002_of_match[] = {
|
|
|
+ { .compatible = "ti,tvp7002", },
|
|
|
+ { /* sentinel */ },
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(of, tvp7002_of_match);
|
|
|
+#endif
|
|
|
+
|
|
|
/* I2C driver data */
|
|
|
static struct i2c_driver tvp7002_driver = {
|
|
|
.driver = {
|
|
|
+ .of_match_table = of_match_ptr(tvp7002_of_match),
|
|
|
.owner = THIS_MODULE,
|
|
|
.name = TVP7002_MODULE_NAME,
|
|
|
},
|