leds-lp55xx: do chip specific configuration on device init

Chip specific function is configured when the device is initialized.
 So _configure() is moved to each device init function.

 If chip configuration gets failed, the device is de-initialized in
 each _init_device(), not probe().

 For compile error fix, function type declarations are added.

Signed-off-by: Milo(Woogyom) Kim <milo.kim@ti.com>
Signed-off-by: Bryan Wu <cooloney@gmail.com>
This commit is contained in:
Milo(Woogyom) Kim 2013-02-05 17:58:01 +09:00 committed by Bryan Wu
parent 86eb7748ce
commit f6c64c6fc8
2 changed files with 36 additions and 16 deletions

View File

@ -694,6 +694,7 @@ static void lp5521_reset_device(struct lp5521_chip *chip)
lp5521_write(client, LP5521_REG_RESET, 0xff);
}
static void lp5521_deinit_device(struct lp5521_chip *chip);
static int lp5521_init_device(struct lp5521_chip *chip)
{
struct lp5521_platform_data *pdata = chip->pdata;
@ -742,9 +743,22 @@ static int lp5521_init_device(struct lp5521_chip *chip)
usleep_range(10000, 20000);
ret = lp5521_detect(client);
if (ret)
if (ret) {
dev_err(&client->dev, "Chip not found\n");
goto err;
}
ret = lp5521_configure(client);
if (ret < 0) {
dev_err(&client->dev, "error configuring chip\n");
goto err_config;
}
return 0;
err_config:
lp5521_deinit_device(chip);
err:
return ret;
}
@ -882,16 +896,10 @@ static int lp5521_probe(struct i2c_client *client,
ret = lp5521_init_device(chip);
if (ret)
goto fail1;
goto err_init;
dev_info(&client->dev, "%s programmable led chip found\n", id->name);
ret = lp5521_configure(client);
if (ret < 0) {
dev_err(&client->dev, "error configuring chip\n");
goto fail1;
}
ret = lp5521_register_leds(chip);
if (ret)
goto fail2;
@ -904,8 +912,8 @@ static int lp5521_probe(struct i2c_client *client,
return ret;
fail2:
lp5521_unregister_leds(chip);
fail1:
lp5521_deinit_device(chip);
err_init:
return ret;
}

View File

@ -953,6 +953,7 @@ static void lp5523_reset_device(struct lp5523_chip *chip)
lp5523_write(client, LP5523_REG_RESET, 0xff);
}
static void lp5523_deinit_device(struct lp5523_chip *chip);
static int lp5523_init_device(struct lp5523_chip *chip)
{
struct lp5523_platform_data *pdata = chip->pdata;
@ -978,7 +979,22 @@ static int lp5523_init_device(struct lp5523_chip *chip)
* Exact value is not available. 10 - 20ms
* appears to be enough for reset.
*/
return lp5523_detect(client);
ret = lp5523_detect(client);
if (ret)
goto err;
ret = lp5523_configure(client);
if (ret < 0) {
dev_err(&client->dev, "error configuring chip\n");
goto err_config;
}
return 0;
err_config:
lp5523_deinit_device(chip);
err:
return ret;
}
static void lp5523_deinit_device(struct lp5523_chip *chip)
@ -1018,7 +1034,7 @@ static int lp5523_probe(struct i2c_client *client,
ret = lp5523_init_device(chip);
if (ret)
goto fail1;
goto err_init;
dev_info(&client->dev, "%s Programmable led chip found\n", id->name);
@ -1030,11 +1046,6 @@ static int lp5523_probe(struct i2c_client *client,
goto fail1;
}
}
ret = lp5523_configure(client);
if (ret < 0) {
dev_err(&client->dev, "error configuring chip\n");
goto fail1;
}
ret = lp5523_register_leds(chip, id->name);
if (ret)
@ -1050,6 +1061,7 @@ fail2:
lp5523_unregister_leds(chip);
fail1:
lp5523_deinit_device(chip);
err_init:
return ret;
}