s35390a_driver.zip_35390A驱动_S35390A_dm365_s35390_s35390a_driver

/* * Filename:rtc-s35390a.c * Author :kingtoneinfo.zhjy * Date :2011.11.4 */ /*Include files*/ #include <linux/kernel.h> #include <linux/module.h> #include <linux/i2c.h> #include <linux/rtc.h> #include <linux/bcd.h> #include "rtc-s35390a.h" #define S35390A_DEBUG #define S35390A_CMD_STATUS1 0 #define S35390A_CMD_STATUS2 1 #define S35390A_CMD_TIME1 2 #define S35390A_BYTE_YEAR 0 #define S35390A_BYTE_MONTH 1 #define S35390A_BYTE_DAY 2 #define S35390A_BYTE_WDAY 3 #define S35390A_BYTE_HOURS 4 #define S35390A_BYTE_MINS 5 #define S35390A_BYTE_SECS 6 #define S35390A_FLAG_POC 0x01 #define S35390A_FLAG_BLD 0x02 #define S35390A_FLAG_24H 0x40 #define S35390A_FLAG_RESET 0x80 #define S35390A_FLAG_TEST 0x01 #ifdef S35390A_DEBUG #define S35390A_DBGINFO() printk(KERN_INFO "S35390A_DRV_DEBUG_INFO:%s, %s, %d!\n",__FILE__,__func__,__LINE__) #else #define S35390A_DBGINFO() do{ } while(0) #endif static unsigned short ignore[] = { I2C_CLIENT_END }; static unsigned short normal_addr[] = { 0x30, I2C_CLIENT_END }; static unsigned short *forces[] = { NULL }; static struct i2c_client_address_data addr_data = { .normal_i2c = normal_addr, .probe = ignore, .ignore = ignore, .forces = forces, }; struct s35390a { struct i2c_client client; struct rtc_device *rtc; unsigned char mode_24; }; static int s35390a_set_reg(struct s35390a *s35390a, int reg, char *buf, int len) { struct i2c_client *client = &s35390a->client; struct i2c_msg msg[] = { { client->addr + reg, 0, len, buf }, }; if ((i2c_transfer(client->adapter, msg, 1)) != 1) return -EIO; return 0; } static int s35390a_get_reg(struct s35390a *s35390a, int reg, char *buf, int len) { struct i2c_client *client = &s35390a->client; struct i2c_msg msg[] = { { client->addr + reg, I2C_M_RD, len, buf }, }; if ((i2c_transfer(client->adapter, msg, 1)) != 1) return -EIO; return 0; } static char s35390a_hr2reg(struct s35390a *s35390a, int hour) { if (s35390a->mode_24) return BIN2BCD(hour); if (hour < 12) return BIN2BCD(hour); return 0x40 | BIN2BCD(hour - 12); } static int s35390a_reg2hr(struct s35390a *s35390a, char reg) { unsigned hour; if (s35390a->mode_24) return BCD2BIN(reg & 0x3f); hour = BCD2BIN(reg & 0x3f); if (reg & 0x40) hour += 12; return hour; } static int s35390a_set_datetime(struct i2c_client *client, struct rtc_time *tm) { struct s35390a *s35390a = i2c_get_clientdata(client); int i, err; char buf[7]; dev_dbg(&client->dev, "%s: tm is secs=%d, mins=%d, hours=%d mday=%d, " "mon=%d, year=%d, wday=%d\n", __func__, tm->tm_sec, tm->tm_min, tm->tm_hour, tm->tm_mday, tm->tm_mon, tm->tm_year, tm->tm_wday); buf[S35390A_BYTE_YEAR] = BIN2BCD(tm->tm_year - 100); buf[S35390A_BYTE_MONTH] = BIN2BCD(tm->tm_mon + 1); buf[S35390A_BYTE_DAY] = BIN2BCD(tm->tm_mday); buf[S35390A_BYTE_WDAY] = BIN2BCD(tm->tm_wday); buf[S35390A_BYTE_HOURS] = s35390a_hr2reg(s35390a, tm->tm_hour); buf[S35390A_BYTE_MINS] = BIN2BCD(tm->tm_min); buf[S35390A_BYTE_SECS] = BIN2BCD(tm->tm_sec); /* This chip expects the bits of each byte to be in reverse order */ for (i = 0; i < 7; ++i) buf[i] = bitrev8(buf[i]); err = s35390a_set_reg(s35390a, S35390A_CMD_TIME1, buf, sizeof(buf)); return err; } static int s35390a_get_datetime(struct i2c_client *client, struct rtc_time *tm) { struct s35390a *s35390a = i2c_get_clientdata(client); char buf[7]; int i, err; err = s35390a_get_reg(s35390a, S35390A_CMD_TIME1, buf, sizeof(buf)); if (err < 0) return err; /* This chip returns the bits of each byte in reverse order */ for (i = 0; i < 7; ++i) buf[i] = bitrev8(buf[i]); tm->tm_sec = BCD2BIN(buf[S35390A_BYTE_SECS]); tm->tm_min = BCD2BIN(buf[S35390A_BYTE_MINS]); tm->tm_hour = s35390a_reg2hr(s35390a, buf[S35390A_BYTE_HOURS]); tm->tm_wday = BCD2BIN(buf[S35390A_BYTE_WDAY]); tm->tm_mday = BCD2BIN(buf[S35390A_BYTE_DAY]); tm->tm_mon = BCD2BIN(buf[S35390A_BYTE_MONTH]) - 1; tm->tm_year = BCD2BIN(buf[S35390A_BYTE_YEAR]) + 100; dev_dbg(&client->dev,"%s: tm is secs=%d, mins=%d, hours=%d, mday=%d, " "mon=%d, year=%d, wday=%d\n", __func__, tm->tm_sec, tm->tm_min, tm->tm_hour, tm->tm_mday, tm->tm_mon, tm->tm_year, tm->tm_wday); return rtc_valid_tm(tm); } static int s35390a_rtc_read_time(struct device *dev, struct rtc_time *tm) { return s35390a_get_datetime(to_i2c_client(dev), tm); } static int s35390a_rtc_set_time(struct device *dev, struct rtc_time *tm) { return s35390a_set_datetime(to_i2c_client(dev), tm); } static int s35390a_reset(struct s35390a *s35390a) { char buf[1]; if (s35390a_get_reg(s35390a, S35390A_CMD_STATUS1, buf, sizeof(buf)) < 0) return -EIO; if (!(buf[0] & (S35390A_FLAG_POC | S35390A_FLAG_BLD))) { return 0; } buf[0] |= (S35390A_FLAG_RESET | S35390A_FLAG_24H); buf[0] &= 0xf0; return s35390a_set_reg(s35390a, S35390A_CMD_STATUS1, buf, sizeof(buf)); } static int s35390a_disable_test_mode(struct s35390a *s35390a) { char buf[1]; if (s35390a_get_reg(s35390a, S35390A_CMD_STATUS2, buf, sizeof(buf)) < 0) return -EIO; if (!(buf[0] & S35390A_FLAG_TEST)) return 0; buf[0] &= ~S35390A_FLAG_TEST; return s35390a_set_reg(s35390a, S35390A_CMD_STATUS2, buf, sizeof(buf)); } static int s35390a_probe(struct i2c_adapter *adap, int addr, int kind); static int s35390a_attach(struct i2c_adapter *adap) { S35390A_DBGINFO(); return i2c_probe(adap, &addr_data, s35390a_probe); } static int s35390a_detach(struct i2c_client *client) { int err; struct rtc_device *rtc = i2c_get_clientdata(client); if (rtc) rtc_device_unregister(rtc); if ((err = i2c_detach_client(client))) return err; kfree(client); return 0; } static struct rtc_class_ops s35390a_rtc_ops = { .read_time = s35390a_rtc_read_time, .set_time = s35390a_rtc_set_time, }; static struct i2c_driver s35390a_driver = { .driver = { .name = "S35390", }, .id = I2C_DRIVERID_S35390, .attach_adapter = s35390a_attach, .detach_client = s35390a_detach, }; static int s35390a_probe(struct i2c_adapter *adap, int addr, int kind) { struct s35390a *s35390a; struct i2c_client *client; int err; char buf[1]; struct rtc_time tm; S35390A_DBGINFO(); if (!i2c_check_functionality(adap, I2C_FUNC_I2C)) { err = -ENODEV; goto exit; } s35390a = kzalloc(sizeof(struct s35390a), GFP_KERNEL); if(!s35390a) { return -ENOMEM; } client = &s35390a->client; client->addr = addr; client->adapter = adap; client->driver = &s35390a_driver; client->flags = 0; strlcpy(client->name, s35390a_driver.driver.name, I2C_NAME_SIZE); i2c_set_clientdata(client, s35390a); if ((err = i2c_attach_client(client))) { goto exit_kfree; } err = s35390a_reset(s35390a); if (err < 0) { dev_err(&client->dev, "error resetting chip\n"); goto exit_detach; } err = s35390a_disable_test_mode(s35390a); if (err < 0) { dev_err(&client->dev, "error disabling test mode\n"); goto exit_detach; } err = s35390a_get_reg(s35390a, S35390A_CMD_STATUS1, buf, sizeof(buf)); if (err < 0) { dev_err(&client->dev, "error checking 12/24 hour mode\n"); goto exit_detach; } printk("%s,%s,%x\n",__FILE__,__func__,buf[0]); if (buf[0] & S35390A_FLAG_24H) s35390a->mode_24 = 1; else s35390a->mode_24 = 0; if (s35390a_get_datetime(client, &tm) < 0) dev_warn(&client->dev, "clock needs to be set\n"); printk("%s: tm is secs=%d, mins=%d, hours=%d, mday=%d, " "mon=%d, year=%d, wday=%d\n", __func__, tm.tm_sec, tm.tm_min, tm.tm_hour, tm.tm_mday, tm.tm_mon, tm.tm_year, tm.tm_wday); s35390a->rtc = rtc_device_register(s35390a_driver.driver.name, &client->dev, &s35390a_rtc_ops, THIS_MODULE); if (IS_ERR(s35390a->rtc)) { err = PTR_ERR(s35390a->rtc); goto exit_detach; } return 0; exit_detach: i2c_detach_client(client); exit_kfree: kfree(s35390a); exit: return err; } static __init int s35390a_init(void) { S35390A_DBGINFO(); return i2c_add_driver(&s35390a_driver); } static __exit void s35390a_exit(void) { S35390A_DBGINFO(); i2c_del_driver(&s35390a_driver); } module_init(s35