hak5
/
wifipineapple-openwrt
mirror of https://github.com/hak5/wifipineapple-openwrt.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity
wifipineapple-openwrt/target/linux/s3c24xx/patches-2.6.24/1186-fix-pcf50633-rtc-i2c-b...

225 lines
7.9 KiB
Diff
Raw Blame History

From d22227eec7efd4b2f40e51ea3c3bc025299efc93 Mon Sep 17 00:00:00 2001
From: Andy Green <andy@openmoko.com>
Date: Wed, 2 Jul 2008 22:40:04 +0100
Subject: [PATCH] fix-pcf50633-rtc-i2c-bulk-autoincrement-simplify.patch
More pcf50633 major time saving by using i2c bulk autoincrement. Code
reduction too by using array for time elements.
Signed-off-by: Andy Green <andy@openmoko.com>
---
drivers/i2c/chips/pcf50633.c | 134 ++++++++++++++++++++++++------------------
1 files changed, 77 insertions(+), 57 deletions(-)
diff --git a/drivers/i2c/chips/pcf50633.c b/drivers/i2c/chips/pcf50633.c
index 33e2eaf..1f88c32 100644
--- a/drivers/i2c/chips/pcf50633.c
+++ b/drivers/i2c/chips/pcf50633.c
@@ -1505,37 +1505,42 @@ static void pcf50633_get_power_status(struct apm_power_info *info)
/***********************************************************************
* RTC
***********************************************************************/
+enum pcf50633_time_indexes {
+ PCF50633_TI_SEC = 0,
+ PCF50633_TI_MIN,
+ PCF50633_TI_HOUR,
+ PCF50633_TI_WKDAY,
+ PCF50633_TI_DAY,
+ PCF50633_TI_MONTH,
+ PCF50633_TI_YEAR,
+ PCF50633_TI_EXTENT /* always last */
+};
+
struct pcf50633_time {
- u_int8_t sec;
- u_int8_t min;
- u_int8_t hour;
- u_int8_t wkday;
- u_int8_t day;
- u_int8_t month;
- u_int8_t year;
+ u_int8_t time[PCF50633_TI_EXTENT];
};
static void pcf2rtc_time(struct rtc_time *rtc, struct pcf50633_time *pcf)
{
- rtc->tm_sec = BCD2BIN(pcf->sec);
- rtc->tm_min = BCD2BIN(pcf->min);
- rtc->tm_hour = BCD2BIN(pcf->hour);
- rtc->tm_wday = BCD2BIN(pcf->wkday);
- rtc->tm_mday = BCD2BIN(pcf->day);
- rtc->tm_mon = BCD2BIN(pcf->month);
- rtc->tm_year = BCD2BIN(pcf->year) + 100;
+ rtc->tm_sec = BCD2BIN(pcf->time[PCF50633_TI_SEC]);
+ rtc->tm_min = BCD2BIN(pcf->time[PCF50633_TI_MIN]);
+ rtc->tm_hour = BCD2BIN(pcf->time[PCF50633_TI_HOUR]);
+ rtc->tm_wday = BCD2BIN(pcf->time[PCF50633_TI_WKDAY]);
+ rtc->tm_mday = BCD2BIN(pcf->time[PCF50633_TI_DAY]);
+ rtc->tm_mon = BCD2BIN(pcf->time[PCF50633_TI_MONTH]);
+ rtc->tm_year = BCD2BIN(pcf->time[PCF50633_TI_YEAR]) + 100;
}
static void rtc2pcf_time(struct pcf50633_time *pcf, struct rtc_time *rtc)
{
- pcf->sec = BIN2BCD(rtc->tm_sec);
- pcf->min = BIN2BCD(rtc->tm_min);
- pcf->hour = BIN2BCD(rtc->tm_hour);
- pcf->wkday = BIN2BCD(rtc->tm_wday);
- pcf->day = BIN2BCD(rtc->tm_mday);
- pcf->month = BIN2BCD(rtc->tm_mon);
- pcf->year = BIN2BCD(rtc->tm_year - 100);
+ pcf->time[PCF50633_TI_SEC] = BIN2BCD(rtc->tm_sec);
+ pcf->time[PCF50633_TI_MIN] = BIN2BCD(rtc->tm_min);
+ pcf->time[PCF50633_TI_HOUR] = BIN2BCD(rtc->tm_hour);
+ pcf->time[PCF50633_TI_WKDAY] = BIN2BCD(rtc->tm_wday);
+ pcf->time[PCF50633_TI_DAY] = BIN2BCD(rtc->tm_mday);
+ pcf->time[PCF50633_TI_MONTH] = BIN2BCD(rtc->tm_mon);
+ pcf->time[PCF50633_TI_YEAR] = BIN2BCD(rtc->tm_year - 100);
}
static int pcf50633_rtc_ioctl(struct device *dev, unsigned int cmd,
@@ -1574,24 +1579,30 @@ static int pcf50633_rtc_read_time(struct device *dev, struct rtc_time *tm)
struct i2c_client *client = to_i2c_client(dev);
struct pcf50633_data *pcf = i2c_get_clientdata(client);
struct pcf50633_time pcf_tm;
+ int ret;
mutex_lock(&pcf->lock);
- pcf_tm.sec = __reg_read(pcf, PCF50633_REG_RTCSC);
- pcf_tm.min = __reg_read(pcf, PCF50633_REG_RTCMN);
- pcf_tm.hour = __reg_read(pcf, PCF50633_REG_RTCHR);
- pcf_tm.wkday = __reg_read(pcf, PCF50633_REG_RTCWD);
- pcf_tm.day = __reg_read(pcf, PCF50633_REG_RTCDT);
- pcf_tm.month = __reg_read(pcf, PCF50633_REG_RTCMT);
- pcf_tm.year = __reg_read(pcf, PCF50633_REG_RTCYR);
+
+ ret = i2c_smbus_read_i2c_block_data(&pcf->client,
+ PCF50633_REG_RTCSC,
+ PCF50633_TI_EXTENT,
+ &pcf_tm.time[0]);
+ if (ret != PCF50633_TI_EXTENT)
+ dev_err(dev, "Failed to read time :-(\n");
+
mutex_unlock(&pcf->lock);
- DEBUGP("PCF_TIME: %02x.%02x.%02x %02x:%02x:%02x\n",
- pcf_tm.day, pcf_tm.month, pcf_tm.year,
- pcf_tm.hour, pcf_tm.min, pcf_tm.sec);
+ dev_info(dev, "PCF_TIME: %02x.%02x.%02x %02x:%02x:%02x\n",
+ pcf_tm.time[PCF50633_TI_DAY],
+ pcf_tm.time[PCF50633_TI_MONTH],
+ pcf_tm.time[PCF50633_TI_YEAR],
+ pcf_tm.time[PCF50633_TI_HOUR],
+ pcf_tm.time[PCF50633_TI_MIN],
+ pcf_tm.time[PCF50633_TI_SEC]);
pcf2rtc_time(tm, &pcf_tm);
- DEBUGP("RTC_TIME: %u.%u.%u %u:%u:%u\n",
+ dev_info(dev, "RTC_TIME: %u.%u.%u %u:%u:%u\n",
tm->tm_mday, tm->tm_mon, tm->tm_year,
tm->tm_hour, tm->tm_min, tm->tm_sec);
@@ -1603,24 +1614,30 @@ static int pcf50633_rtc_set_time(struct device *dev, struct rtc_time *tm)
struct i2c_client *client = to_i2c_client(dev);
struct pcf50633_data *pcf = i2c_get_clientdata(client);
struct pcf50633_time pcf_tm;
+ int ret;
- DEBUGP("RTC_TIME: %u.%u.%u %u:%u:%u\n",
+ dev_info(dev, "RTC_TIME: %u.%u.%u %u:%u:%u\n",
tm->tm_mday, tm->tm_mon, tm->tm_year,
tm->tm_hour, tm->tm_min, tm->tm_sec);
rtc2pcf_time(&pcf_tm, tm);
- DEBUGP("PCF_TIME: %02x.%02x.%02x %02x:%02x:%02x\n",
- pcf_tm.day, pcf_tm.month, pcf_tm.year,
- pcf_tm.hour, pcf_tm.min, pcf_tm.sec);
+ dev_info(dev, "PCF_TIME: %02x.%02x.%02x %02x:%02x:%02x\n",
+ pcf_tm.time[PCF50633_TI_DAY],
+ pcf_tm.time[PCF50633_TI_MONTH],
+ pcf_tm.time[PCF50633_TI_YEAR],
+ pcf_tm.time[PCF50633_TI_HOUR],
+ pcf_tm.time[PCF50633_TI_MIN],
+ pcf_tm.time[PCF50633_TI_SEC]);
mutex_lock(&pcf->lock);
/* FIXME: disable second interrupt */
- __reg_write(pcf, PCF50633_REG_RTCSC, pcf_tm.sec);
- __reg_write(pcf, PCF50633_REG_RTCMN, pcf_tm.min);
- __reg_write(pcf, PCF50633_REG_RTCHR, pcf_tm.hour);
- __reg_write(pcf, PCF50633_REG_RTCWD, pcf_tm.wkday);
- __reg_write(pcf, PCF50633_REG_RTCDT, pcf_tm.day);
- __reg_write(pcf, PCF50633_REG_RTCMT, pcf_tm.month);
- __reg_write(pcf, PCF50633_REG_RTCYR, pcf_tm.year);
+
+ ret = i2c_smbus_write_i2c_block_data(&pcf->client,
+ PCF50633_REG_RTCSC,
+ PCF50633_TI_EXTENT,
+ &pcf_tm.time[0]);
+ if (ret)
+ dev_err(dev, "Failed to set time %d\n", ret);
+
/* FIXME: re-enable second interrupt */
mutex_unlock(&pcf->lock);
@@ -1632,17 +1649,20 @@ static int pcf50633_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)
struct i2c_client *client = to_i2c_client(dev);
struct pcf50633_data *pcf = i2c_get_clientdata(client);
struct pcf50633_time pcf_tm;
+ int ret;
mutex_lock(&pcf->lock);
+
alrm->enabled =
__reg_read(pcf, PCF50633_REG_INT1M) & PCF50633_INT1_ALARM ? 0 : 1;
- pcf_tm.sec = __reg_read(pcf, PCF50633_REG_RTCSCA);
- pcf_tm.min = __reg_read(pcf, PCF50633_REG_RTCMNA);
- pcf_tm.hour = __reg_read(pcf, PCF50633_REG_RTCHRA);
- pcf_tm.wkday = __reg_read(pcf, PCF50633_REG_RTCWDA);
- pcf_tm.day = __reg_read(pcf, PCF50633_REG_RTCDTA);
- pcf_tm.month = __reg_read(pcf, PCF50633_REG_RTCMTA);
- pcf_tm.year = __reg_read(pcf, PCF50633_REG_RTCYRA);
+
+ ret = i2c_smbus_read_i2c_block_data(&pcf->client,
+ PCF50633_REG_RTCSCA,
+ PCF50633_TI_EXTENT,
+ &pcf_tm.time[0]);
+ if (ret != PCF50633_TI_EXTENT)
+ dev_err(dev, "Failed to read Alarm time :-(\n");
+
mutex_unlock(&pcf->lock);
pcf2rtc_time(&alrm->time, &pcf_tm);
@@ -1656,6 +1676,7 @@ static int pcf50633_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)
struct pcf50633_data *pcf = i2c_get_clientdata(client);
struct pcf50633_time pcf_tm;
u_int8_t irqmask;
+ int ret;
rtc2pcf_time(&pcf_tm, &alrm->time);
@@ -1666,13 +1687,12 @@ static int pcf50633_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)
irqmask |= PCF50633_INT1_ALARM;
__reg_write(pcf, PCF50633_REG_INT1M, irqmask);
- __reg_write(pcf, PCF50633_REG_RTCSCA, pcf_tm.sec);
- __reg_write(pcf, PCF50633_REG_RTCMNA, pcf_tm.min);
- __reg_write(pcf, PCF50633_REG_RTCHRA, pcf_tm.hour);
- __reg_write(pcf, PCF50633_REG_RTCWDA, pcf_tm.wkday);
- __reg_write(pcf, PCF50633_REG_RTCDTA, pcf_tm.day);
- __reg_write(pcf, PCF50633_REG_RTCMTA, pcf_tm.month);
- __reg_write(pcf, PCF50633_REG_RTCYRA, pcf_tm.year);
+ ret = i2c_smbus_write_i2c_block_data(&pcf->client,
+ PCF50633_REG_RTCSCA,
+ PCF50633_TI_EXTENT,
+ &pcf_tm.time[0]);
+ if (ret)
+ dev_err(dev, "Failed to write alarm time :-( %d\n", ret);
if (alrm->enabled) {
/* (re-)enaable alarm interrupt */
--
1.5.6.5
Reference in New Issue View Git Blame Copy Permalink