Commit 15693b57 authored by Laurent Pinchart's avatar Laurent Pinchart Committed by Mauro Carvalho Chehab

[media] mt9p031: Replace the reset board callback by a GPIO number

Use the GPIO from the sensor driver instead of calling back to board
code.
Signed-off-by: default avatarLaurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 1c542ba8
...@@ -14,6 +14,7 @@ ...@@ -14,6 +14,7 @@
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/device.h> #include <linux/device.h>
#include <linux/gpio.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/i2c.h> #include <linux/i2c.h>
#include <linux/log2.h> #include <linux/log2.h>
...@@ -116,6 +117,7 @@ struct mt9p031 { ...@@ -116,6 +117,7 @@ struct mt9p031 {
enum mt9p031_model model; enum mt9p031_model model;
struct aptina_pll pll; struct aptina_pll pll;
int reset;
/* Registers cache */ /* Registers cache */
u16 output_control; u16 output_control;
...@@ -247,8 +249,8 @@ static inline int mt9p031_pll_disable(struct mt9p031 *mt9p031) ...@@ -247,8 +249,8 @@ static inline int mt9p031_pll_disable(struct mt9p031 *mt9p031)
static int mt9p031_power_on(struct mt9p031 *mt9p031) static int mt9p031_power_on(struct mt9p031 *mt9p031)
{ {
/* Ensure RESET_BAR is low */ /* Ensure RESET_BAR is low */
if (mt9p031->pdata->reset) { if (mt9p031->reset != -1) {
mt9p031->pdata->reset(&mt9p031->subdev, 1); gpio_set_value(mt9p031->reset, 0);
usleep_range(1000, 2000); usleep_range(1000, 2000);
} }
...@@ -258,8 +260,8 @@ static int mt9p031_power_on(struct mt9p031 *mt9p031) ...@@ -258,8 +260,8 @@ static int mt9p031_power_on(struct mt9p031 *mt9p031)
mt9p031->pdata->ext_freq); mt9p031->pdata->ext_freq);
/* Now RESET_BAR must be high */ /* Now RESET_BAR must be high */
if (mt9p031->pdata->reset) { if (mt9p031->reset != -1) {
mt9p031->pdata->reset(&mt9p031->subdev, 0); gpio_set_value(mt9p031->reset, 1);
usleep_range(1000, 2000); usleep_range(1000, 2000);
} }
...@@ -268,8 +270,8 @@ static int mt9p031_power_on(struct mt9p031 *mt9p031) ...@@ -268,8 +270,8 @@ static int mt9p031_power_on(struct mt9p031 *mt9p031)
static void mt9p031_power_off(struct mt9p031 *mt9p031) static void mt9p031_power_off(struct mt9p031 *mt9p031)
{ {
if (mt9p031->pdata->reset) { if (mt9p031->reset != -1) {
mt9p031->pdata->reset(&mt9p031->subdev, 1); gpio_set_value(mt9p031->reset, 0);
usleep_range(1000, 2000); usleep_range(1000, 2000);
} }
...@@ -849,6 +851,7 @@ static int mt9p031_probe(struct i2c_client *client, ...@@ -849,6 +851,7 @@ static int mt9p031_probe(struct i2c_client *client,
mt9p031->output_control = MT9P031_OUTPUT_CONTROL_DEF; mt9p031->output_control = MT9P031_OUTPUT_CONTROL_DEF;
mt9p031->mode2 = MT9P031_READ_MODE_2_ROW_BLC; mt9p031->mode2 = MT9P031_READ_MODE_2_ROW_BLC;
mt9p031->model = did->driver_data; mt9p031->model = did->driver_data;
mt9p031->reset = -1;
v4l2_ctrl_handler_init(&mt9p031->ctrls, ARRAY_SIZE(mt9p031_ctrls) + 4); v4l2_ctrl_handler_init(&mt9p031->ctrls, ARRAY_SIZE(mt9p031_ctrls) + 4);
...@@ -899,10 +902,22 @@ static int mt9p031_probe(struct i2c_client *client, ...@@ -899,10 +902,22 @@ static int mt9p031_probe(struct i2c_client *client,
mt9p031->format.field = V4L2_FIELD_NONE; mt9p031->format.field = V4L2_FIELD_NONE;
mt9p031->format.colorspace = V4L2_COLORSPACE_SRGB; mt9p031->format.colorspace = V4L2_COLORSPACE_SRGB;
if (pdata->reset != -1) {
ret = gpio_request_one(pdata->reset, GPIOF_OUT_INIT_LOW,
"mt9p031_rst");
if (ret < 0)
goto done;
mt9p031->reset = pdata->reset;
}
ret = mt9p031_pll_setup(mt9p031); ret = mt9p031_pll_setup(mt9p031);
done: done:
if (ret < 0) { if (ret < 0) {
if (mt9p031->reset != -1)
gpio_free(mt9p031->reset);
v4l2_ctrl_handler_free(&mt9p031->ctrls); v4l2_ctrl_handler_free(&mt9p031->ctrls);
media_entity_cleanup(&mt9p031->subdev.entity); media_entity_cleanup(&mt9p031->subdev.entity);
kfree(mt9p031); kfree(mt9p031);
...@@ -919,6 +934,8 @@ static int mt9p031_remove(struct i2c_client *client) ...@@ -919,6 +934,8 @@ static int mt9p031_remove(struct i2c_client *client)
v4l2_ctrl_handler_free(&mt9p031->ctrls); v4l2_ctrl_handler_free(&mt9p031->ctrls);
v4l2_device_unregister_subdev(subdev); v4l2_device_unregister_subdev(subdev);
media_entity_cleanup(&subdev->entity); media_entity_cleanup(&subdev->entity);
if (mt9p031->reset != -1)
gpio_free(mt9p031->reset);
kfree(mt9p031); kfree(mt9p031);
return 0; return 0;
......
...@@ -3,11 +3,18 @@ ...@@ -3,11 +3,18 @@
struct v4l2_subdev; struct v4l2_subdev;
/*
* struct mt9p031_platform_data - MT9P031 platform data
* @set_xclk: Clock frequency set callback
* @reset: Chip reset GPIO (set to -1 if not used)
* @ext_freq: Input clock frequency
* @target_freq: Pixel clock frequency
*/
struct mt9p031_platform_data { struct mt9p031_platform_data {
int (*set_xclk)(struct v4l2_subdev *subdev, int hz); int (*set_xclk)(struct v4l2_subdev *subdev, int hz);
int (*reset)(struct v4l2_subdev *subdev, int active); int reset;
int ext_freq; /* input frequency to the mt9p031 for PLL dividers */ int ext_freq;
int target_freq; /* frequency target for the PLL */ int target_freq;
}; };
#endif #endif
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment