Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 2dca3d9e authored by Michael Buesch's avatar Michael Buesch Committed by Alexandre Belloni
Browse files

rtc: rv3029: Add i2c register update-bits helper 



This simplifies mask/set operations on device I2C registers.

Signed-off-by: default avatarMichael Buesch <m@bues.ch>
Signed-off-by: default avatarAlexandre Belloni <alexandre.belloni@free-electrons.com>
parent 7697de35

drivers/rtc/rtc-rv3029c2.c

+28 −26
Original line number Diff line number Diff line
@@ -2,6 +2,7 @@ 
 * Micro Crystal RV-3029 rtc class driver

 *

 * Author: Gregory Hermant <gregory.hermant@calao-systems.com>

 *         Michael Buesch <m@bues.ch>

 *

 * based on previously existing rtc class drivers

 *
@@ -142,6 +143,24 @@ rv3029_i2c_write_regs(struct i2c_client *client, u8 reg, u8 const buf[], 
	return i2c_smbus_write_i2c_block_data(client, reg, len, buf);

}



static int

rv3029_i2c_update_bits(struct i2c_client *client, u8 reg, u8 mask, u8 set)

{

	u8 buf;

	int ret;



	ret = rv3029_i2c_read_regs(client, reg, &buf, 1);

	if (ret < 0)

		return ret;

	buf &= ~mask;

	buf |= set & mask;

	ret = rv3029_i2c_write_regs(client, reg, &buf, 1);

	if (ret < 0)

		return ret;



	return 0;

}



static int

rv3029_i2c_get_sr(struct i2c_client *client, u8 *buf)

{
@@ -260,22 +279,13 @@ static int rv3029_rtc_i2c_alarm_set_irq(struct i2c_client *client, 
					int enable)

{

	int ret;

	u8 buf[1];



	/* enable AIE irq */

	ret = rv3029_i2c_read_regs(client, RV3029_IRQ_CTRL, buf, 1);

	if (ret < 0) {

		dev_err(&client->dev, "can't read INT reg\n");

		return ret;

	}

	if (enable)

		buf[0] |= RV3029_IRQ_CTRL_AIE;

	else

		buf[0] &= ~RV3029_IRQ_CTRL_AIE;



	ret = rv3029_i2c_write_regs(client, RV3029_IRQ_CTRL, buf, 1);

	/* enable/disable AIE irq */

	ret = rv3029_i2c_update_bits(client, RV3029_IRQ_CTRL,

				     RV3029_IRQ_CTRL_AIE,

				     (enable ? RV3029_IRQ_CTRL_AIE : 0));

	if (ret < 0) {

		dev_err(&client->dev, "can't set INT reg\n");

		dev_err(&client->dev, "can't update INT reg\n");

		return ret;

	}
@@ -316,20 +326,11 @@ static int rv3029_rtc_i2c_set_alarm(struct i2c_client *client, 
		return ret;



	if (alarm->enabled) {

		u8 buf[1];



		/* clear AF flag */

		ret = rv3029_i2c_read_regs(client, RV3029_IRQ_FLAGS,

					   buf, 1);

		if (ret < 0) {

			dev_err(&client->dev, "can't read alarm flag\n");

			return ret;

		}

		buf[0] &= ~RV3029_IRQ_FLAGS_AF;

		ret = rv3029_i2c_write_regs(client, RV3029_IRQ_FLAGS,

					    buf, 1);

		ret = rv3029_i2c_update_bits(client, RV3029_IRQ_FLAGS,

					     RV3029_IRQ_FLAGS_AF, 0);

		if (ret < 0) {

			dev_err(&client->dev, "can't set alarm flag\n");

			dev_err(&client->dev, "can't clear alarm flag\n");

			return ret;

		}

		/* enable AIE irq */
@@ -454,5 +455,6 @@ static struct i2c_driver rv3029_driver = { 
module_i2c_driver(rv3029_driver);



MODULE_AUTHOR("Gregory Hermant <gregory.hermant@calao-systems.com>");

MODULE_AUTHOR("Michael Buesch <m@bues.ch>");

MODULE_DESCRIPTION("Micro Crystal RV3029 RTC driver");

MODULE_LICENSE("GPL");