static int lm3554_detect(struct v4l2_subdev *sd)
{
struct i2c_client *client = v4l2_get_subdevdata(sd);
struct i2c_adapter *adapter = client->adapter;
struct lm3554 *flash = to_lm3554(sd);
int ret;
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
dev_err(&client->dev, "lm3554_detect i2c error\n");
return -ENODEV;
}
/* Power up the flash driver and reset it */
ret = lm3554_s_power(&flash->sd, 1);
if (ret < 0)
return ret;
lm3554_hw_reset(client);
/* Setup default values. This makes sure that the chip is in a known
* state.
*/
ret = lm3554_setup(flash);
if (ret < 0)
goto fail;
dev_dbg(&client->dev, "Successfully detected lm3554 LED flash\n");
lm3554_s_power(&flash->sd, 0);
return 0;
fail:
lm3554_s_power(&flash->sd, 0);
return ret;
}
static int lm3554_detect(struct i2c_client *client)
{
s32 status;
struct i2c_adapter *adapter = client->adapter;
struct v4l2_subdev *sd = i2c_get_clientdata(client);
struct lm3554_priv *p_lm3554_priv = to_lm3554_priv(sd);
struct camera_flash_platform_data *pdata = p_lm3554_priv->platform_data;
int ret;
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
dev_err(&client->dev, "lm3554_detect i2c error\n");
return -ENODEV;
}
lm3554_hw_reset(client);
ret = set_gpio_output(pdata->gpio_strobe, "flash", 0);
if (ret < 0)
goto fail;
ret = set_gpio_output(pdata->gpio_torch, "torch", 0);
if (ret < 0)
goto fail;
/* Set to TX2 mode, then ENVM/TX2 pin is a power
* amplifier sync input:
* ENVM/TX pin asserted, flash forced into torch;
* ENVM/TX pin desserted, flash set back;
*/
ret = set_reg_field(sd, &envm_tx2, 1);
if (ret < 0)
goto fail;
ret = set_reg_field(sd, &tx2_polarity, 0);
if (ret < 0)
goto fail;
/* set peak current limit to be 1000mA */
ret = set_reg_field(sd, ¤t_limit, 0);
if (ret < 0)
goto fail;
/* clear the flags register */
ret = lm3554_g_flash_status(sd, &status);
if (ret < 0)
goto fail;
dev_dbg(&client->dev, "Successfully detected lm3554 LED flash\n");
return 0;
fail:
dev_err(&client->dev, "gpio request/direction_output fail");
return ret;
}
