leds-lp5523: clean up lp5523_configure()

This patch is a preceding step for making common lp55xx init function.

 Return code:
 Do not use 'OR' arithmetic for the result.
 If some error occurs, just return it.

 Remove engine verification code:
 To check whether internal engine works or not, many lines of code are executed.
 However, this job is unnecessary during the chip initialization because
 the engine usage is not mandatory but optional function.
 LED engines are enabled when specific LED pattern is loaded.
 Therefore, this verification code is removed.

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 18:04:50 +09:00 committed by Bryan Wu
parent 9448217403
commit 632418bf65
1 changed files with 10 additions and 59 deletions

View File

@ -199,77 +199,28 @@ static int lp5523_detect(struct i2c_client *client)
static int lp5523_configure(struct i2c_client *client) static int lp5523_configure(struct i2c_client *client)
{ {
struct lp5523_chip *chip = i2c_get_clientdata(client);
int ret = 0; int ret = 0;
u8 status;
/* one pattern per engine setting led mux start and stop addresses */ ret = lp5523_write(client, LP5523_REG_ENABLE, LP5523_ENABLE);
static const u8 pattern[][LP5523_PROGRAM_LENGTH] = { if (ret)
{ 0x9c, 0x30, 0x9c, 0xb0, 0x9d, 0x80, 0xd8, 0x00, 0}, return ret;
{ 0x9c, 0x40, 0x9c, 0xc0, 0x9d, 0x80, 0xd8, 0x00, 0},
{ 0x9c, 0x50, 0x9c, 0xd0, 0x9d, 0x80, 0xd8, 0x00, 0},
};
ret |= lp5523_write(client, LP5523_REG_ENABLE, LP5523_ENABLE);
/* Chip startup time is 500 us, 1 - 2 ms gives some margin */ /* Chip startup time is 500 us, 1 - 2 ms gives some margin */
usleep_range(1000, 2000); usleep_range(1000, 2000);
ret |= lp5523_write(client, LP5523_REG_CONFIG, ret = lp5523_write(client, LP5523_REG_CONFIG,
LP5523_AUTO_INC | LP5523_PWR_SAVE | LP5523_AUTO_INC | LP5523_PWR_SAVE |
LP5523_CP_AUTO | LP5523_AUTO_CLK | LP5523_CP_AUTO | LP5523_AUTO_CLK |
LP5523_PWM_PWR_SAVE); LP5523_PWM_PWR_SAVE);
if (ret)
/* turn on all leds */
ret |= lp5523_write(client, LP5523_REG_ENABLE_LEDS_MSB, 0x01);
ret |= lp5523_write(client, LP5523_REG_ENABLE_LEDS_LSB, 0xff);
/* hardcode 32 bytes of memory for each engine from program memory */
ret |= lp5523_write(client, LP5523_REG_CH1_PROG_START, 0x00);
ret |= lp5523_write(client, LP5523_REG_CH2_PROG_START, 0x10);
ret |= lp5523_write(client, LP5523_REG_CH3_PROG_START, 0x20);
/* write led mux address space for each channel */
ret |= lp5523_load_program(&chip->engines[0], pattern[0]);
ret |= lp5523_load_program(&chip->engines[1], pattern[1]);
ret |= lp5523_load_program(&chip->engines[2], pattern[2]);
if (ret) {
dev_err(&client->dev, "could not load mux programs\n");
return -1;
}
/* set all engines exec state and mode to run 00101010 */
ret |= lp5523_write(client, LP5523_REG_ENABLE,
(LP5523_CMD_RUN | LP5523_ENABLE));
ret |= lp5523_write(client, LP5523_REG_OP_MODE, LP5523_CMD_RUN);
if (ret) {
dev_err(&client->dev, "could not start mux programs\n");
return -1;
}
/* Let the programs run for couple of ms and check the engine status */
usleep_range(3000, 6000);
ret = lp5523_read(client, LP5523_REG_STATUS, &status);
if (ret < 0)
return ret; return ret;
status &= LP5523_ENG_STATUS_MASK; /* turn on all leds */
ret = lp5523_write(client, LP5523_REG_ENABLE_LEDS_MSB, 0x01);
if (ret)
return ret;
if (status == LP5523_ENG_STATUS_MASK) { return lp5523_write(client, LP5523_REG_ENABLE_LEDS_LSB, 0xff);
dev_dbg(&client->dev, "all engines configured\n");
} else {
dev_info(&client->dev, "status == %x\n", status);
dev_err(&client->dev, "cound not configure LED engine\n");
return -1;
}
dev_info(&client->dev, "disabling engines\n");
ret |= lp5523_write(client, LP5523_REG_OP_MODE, LP5523_CMD_DISABLED);
return ret;
} }
static int lp5523_set_engine_mode(struct lp5523_engine *engine, u8 mode) static int lp5523_set_engine_mode(struct lp5523_engine *engine, u8 mode)