| /* |
| * linux/drivers/i2c/chips/rtc8564.c |
| * |
| * Copyright (C) 2002-2004 Stefan Eletzhofer |
| * |
| * based on linux/drivers/acron/char/pcf8583.c |
| * Copyright (C) 2000 Russell King |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| * |
| * Driver for system3's EPSON RTC 8564 chip |
| */ |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/i2c.h> |
| #include <linux/slab.h> |
| #include <linux/string.h> |
| #include <linux/rtc.h> /* get the user-level API */ |
| #include <linux/init.h> |
| |
| #include "rtc8564.h" |
| |
| #ifdef DEBUG |
| # define _DBG(x, fmt, args...) do{ if (debug>=x) printk(KERN_DEBUG"%s: " fmt "\n", __FUNCTION__, ##args); } while(0); |
| #else |
| # define _DBG(x, fmt, args...) do { } while(0); |
| #endif |
| |
| #define _DBGRTCTM(x, rtctm) if (debug>=x) printk("%s: secs=%d, mins=%d, hours=%d, mday=%d, " \ |
| "mon=%d, year=%d, wday=%d VL=%d\n", __FUNCTION__, \ |
| (rtctm).secs, (rtctm).mins, (rtctm).hours, (rtctm).mday, \ |
| (rtctm).mon, (rtctm).year, (rtctm).wday, (rtctm).vl); |
| |
| struct rtc8564_data { |
| struct i2c_client client; |
| u16 ctrl; |
| }; |
| |
| static inline u8 _rtc8564_ctrl1(struct i2c_client *client) |
| { |
| struct rtc8564_data *data = i2c_get_clientdata(client); |
| return data->ctrl & 0xff; |
| } |
| static inline u8 _rtc8564_ctrl2(struct i2c_client *client) |
| { |
| struct rtc8564_data *data = i2c_get_clientdata(client); |
| return (data->ctrl & 0xff00) >> 8; |
| } |
| |
| #define CTRL1(c) _rtc8564_ctrl1(c) |
| #define CTRL2(c) _rtc8564_ctrl2(c) |
| |
| #define BCD_TO_BIN(val) (((val)&15) + ((val)>>4)*10) |
| #define BIN_TO_BCD(val) ((((val)/10)<<4) + (val)%10) |
| |
| static int debug;; |
| module_param(debug, int, S_IRUGO | S_IWUSR); |
| |
| static struct i2c_driver rtc8564_driver; |
| |
| static unsigned short ignore[] = { I2C_CLIENT_END }; |
| static unsigned short normal_addr[] = { 0x51, I2C_CLIENT_END }; |
| |
| static struct i2c_client_address_data addr_data = { |
| .normal_i2c = normal_addr, |
| .probe = ignore, |
| .ignore = ignore, |
| }; |
| |
| static int rtc8564_read_mem(struct i2c_client *client, struct mem *mem); |
| static int rtc8564_write_mem(struct i2c_client *client, struct mem *mem); |
| |
| static int rtc8564_read(struct i2c_client *client, unsigned char adr, |
| unsigned char *buf, unsigned char len) |
| { |
| int ret = -EIO; |
| unsigned char addr[1] = { adr }; |
| struct i2c_msg msgs[2] = { |
| {client->addr, 0, 1, addr}, |
| {client->addr, I2C_M_RD, len, buf} |
| }; |
| |
| _DBG(1, "client=%p, adr=%d, buf=%p, len=%d", client, adr, buf, len); |
| |
| if (!buf) { |
| ret = -EINVAL; |
| goto done; |
| } |
| |
| ret = i2c_transfer(client->adapter, msgs, 2); |
| if (ret == 2) { |
| ret = 0; |
| } |
| |
| done: |
| return ret; |
| } |
| |
| static int rtc8564_write(struct i2c_client *client, unsigned char adr, |
| unsigned char *data, unsigned char len) |
| { |
| int ret = 0; |
| unsigned char _data[16]; |
| struct i2c_msg wr; |
| int i; |
| |
| if (!data || len > 15) { |
| ret = -EINVAL; |
| goto done; |
| } |
| |
| _DBG(1, "client=%p, adr=%d, buf=%p, len=%d", client, adr, data, len); |
| |
| _data[0] = adr; |
| for (i = 0; i < len; i++) { |
| _data[i + 1] = data[i]; |
| _DBG(5, "data[%d] = 0x%02x (%d)", i, data[i], data[i]); |
| } |
| |
| wr.addr = client->addr; |
| wr.flags = 0; |
| wr.len = len + 1; |
| wr.buf = _data; |
| |
| ret = i2c_transfer(client->adapter, &wr, 1); |
| if (ret == 1) { |
| ret = 0; |
| } |
| |
| done: |
| return ret; |
| } |
| |
| static int rtc8564_attach(struct i2c_adapter *adap, int addr, int kind) |
| { |
| int ret; |
| struct i2c_client *new_client; |
| struct rtc8564_data *d; |
| unsigned char data[10]; |
| unsigned char ad[1] = { 0 }; |
| struct i2c_msg ctrl_wr[1] = { |
| {addr, 0, 2, data} |
| }; |
| struct i2c_msg ctrl_rd[2] = { |
| {addr, 0, 1, ad}, |
| {addr, I2C_M_RD, 2, data} |
| }; |
| |
| d = kmalloc(sizeof(struct rtc8564_data), GFP_KERNEL); |
| if (!d) { |
| ret = -ENOMEM; |
| goto done; |
| } |
| memset(d, 0, sizeof(struct rtc8564_data)); |
| new_client = &d->client; |
| |
| strlcpy(new_client->name, "RTC8564", I2C_NAME_SIZE); |
| i2c_set_clientdata(new_client, d); |
| new_client->flags = I2C_CLIENT_ALLOW_USE; |
| new_client->addr = addr; |
| new_client->adapter = adap; |
| new_client->driver = &rtc8564_driver; |
| |
| _DBG(1, "client=%p", new_client); |
| |
| /* init ctrl1 reg */ |
| data[0] = 0; |
| data[1] = 0; |
| ret = i2c_transfer(new_client->adapter, ctrl_wr, 1); |
| if (ret != 1) { |
| printk(KERN_INFO "rtc8564: cant init ctrl1\n"); |
| ret = -ENODEV; |
| goto done; |
| } |
| |
| /* read back ctrl1 and ctrl2 */ |
| ret = i2c_transfer(new_client->adapter, ctrl_rd, 2); |
| if (ret != 2) { |
| printk(KERN_INFO "rtc8564: cant read ctrl\n"); |
| ret = -ENODEV; |
| goto done; |
| } |
| |
| d->ctrl = data[0] | (data[1] << 8); |
| |
| _DBG(1, "RTC8564_REG_CTRL1=%02x, RTC8564_REG_CTRL2=%02x", |
| data[0], data[1]); |
| |
| ret = i2c_attach_client(new_client); |
| done: |
| if (ret) { |
| kfree(d); |
| } |
| return ret; |
| } |
| |
| static int rtc8564_probe(struct i2c_adapter *adap) |
| { |
| return i2c_probe(adap, &addr_data, rtc8564_attach); |
| } |
| |
| static int rtc8564_detach(struct i2c_client *client) |
| { |
| i2c_detach_client(client); |
| kfree(i2c_get_clientdata(client)); |
| return 0; |
| } |
| |
| static int rtc8564_get_datetime(struct i2c_client *client, struct rtc_tm *dt) |
| { |
| int ret = -EIO; |
| unsigned char buf[15]; |
| |
| _DBG(1, "client=%p, dt=%p", client, dt); |
| |
| if (!dt) |
| return -EINVAL; |
| |
| memset(buf, 0, sizeof(buf)); |
| |
| ret = rtc8564_read(client, 0, buf, 15); |
| if (ret) |
| return ret; |
| |
| /* century stored in minute alarm reg */ |
| dt->year = BCD_TO_BIN(buf[RTC8564_REG_YEAR]); |
| dt->year += 100 * BCD_TO_BIN(buf[RTC8564_REG_AL_MIN] & 0x3f); |
| dt->mday = BCD_TO_BIN(buf[RTC8564_REG_DAY] & 0x3f); |
| dt->wday = BCD_TO_BIN(buf[RTC8564_REG_WDAY] & 7); |
| dt->mon = BCD_TO_BIN(buf[RTC8564_REG_MON_CENT] & 0x1f); |
| |
| dt->secs = BCD_TO_BIN(buf[RTC8564_REG_SEC] & 0x7f); |
| dt->vl = (buf[RTC8564_REG_SEC] & 0x80) == 0x80; |
| dt->mins = BCD_TO_BIN(buf[RTC8564_REG_MIN] & 0x7f); |
| dt->hours = BCD_TO_BIN(buf[RTC8564_REG_HR] & 0x3f); |
| |
| _DBGRTCTM(2, *dt); |
| |
| return 0; |
| } |
| |
| static int |
| rtc8564_set_datetime(struct i2c_client *client, struct rtc_tm *dt, int datetoo) |
| { |
| int ret, len = 5; |
| unsigned char buf[15]; |
| |
| _DBG(1, "client=%p, dt=%p", client, dt); |
| |
| if (!dt) |
| return -EINVAL; |
| |
| _DBGRTCTM(2, *dt); |
| |
| buf[RTC8564_REG_CTRL1] = CTRL1(client) | RTC8564_CTRL1_STOP; |
| buf[RTC8564_REG_CTRL2] = CTRL2(client); |
| buf[RTC8564_REG_SEC] = BIN_TO_BCD(dt->secs); |
| buf[RTC8564_REG_MIN] = BIN_TO_BCD(dt->mins); |
| buf[RTC8564_REG_HR] = BIN_TO_BCD(dt->hours); |
| |
| if (datetoo) { |
| len += 5; |
| buf[RTC8564_REG_DAY] = BIN_TO_BCD(dt->mday); |
| buf[RTC8564_REG_WDAY] = BIN_TO_BCD(dt->wday); |
| buf[RTC8564_REG_MON_CENT] = BIN_TO_BCD(dt->mon) & 0x1f; |
| /* century stored in minute alarm reg */ |
| buf[RTC8564_REG_YEAR] = BIN_TO_BCD(dt->year % 100); |
| buf[RTC8564_REG_AL_MIN] = BIN_TO_BCD(dt->year / 100); |
| } |
| |
| ret = rtc8564_write(client, 0, buf, len); |
| if (ret) { |
| _DBG(1, "error writing data! %d", ret); |
| } |
| |
| buf[RTC8564_REG_CTRL1] = CTRL1(client); |
| ret = rtc8564_write(client, 0, buf, 1); |
| if (ret) { |
| _DBG(1, "error writing data! %d", ret); |
| } |
| |
| return ret; |
| } |
| |
| static int rtc8564_get_ctrl(struct i2c_client *client, unsigned int *ctrl) |
| { |
| struct rtc8564_data *data = i2c_get_clientdata(client); |
| |
| if (!ctrl) |
| return -1; |
| |
| *ctrl = data->ctrl; |
| return 0; |
| } |
| |
| static int rtc8564_set_ctrl(struct i2c_client *client, unsigned int *ctrl) |
| { |
| struct rtc8564_data *data = i2c_get_clientdata(client); |
| unsigned char buf[2]; |
| |
| if (!ctrl) |
| return -1; |
| |
| buf[0] = *ctrl & 0xff; |
| buf[1] = (*ctrl & 0xff00) >> 8; |
| data->ctrl = *ctrl; |
| |
| return rtc8564_write(client, 0, buf, 2); |
| } |
| |
| static int rtc8564_read_mem(struct i2c_client *client, struct mem *mem) |
| { |
| |
| if (!mem) |
| return -EINVAL; |
| |
| return rtc8564_read(client, mem->loc, mem->data, mem->nr); |
| } |
| |
| static int rtc8564_write_mem(struct i2c_client *client, struct mem *mem) |
| { |
| |
| if (!mem) |
| return -EINVAL; |
| |
| return rtc8564_write(client, mem->loc, mem->data, mem->nr); |
| } |
| |
| static int |
| rtc8564_command(struct i2c_client *client, unsigned int cmd, void *arg) |
| { |
| |
| _DBG(1, "cmd=%d", cmd); |
| |
| switch (cmd) { |
| case RTC_GETDATETIME: |
| return rtc8564_get_datetime(client, arg); |
| |
| case RTC_SETTIME: |
| return rtc8564_set_datetime(client, arg, 0); |
| |
| case RTC_SETDATETIME: |
| return rtc8564_set_datetime(client, arg, 1); |
| |
| case RTC_GETCTRL: |
| return rtc8564_get_ctrl(client, arg); |
| |
| case RTC_SETCTRL: |
| return rtc8564_set_ctrl(client, arg); |
| |
| case MEM_READ: |
| return rtc8564_read_mem(client, arg); |
| |
| case MEM_WRITE: |
| return rtc8564_write_mem(client, arg); |
| |
| default: |
| return -EINVAL; |
| } |
| } |
| |
| static struct i2c_driver rtc8564_driver = { |
| .owner = THIS_MODULE, |
| .name = "RTC8564", |
| .id = I2C_DRIVERID_RTC8564, |
| .flags = I2C_DF_NOTIFY, |
| .attach_adapter = rtc8564_probe, |
| .detach_client = rtc8564_detach, |
| .command = rtc8564_command |
| }; |
| |
| static __init int rtc8564_init(void) |
| { |
| return i2c_add_driver(&rtc8564_driver); |
| } |
| |
| static __exit void rtc8564_exit(void) |
| { |
| i2c_del_driver(&rtc8564_driver); |
| } |
| |
| MODULE_AUTHOR("Stefan Eletzhofer <Stefan.Eletzhofer@eletztrick.de>"); |
| MODULE_DESCRIPTION("EPSON RTC8564 Driver"); |
| MODULE_LICENSE("GPL"); |
| |
| module_init(rtc8564_init); |
| module_exit(rtc8564_exit); |