[media] media: ov2640: add primary dt support
Add device tree support for ov2640. In device tree, user needs to provide the master clock (xvclk). User can add the reset/pwdn pins if they have. Cc: devicetree@vger.kernel.org Signed-off-by: Josh Wu <josh.wu@atmel.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de> Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>
This commit is contained in:
parent
87838addf6
commit
4e65172f7b
|
@ -18,6 +18,8 @@
|
|||
#include <linux/i2c.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/gpio.h>
|
||||
#include <linux/of_gpio.h>
|
||||
#include <linux/v4l2-mediabus.h>
|
||||
#include <linux/videodev2.h>
|
||||
|
||||
|
@ -283,6 +285,10 @@ struct ov2640_priv {
|
|||
u32 cfmt_code;
|
||||
struct v4l2_clk *clk;
|
||||
const struct ov2640_win_size *win;
|
||||
|
||||
struct soc_camera_subdev_desc ssdd_dt;
|
||||
struct gpio_desc *resetb_gpio;
|
||||
struct gpio_desc *pwdn_gpio;
|
||||
};
|
||||
|
||||
/*
|
||||
|
@ -1038,6 +1044,63 @@ static struct v4l2_subdev_ops ov2640_subdev_ops = {
|
|||
.video = &ov2640_subdev_video_ops,
|
||||
};
|
||||
|
||||
/* OF probe functions */
|
||||
static int ov2640_hw_power(struct device *dev, int on)
|
||||
{
|
||||
struct i2c_client *client = to_i2c_client(dev);
|
||||
struct ov2640_priv *priv = to_ov2640(client);
|
||||
|
||||
dev_dbg(&client->dev, "%s: %s the camera\n",
|
||||
__func__, on ? "ENABLE" : "DISABLE");
|
||||
|
||||
if (priv->pwdn_gpio)
|
||||
gpiod_direction_output(priv->pwdn_gpio, !on);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ov2640_hw_reset(struct device *dev)
|
||||
{
|
||||
struct i2c_client *client = to_i2c_client(dev);
|
||||
struct ov2640_priv *priv = to_ov2640(client);
|
||||
|
||||
if (priv->resetb_gpio) {
|
||||
/* Active the resetb pin to perform a reset pulse */
|
||||
gpiod_direction_output(priv->resetb_gpio, 1);
|
||||
usleep_range(3000, 5000);
|
||||
gpiod_direction_output(priv->resetb_gpio, 0);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ov2640_probe_dt(struct i2c_client *client,
|
||||
struct ov2640_priv *priv)
|
||||
{
|
||||
/* Request the reset GPIO deasserted */
|
||||
priv->resetb_gpio = devm_gpiod_get_optional(&client->dev, "resetb",
|
||||
GPIOD_OUT_LOW);
|
||||
if (!priv->resetb_gpio)
|
||||
dev_dbg(&client->dev, "resetb gpio is not assigned!\n");
|
||||
else if (IS_ERR(priv->resetb_gpio))
|
||||
return PTR_ERR(priv->resetb_gpio);
|
||||
|
||||
/* Request the power down GPIO asserted */
|
||||
priv->pwdn_gpio = devm_gpiod_get_optional(&client->dev, "pwdn",
|
||||
GPIOD_OUT_HIGH);
|
||||
if (!priv->pwdn_gpio)
|
||||
dev_dbg(&client->dev, "pwdn gpio is not assigned!\n");
|
||||
else if (IS_ERR(priv->pwdn_gpio))
|
||||
return PTR_ERR(priv->pwdn_gpio);
|
||||
|
||||
/* Initialize the soc_camera_subdev_desc */
|
||||
priv->ssdd_dt.power = ov2640_hw_power;
|
||||
priv->ssdd_dt.reset = ov2640_hw_reset;
|
||||
client->dev.platform_data = &priv->ssdd_dt;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* i2c_driver functions
|
||||
*/
|
||||
|
@ -1049,12 +1112,6 @@ static int ov2640_probe(struct i2c_client *client,
|
|||
struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent);
|
||||
int ret;
|
||||
|
||||
if (!ssdd) {
|
||||
dev_err(&adapter->dev,
|
||||
"OV2640: Missing platform_data for driver\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
|
||||
dev_err(&adapter->dev,
|
||||
"OV2640: I2C-Adapter doesn't support SMBUS\n");
|
||||
|
@ -1068,10 +1125,22 @@ static int ov2640_probe(struct i2c_client *client,
|
|||
return -ENOMEM;
|
||||
}
|
||||
|
||||
priv->clk = v4l2_clk_get(&client->dev, "mclk");
|
||||
priv->clk = v4l2_clk_get(&client->dev, "xvclk");
|
||||
if (IS_ERR(priv->clk))
|
||||
return -EPROBE_DEFER;
|
||||
|
||||
if (!ssdd && !client->dev.of_node) {
|
||||
dev_err(&client->dev, "Missing platform_data for driver\n");
|
||||
ret = -EINVAL;
|
||||
goto err_clk;
|
||||
}
|
||||
|
||||
if (!ssdd) {
|
||||
ret = ov2640_probe_dt(client, priv);
|
||||
if (ret)
|
||||
goto err_clk;
|
||||
}
|
||||
|
||||
v4l2_i2c_subdev_init(&priv->subdev, client, &ov2640_subdev_ops);
|
||||
v4l2_ctrl_handler_init(&priv->hdl, 2);
|
||||
v4l2_ctrl_new_std(&priv->hdl, &ov2640_ctrl_ops,
|
||||
|
@ -1120,9 +1189,16 @@ static const struct i2c_device_id ov2640_id[] = {
|
|||
};
|
||||
MODULE_DEVICE_TABLE(i2c, ov2640_id);
|
||||
|
||||
static const struct of_device_id ov2640_of_match[] = {
|
||||
{.compatible = "ovti,ov2640", },
|
||||
{},
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, ov2640_of_match);
|
||||
|
||||
static struct i2c_driver ov2640_i2c_driver = {
|
||||
.driver = {
|
||||
.name = "ov2640",
|
||||
.of_match_table = of_match_ptr(ov2640_of_match),
|
||||
},
|
||||
.probe = ov2640_probe,
|
||||
.remove = ov2640_remove,
|
||||
|
|
Loading…
Reference in a new issue