Loading drivers/media/video/mt9p031.c +23 −6 Original line number Diff line number Diff line Loading @@ -14,6 +14,7 @@ #include <linux/delay.h> #include <linux/device.h> #include <linux/gpio.h> #include <linux/module.h> #include <linux/i2c.h> #include <linux/log2.h> Loading Loading @@ -116,6 +117,7 @@ struct mt9p031 { enum mt9p031_model model; struct aptina_pll pll; int reset; /* Registers cache */ u16 output_control; Loading Loading @@ -247,8 +249,8 @@ static inline int mt9p031_pll_disable(struct mt9p031 *mt9p031) static int mt9p031_power_on(struct mt9p031 *mt9p031) { /* Ensure RESET_BAR is low */ if (mt9p031->pdata->reset) { mt9p031->pdata->reset(&mt9p031->subdev, 1); if (mt9p031->reset != -1) { gpio_set_value(mt9p031->reset, 0); usleep_range(1000, 2000); } Loading @@ -258,8 +260,8 @@ static int mt9p031_power_on(struct mt9p031 *mt9p031) mt9p031->pdata->ext_freq); /* Now RESET_BAR must be high */ if (mt9p031->pdata->reset) { mt9p031->pdata->reset(&mt9p031->subdev, 0); if (mt9p031->reset != -1) { gpio_set_value(mt9p031->reset, 1); usleep_range(1000, 2000); } Loading @@ -268,8 +270,8 @@ static int mt9p031_power_on(struct mt9p031 *mt9p031) static void mt9p031_power_off(struct mt9p031 *mt9p031) { if (mt9p031->pdata->reset) { mt9p031->pdata->reset(&mt9p031->subdev, 1); if (mt9p031->reset != -1) { gpio_set_value(mt9p031->reset, 0); usleep_range(1000, 2000); } Loading Loading @@ -849,6 +851,7 @@ static int mt9p031_probe(struct i2c_client *client, mt9p031->output_control = MT9P031_OUTPUT_CONTROL_DEF; mt9p031->mode2 = MT9P031_READ_MODE_2_ROW_BLC; mt9p031->model = did->driver_data; mt9p031->reset = -1; v4l2_ctrl_handler_init(&mt9p031->ctrls, ARRAY_SIZE(mt9p031_ctrls) + 4); Loading Loading @@ -899,10 +902,22 @@ static int mt9p031_probe(struct i2c_client *client, mt9p031->format.field = V4L2_FIELD_NONE; 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); done: if (ret < 0) { if (mt9p031->reset != -1) gpio_free(mt9p031->reset); v4l2_ctrl_handler_free(&mt9p031->ctrls); media_entity_cleanup(&mt9p031->subdev.entity); kfree(mt9p031); Loading @@ -919,6 +934,8 @@ static int mt9p031_remove(struct i2c_client *client) v4l2_ctrl_handler_free(&mt9p031->ctrls); v4l2_device_unregister_subdev(subdev); media_entity_cleanup(&subdev->entity); if (mt9p031->reset != -1) gpio_free(mt9p031->reset); kfree(mt9p031); return 0; Loading include/media/mt9p031.h +10 −3 Original line number Diff line number Diff line Loading @@ -3,11 +3,18 @@ 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 { int (*set_xclk)(struct v4l2_subdev *subdev, int hz); int (*reset)(struct v4l2_subdev *subdev, int active); int ext_freq; /* input frequency to the mt9p031 for PLL dividers */ int target_freq; /* frequency target for the PLL */ int reset; int ext_freq; int target_freq; }; #endif Loading
drivers/media/video/mt9p031.c +23 −6 Original line number Diff line number Diff line Loading @@ -14,6 +14,7 @@ #include <linux/delay.h> #include <linux/device.h> #include <linux/gpio.h> #include <linux/module.h> #include <linux/i2c.h> #include <linux/log2.h> Loading Loading @@ -116,6 +117,7 @@ struct mt9p031 { enum mt9p031_model model; struct aptina_pll pll; int reset; /* Registers cache */ u16 output_control; Loading Loading @@ -247,8 +249,8 @@ static inline int mt9p031_pll_disable(struct mt9p031 *mt9p031) static int mt9p031_power_on(struct mt9p031 *mt9p031) { /* Ensure RESET_BAR is low */ if (mt9p031->pdata->reset) { mt9p031->pdata->reset(&mt9p031->subdev, 1); if (mt9p031->reset != -1) { gpio_set_value(mt9p031->reset, 0); usleep_range(1000, 2000); } Loading @@ -258,8 +260,8 @@ static int mt9p031_power_on(struct mt9p031 *mt9p031) mt9p031->pdata->ext_freq); /* Now RESET_BAR must be high */ if (mt9p031->pdata->reset) { mt9p031->pdata->reset(&mt9p031->subdev, 0); if (mt9p031->reset != -1) { gpio_set_value(mt9p031->reset, 1); usleep_range(1000, 2000); } Loading @@ -268,8 +270,8 @@ static int mt9p031_power_on(struct mt9p031 *mt9p031) static void mt9p031_power_off(struct mt9p031 *mt9p031) { if (mt9p031->pdata->reset) { mt9p031->pdata->reset(&mt9p031->subdev, 1); if (mt9p031->reset != -1) { gpio_set_value(mt9p031->reset, 0); usleep_range(1000, 2000); } Loading Loading @@ -849,6 +851,7 @@ static int mt9p031_probe(struct i2c_client *client, mt9p031->output_control = MT9P031_OUTPUT_CONTROL_DEF; mt9p031->mode2 = MT9P031_READ_MODE_2_ROW_BLC; mt9p031->model = did->driver_data; mt9p031->reset = -1; v4l2_ctrl_handler_init(&mt9p031->ctrls, ARRAY_SIZE(mt9p031_ctrls) + 4); Loading Loading @@ -899,10 +902,22 @@ static int mt9p031_probe(struct i2c_client *client, mt9p031->format.field = V4L2_FIELD_NONE; 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); done: if (ret < 0) { if (mt9p031->reset != -1) gpio_free(mt9p031->reset); v4l2_ctrl_handler_free(&mt9p031->ctrls); media_entity_cleanup(&mt9p031->subdev.entity); kfree(mt9p031); Loading @@ -919,6 +934,8 @@ static int mt9p031_remove(struct i2c_client *client) v4l2_ctrl_handler_free(&mt9p031->ctrls); v4l2_device_unregister_subdev(subdev); media_entity_cleanup(&subdev->entity); if (mt9p031->reset != -1) gpio_free(mt9p031->reset); kfree(mt9p031); return 0; Loading
include/media/mt9p031.h +10 −3 Original line number Diff line number Diff line Loading @@ -3,11 +3,18 @@ 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 { int (*set_xclk)(struct v4l2_subdev *subdev, int hz); int (*reset)(struct v4l2_subdev *subdev, int active); int ext_freq; /* input frequency to the mt9p031 for PLL dividers */ int target_freq; /* frequency target for the PLL */ int reset; int ext_freq; int target_freq; }; #endif