Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 306552
b: refs/heads/master
c: 2547428
h: refs/heads/master
v: v3
  • Loading branch information
Sakari Ailus authored and Mauro Carvalho Chehab committed May 20, 2012
1 parent 8306725 commit 24caaa7
Show file tree
Hide file tree
Showing 4 changed files with 51 additions and 8 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: 13c6a9f706d21fa02495f31b3bbd3ae4d42d108f
refs/heads/master: 2547428de05d5bc45d3144a0ebc51e3f249a2bc0
55 changes: 48 additions & 7 deletions trunk/drivers/media/video/smiapp/smiapp-core.c
Original file line number Diff line number Diff line change
Expand Up @@ -26,6 +26,7 @@
*
*/

#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/gpio.h>
Expand Down Expand Up @@ -1111,8 +1112,11 @@ static int smiapp_power_on(struct smiapp_sensor *sensor)
}
usleep_range(1000, 1000);

rval = sensor->platform_data->set_xclk(&sensor->src->sd,
sensor->platform_data->ext_clk);
if (sensor->platform_data->set_xclk)
rval = sensor->platform_data->set_xclk(
&sensor->src->sd, sensor->platform_data->ext_clk);
else
rval = clk_enable(sensor->ext_clk);
if (rval < 0) {
dev_dbg(&client->dev, "failed to set xclk\n");
goto out_xclk_fail;
Expand Down Expand Up @@ -1231,7 +1235,10 @@ static int smiapp_power_on(struct smiapp_sensor *sensor)
out_cci_addr_fail:
if (sensor->platform_data->xshutdown != SMIAPP_NO_XSHUTDOWN)
gpio_set_value(sensor->platform_data->xshutdown, 0);
sensor->platform_data->set_xclk(&sensor->src->sd, 0);
if (sensor->platform_data->set_xclk)
sensor->platform_data->set_xclk(&sensor->src->sd, 0);
else
clk_disable(sensor->ext_clk);

out_xclk_fail:
regulator_disable(sensor->vana);
Expand All @@ -1256,7 +1263,10 @@ static void smiapp_power_off(struct smiapp_sensor *sensor)

if (sensor->platform_data->xshutdown != SMIAPP_NO_XSHUTDOWN)
gpio_set_value(sensor->platform_data->xshutdown, 0);
sensor->platform_data->set_xclk(&sensor->src->sd, 0);
if (sensor->platform_data->set_xclk)
sensor->platform_data->set_xclk(&sensor->src->sd, 0);
else
clk_disable(sensor->ext_clk);
usleep_range(5000, 5000);
regulator_disable(sensor->vana);
sensor->streaming = 0;
Expand Down Expand Up @@ -2327,14 +2337,36 @@ static int smiapp_registered(struct v4l2_subdev *subdev)
return -ENODEV;
}

if (!sensor->platform_data->set_xclk) {
sensor->ext_clk = clk_get(&client->dev,
sensor->platform_data->ext_clk_name);
if (IS_ERR(sensor->ext_clk)) {
dev_err(&client->dev, "could not get clock %s\n",
sensor->platform_data->ext_clk_name);
rval = -ENODEV;
goto out_clk_get;
}

rval = clk_set_rate(sensor->ext_clk,
sensor->platform_data->ext_clk);
if (rval < 0) {
dev_err(&client->dev,
"unable to set clock %s freq to %u\n",
sensor->platform_data->ext_clk_name,
sensor->platform_data->ext_clk);
rval = -ENODEV;
goto out_clk_set_rate;
}
}

if (sensor->platform_data->xshutdown != SMIAPP_NO_XSHUTDOWN) {
if (gpio_request_one(sensor->platform_data->xshutdown, 0,
"SMIA++ xshutdown") != 0) {
dev_err(&client->dev,
"unable to acquire reset gpio %d\n",
sensor->platform_data->xshutdown);
rval = -ENODEV;
goto out_gpio_request;
goto out_clk_set_rate;
}
}

Expand Down Expand Up @@ -2589,7 +2621,11 @@ static int smiapp_registered(struct v4l2_subdev *subdev)
if (sensor->platform_data->xshutdown != SMIAPP_NO_XSHUTDOWN)
gpio_free(sensor->platform_data->xshutdown);

out_gpio_request:
out_clk_set_rate:
clk_put(sensor->ext_clk);
sensor->ext_clk = NULL;

out_clk_get:
regulator_put(sensor->vana);
sensor->vana = NULL;
return rval;
Expand Down Expand Up @@ -2778,7 +2814,10 @@ static int __exit smiapp_remove(struct i2c_client *client)
if (sensor->power_count) {
if (sensor->platform_data->xshutdown != SMIAPP_NO_XSHUTDOWN)
gpio_set_value(sensor->platform_data->xshutdown, 0);
sensor->platform_data->set_xclk(&sensor->src->sd, 0);
if (sensor->platform_data->set_xclk)
sensor->platform_data->set_xclk(&sensor->src->sd, 0);
else
clk_disable(sensor->ext_clk);
sensor->power_count = 0;
}

Expand All @@ -2794,6 +2833,8 @@ static int __exit smiapp_remove(struct i2c_client *client)
smiapp_free_controls(sensor);
if (sensor->platform_data->xshutdown != SMIAPP_NO_XSHUTDOWN)
gpio_free(sensor->platform_data->xshutdown);
if (sensor->ext_clk)
clk_put(sensor->ext_clk);
if (sensor->vana)
regulator_put(sensor->vana);

Expand Down
1 change: 1 addition & 0 deletions trunk/drivers/media/video/smiapp/smiapp.h
Original file line number Diff line number Diff line change
Expand Up @@ -198,6 +198,7 @@ struct smiapp_sensor {
struct smiapp_subdev *pixel_array;
struct smiapp_platform_data *platform_data;
struct regulator *vana;
struct clk *ext_clk;
u32 limits[SMIAPP_LIMIT_LAST];
u8 nbinning_subtypes;
struct smiapp_binning_subtype binning_subtypes[SMIAPP_BINNING_SUBTYPES];
Expand Down
1 change: 1 addition & 0 deletions trunk/include/media/smiapp.h
Original file line number Diff line number Diff line change
Expand Up @@ -77,6 +77,7 @@ struct smiapp_platform_data {
struct smiapp_flash_strobe_parms *strobe_setup;

int (*set_xclk)(struct v4l2_subdev *sd, int hz);
char *ext_clk_name;
int xshutdown; /* gpio or SMIAPP_NO_XSHUTDOWN */
};

Expand Down

0 comments on commit 24caaa7

Please sign in to comment.