Commit 632418bf authored by Milo(Woogyom) Kim's avatar Milo(Woogyom) Kim Committed by Bryan Wu
Browse files

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: default avatarMilo(Woogyom) Kim <milo.kim@ti.com>
Signed-off-by: default avatarBryan Wu <cooloney@gmail.com>
parent 94482174

drivers/leds/leds-lp5523.c

+9 −58
Original line number Diff line number Diff line
@@ -199,77 +199,28 @@ static int lp5523_detect(struct i2c_client *client) 


static int lp5523_configure(struct i2c_client *client)

{

	struct lp5523_chip *chip = i2c_get_clientdata(client);

	int ret = 0;

	u8 status;



	/* one pattern per engine setting led mux start and stop addresses */

	static const u8 pattern[][LP5523_PROGRAM_LENGTH] =  {

		{ 0x9c, 0x30, 0x9c, 0xb0, 0x9d, 0x80, 0xd8, 0x00, 0},

		{ 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);

	if (ret)

		return ret;



	ret |= lp5523_write(client, LP5523_REG_ENABLE, LP5523_ENABLE);

	/* Chip startup time is 500 us, 1 - 2 ms gives some margin */

	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_CP_AUTO | LP5523_AUTO_CLK |

			    LP5523_PWM_PWR_SAVE);

	if (ret)

		return 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)

	ret = lp5523_write(client, LP5523_REG_ENABLE_LEDS_MSB, 0x01);

	if (ret)

		return ret;



	status &= LP5523_ENG_STATUS_MASK;



	if (status == LP5523_ENG_STATUS_MASK) {

		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;

	return lp5523_write(client, LP5523_REG_ENABLE_LEDS_LSB, 0xff);

}



static int lp5523_set_engine_mode(struct lp5523_engine *engine, u8 mode)

CRA Git | Maintained and supported by SUSTech CRA and CCSE