From 7ffc881aa6a039b2e353449b97dca8a64ee3969a Mon Sep 17 00:00:00 2001 From: mokopatches Date: Sun, 13 Apr 2008 07:23:52 +0100 Subject: [PATCH] fiq-hdq.patch --- arch/arm/mach-s3c2440/mach-gta02.c | 204 +++++++++++++++++++++- drivers/power/Kconfig | 8 + drivers/power/Makefile | 2 + drivers/power/gta02_hdq.c | 250 ++++++++++++++++++++++++++ include/asm-arm/arch-s3c2410/fiq_ipc_gta02.h | 23 +++ include/asm-arm/arch-s3c2410/gta02.h | 1 + include/linux/gta02_hdq.h | 8 + 7 files changed, 495 insertions(+), 1 deletions(-) create mode 100644 drivers/power/gta02_hdq.c create mode 100644 include/linux/gta02_hdq.h diff --git a/arch/arm/mach-s3c2440/mach-gta02.c b/arch/arm/mach-s3c2440/mach-gta02.c index 8c7bbe7..cea76e7 100644 --- a/arch/arm/mach-s3c2440/mach-gta02.c +++ b/arch/arm/mach-s3c2440/mach-gta02.c @@ -99,6 +99,19 @@ EXPORT_SYMBOL(fiq_ipc); #define FIQ_DIVISOR_VIBRATOR DIVISOR_FROM_US(100) +#ifdef CONFIG_GTA02_HDQ +/* HDQ specific */ +#define HDQ_SAMPLE_PERIOD_US 20 +/* private HDQ FSM state -- all other info interesting for caller in fiq_ipc */ +static enum hdq_bitbang_states hdq_state; +static u8 hdq_ctr; +static u8 hdq_ctr2; +static u8 hdq_bit; +static u8 hdq_shifter; +static u8 hdq_tx_data_done; + +#define FIQ_DIVISOR_HDQ DIVISOR_FROM_US(HDQ_SAMPLE_PERIOD_US) +#endif /* define FIQ ISR */ FIQ_HANDLER_START() @@ -121,9 +134,171 @@ FIQ_HANDLER_ENTRY(256, 512) divisor = FIQ_DIVISOR_VIBRATOR; } - /* TODO: HDQ servicing */ +#ifdef CONFIG_GTA02_HDQ + /* HDQ servicing */ + + switch (hdq_state) { + case HDQB_IDLE: + if (fiq_ipc.hdq_request_ctr == fiq_ipc.hdq_transaction_ctr) + break; + hdq_ctr = 210 / HDQ_SAMPLE_PERIOD_US; + s3c2410_gpio_setpin(fiq_ipc.hdq_gpio_pin, 0); + s3c2410_gpio_cfgpin(fiq_ipc.hdq_gpio_pin, S3C2410_GPIO_OUTPUT); + hdq_tx_data_done = 0; + hdq_state = HDQB_TX_BREAK; + break; + + case HDQB_TX_BREAK: /* issue low for > 190us */ + if (--hdq_ctr == 0) { + hdq_ctr = 60 / HDQ_SAMPLE_PERIOD_US; + hdq_state = HDQB_TX_BREAK_RECOVERY; + s3c2410_gpio_setpin(fiq_ipc.hdq_gpio_pin, 1); + } + break; + + case HDQB_TX_BREAK_RECOVERY: /* issue low for > 40us */ + if (--hdq_ctr) + break; + hdq_shifter = fiq_ipc.hdq_ads; + hdq_bit = 8; /* 8 bits of ads / rw */ + hdq_tx_data_done = 0; /* doing ads */ + /* fallthru on last one */ + case HDQB_ADS_CALC: + if (hdq_shifter & 1) + hdq_ctr = 50 / HDQ_SAMPLE_PERIOD_US; + else + hdq_ctr = 120 / HDQ_SAMPLE_PERIOD_US; + /* carefully precompute the other phase length */ + hdq_ctr2 = (210 - (hdq_ctr * HDQ_SAMPLE_PERIOD_US)) / + HDQ_SAMPLE_PERIOD_US; + hdq_state = HDQB_ADS_LOW; + hdq_shifter >>= 1; + hdq_bit--; + s3c2410_gpio_setpin(fiq_ipc.hdq_gpio_pin, 0); + break; + + case HDQB_ADS_LOW: + if (--hdq_ctr) + break; + s3c2410_gpio_setpin(fiq_ipc.hdq_gpio_pin, 1); + hdq_state = HDQB_ADS_HIGH; + break; + + case HDQB_ADS_HIGH: + if (--hdq_ctr2 > 1) /* account for HDQB_ADS_CALC */ + break; + if (hdq_bit) { /* more bits to do */ + hdq_state = HDQB_ADS_CALC; + break; + } + /* no more bits, wait it out until hdq_ctr2 exhausted */ + if (hdq_ctr2) + break; + /* ok no more bits and very last state */ + hdq_ctr = 60 / HDQ_SAMPLE_PERIOD_US; + /* FIXME 0 = read */ + if (fiq_ipc.hdq_ads & 0x80) { /* write the byte out */ + /* set delay before payload */ + hdq_ctr = 300 / HDQ_SAMPLE_PERIOD_US; + /* already high, no need to write */ + hdq_state = HDQB_WAIT_TX; + break; + } + /* read the next byte */ + hdq_bit = 8; /* 8 bits of data */ + hdq_ctr = 3000 / HDQ_SAMPLE_PERIOD_US; + hdq_state = HDQB_WAIT_RX; + s3c2410_gpio_cfgpin(fiq_ipc.hdq_gpio_pin, S3C2410_GPIO_INPUT); + break; + + case HDQB_WAIT_TX: /* issue low for > 40us */ + if (--hdq_ctr) + break; + if (!hdq_tx_data_done) { /* was that the data sent? */ + hdq_tx_data_done++; + hdq_shifter = fiq_ipc.hdq_tx_data; + hdq_bit = 8; /* 8 bits of data */ + hdq_state = HDQB_ADS_CALC; /* start sending */ + break; + } + fiq_ipc.hdq_error = 0; + fiq_ipc.hdq_transaction_ctr++; + hdq_state = HDQB_IDLE; /* all tx is done */ + /* idle in input mode, it's pulled up by 10K */ + s3c2410_gpio_cfgpin(fiq_ipc.hdq_gpio_pin, S3C2410_GPIO_INPUT); + break; + + case HDQB_WAIT_RX: /* wait for battery to talk to us */ + if (s3c2410_gpio_getpin(fiq_ipc.hdq_gpio_pin) == 0) { + /* it talks to us! */ + hdq_ctr2 = 1; + hdq_bit = 8; /* 8 bits of data */ + /* timeout */ + hdq_ctr = 300 / HDQ_SAMPLE_PERIOD_US; + hdq_state = HDQB_DATA_RX_LOW; + break; + } + if (--hdq_ctr == 0) { /* timed out, error */ + fiq_ipc.hdq_error = 1; + fiq_ipc.hdq_transaction_ctr++; + hdq_state = HDQB_IDLE; /* abort */ + } + break; + + /* + * HDQ basically works by measuring the low time of the bit cell + * 32-50us --> '1', 80 - 145us --> '0' + */ + + case HDQB_DATA_RX_LOW: + if (s3c2410_gpio_getpin(fiq_ipc.hdq_gpio_pin)) { + fiq_ipc.hdq_rx_data >>= 1; + if (hdq_ctr2 <= (65 / HDQ_SAMPLE_PERIOD_US)) + fiq_ipc.hdq_rx_data |= 0x80; + + if (--hdq_bit == 0) { + fiq_ipc.hdq_error = 0; + fiq_ipc.hdq_transaction_ctr++; /* done */ + hdq_state = HDQB_IDLE; + } else + hdq_state = HDQB_DATA_RX_HIGH; + /* timeout */ + hdq_ctr = 1000 / HDQ_SAMPLE_PERIOD_US; + hdq_ctr2 = 1; + break; + } + hdq_ctr2++; + if (--hdq_ctr) + break; + /* timed out, error */ + fiq_ipc.hdq_error = 2; + fiq_ipc.hdq_transaction_ctr++; + hdq_state = HDQB_IDLE; /* abort */ + break; + case HDQB_DATA_RX_HIGH: + if (!s3c2410_gpio_getpin(fiq_ipc.hdq_gpio_pin)) { + /* it talks to us! */ + hdq_ctr2 = 1; + /* timeout */ + hdq_ctr = 400 / HDQ_SAMPLE_PERIOD_US; + hdq_state = HDQB_DATA_RX_LOW; + break; + } + if (--hdq_ctr) + break; + /* timed out, error */ + fiq_ipc.hdq_error = 3; + fiq_ipc.hdq_transaction_ctr++; + /* we're in input mode already */ + hdq_state = HDQB_IDLE; /* abort */ + break; + } + if (hdq_state != HDQB_IDLE) /* ie, not idle */ + if (divisor > FIQ_DIVISOR_HDQ) + divisor = FIQ_DIVISOR_HDQ; /* keep us going */ +#endif /* disable further timer interrupts if nobody has any work * or adjust rate according to who still has work @@ -391,6 +566,23 @@ struct platform_device sc32440_fiq_device = { .resource = sc32440_fiq_resources, }; +#ifdef CONFIG_GTA02_HDQ +/* HDQ */ + +static struct resource gta02_hdq_resources[] = { + [0] = { + .start = GTA02v5_GPIO_HDQ, + .end = GTA02v5_GPIO_HDQ, + }, +}; + +struct platform_device gta02_hdq_device = { + .name = "gta02-hdq", + .num_resources = 1, + .resource = gta02_hdq_resources, +}; +#endif + /* NOR Flash */ #define GTA02_FLASH_BASE 0x18000000 /* GCS3 */ @@ -1074,6 +1266,16 @@ static void __init gta02_machine_init(void) platform_add_devices(gta02_devices, ARRAY_SIZE(gta02_devices)); +#ifdef CONFIG_GTA02_HDQ + switch (system_rev) { + case GTA02v5_SYSTEM_REV: + case GTA02v6_SYSTEM_REV: + platform_device_register(>a02_hdq_device); + break; + default: + break; + } +#endif s3c2410_pm_init(); /* Set LCD_RESET / XRES to high */ diff --git a/drivers/power/Kconfig b/drivers/power/Kconfig index 58c806e..0a4515d 100644 --- a/drivers/power/Kconfig +++ b/drivers/power/Kconfig @@ -50,3 +50,11 @@ config BATTERY_OLPC Say Y to enable support for the battery on the OLPC laptop. endif # POWER_SUPPLY + +config GTA02_HDQ + tristate "Neo Freerunner HDQ" + depends on MACH_NEO1973_GTA02 && FIQ && S3C2440_C_FIQ + help + Say Y to enable support for communicating with an HDQ battery + on the Neo Freerunner. You probably want to select + at least BATTERY_BQ27000_HDQ as well diff --git a/drivers/power/Makefile b/drivers/power/Makefile index 6413ded..88f227f 100644 --- a/drivers/power/Makefile +++ b/drivers/power/Makefile @@ -20,3 +20,5 @@ obj-$(CONFIG_APM_POWER) += apm_power.o obj-$(CONFIG_BATTERY_DS2760) += ds2760_battery.o obj-$(CONFIG_BATTERY_PMU) += pmu_battery.o obj-$(CONFIG_BATTERY_OLPC) += olpc_battery.o + +obj-$(CONFIG_GTA02_HDQ) += gta02_hdq.o diff --git a/drivers/power/gta02_hdq.c b/drivers/power/gta02_hdq.c new file mode 100644 index 0000000..12c742e --- /dev/null +++ b/drivers/power/gta02_hdq.c @@ -0,0 +1,250 @@ +/* + * HDQ driver for the FIC Neo1973 GTA02 GSM phone + * + * (C) 2006-2007 by OpenMoko, Inc. + * Author: Andy Green + * All rights reserved. + * + * 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. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include + + + +#define HDQ_READ 0 +#define HDQ_WRITE 0x80 + + +int gta02hdq_initialized(void) +{ + return fiq_ipc.hdq_probed; +} +EXPORT_SYMBOL_GPL(gta02hdq_initialized); + +int gta02hdq_read(int address) +{ + int count_sleeps = 5; + int ret = -ETIME; + + mutex_lock(&fiq_ipc.hdq_lock); + + fiq_ipc.hdq_ads = address | HDQ_READ; + fiq_ipc.hdq_request_ctr++; + fiq_kick(); + /* + * FIQ takes care of it while we block our calling process + * But we're not spinning -- other processes run normally while + * we wait for the result + */ + while (count_sleeps--) { + msleep(10); /* valid transaction always completes in < 10ms */ + + if (fiq_ipc.hdq_request_ctr != fiq_ipc.hdq_transaction_ctr) + continue; + + if (fiq_ipc.hdq_error) + goto done; /* didn't see a response in good time */ + + ret = fiq_ipc.hdq_rx_data; + goto done; + } + ret = -EINVAL; + +done: + mutex_unlock(&fiq_ipc.hdq_lock); + return ret; +} +EXPORT_SYMBOL_GPL(gta02hdq_read); + +int gta02hdq_write(int address, u8 data) +{ + int count_sleeps = 5; + int ret = -ETIME; + + mutex_lock(&fiq_ipc.hdq_lock); + + fiq_ipc.hdq_ads = address | HDQ_WRITE; + fiq_ipc.hdq_tx_data = data; + fiq_ipc.hdq_request_ctr++; + fiq_kick(); + /* + * FIQ takes care of it while we block our calling process + * But we're not spinning -- other processes run normally while + * we wait for the result + */ + while (count_sleeps--) { + msleep(10); /* valid transaction always completes in < 10ms */ + + if (fiq_ipc.hdq_request_ctr != fiq_ipc.hdq_transaction_ctr) + continue; /* something bad with FIQ */ + + if (fiq_ipc.hdq_error) + goto done; /* didn't see a response in good time */ + } + ret = -EINVAL; + +done: + mutex_unlock(&fiq_ipc.hdq_lock); + return ret; +} +EXPORT_SYMBOL_GPL(gta02hdq_write); + +/* sysfs */ + +static ssize_t hdq_sysfs_dump(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int n; + int v; + u8 u8a[128]; /* whole address space for HDQ */ + char *end = buf; + + /* the dump does not take care about 16 bit regs, because at this + * bus level we don't know about the chip details + */ + for (n = 0; n < sizeof(u8a); n++) { + v = gta02hdq_read(n); + if (v < 0) + goto bail; + u8a[n] = v; + } + + for (n = 0; n < sizeof(u8a); n += 16) { + hex_dump_to_buffer(u8a + n, sizeof(u8a), 16, 1, end, 4096, 0); + end += strlen(end); + *end++ = '\n'; + *end = '\0'; + } + return (end - buf); + +bail: + return sprintf(buf, "ERROR %d\n", v); +} + +/* you write by
, eg, "34 128" */ + +#define atoi(str) simple_strtoul(((str != NULL) ? str : ""), NULL, 0) + +static ssize_t hdq_sysfs_write(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t count) +{ + const char *end = buf + count; + int address = atoi(buf); + + while ((buf != end) && (*buf != ' ')) + buf++; + if (buf >= end) + return 0; + while ((buf < end) && (*buf == ' ')) + buf++; + if (buf >= end) + return 0; + + gta02hdq_write(address, atoi(buf)); + + return count; +} + +static DEVICE_ATTR(dump, 0400, hdq_sysfs_dump, NULL); +static DEVICE_ATTR(write, 0600, NULL, hdq_sysfs_write); + +static struct attribute *gta02hdq_sysfs_entries[] = { + &dev_attr_dump.attr, + &dev_attr_write.attr, + NULL +}; + +static struct attribute_group gta02hdq_attr_group = { + .name = "hdq", + .attrs = gta02hdq_sysfs_entries, +}; + + +#ifdef CONFIG_PM +static int gta02hdq_suspend(struct platform_device *pdev, pm_message_t state) +{ + /* after 18s of this, the battery monitor will also go to sleep */ + s3c2410_gpio_setpin(fiq_ipc.hdq_gpio_pin, 0); + s3c2410_gpio_cfgpin(fiq_ipc.hdq_gpio_pin, S3C2410_GPIO_OUTPUT); + return 0; +} + +static int gta02hdq_resume(struct platform_device *pdev) +{ + s3c2410_gpio_setpin(fiq_ipc.hdq_gpio_pin, 1); + s3c2410_gpio_cfgpin(fiq_ipc.hdq_gpio_pin, S3C2410_GPIO_OUTPUT); + return 0; +} +#endif + +static int __init gta02hdq_probe(struct platform_device *pdev) +{ + struct resource *r = platform_get_resource(pdev, 0, 0); + + if (!machine_is_neo1973_gta02()) + return -EIO; + + if (!r) + return -EINVAL; + + platform_set_drvdata(pdev, NULL); + + mutex_init(&fiq_ipc.hdq_lock); + + /* set our HDQ comms pin from the platform data */ + fiq_ipc.hdq_gpio_pin = r->start; + + s3c2410_gpio_setpin(fiq_ipc.hdq_gpio_pin, 1); + s3c2410_gpio_cfgpin(fiq_ipc.hdq_gpio_pin, S3C2410_GPIO_OUTPUT); + + fiq_ipc.hdq_probed = 1; /* we are ready to do stuff now */ + + return sysfs_create_group(&pdev->dev.kobj, >a02hdq_attr_group); +} + +static int gta02hdq_remove(struct platform_device *pdev) +{ + sysfs_remove_group(&pdev->dev.kobj, >a02hdq_attr_group); + return 0; +} + +static struct platform_driver gta02hdq_driver = { + .probe = gta02hdq_probe, + .remove = gta02hdq_remove, +#ifdef CONFIG_PM + .suspend = gta02hdq_suspend, + .resume = gta02hdq_resume, +#endif + .driver = { + .name = "gta02-hdq", + }, +}; + +static int __init gta02hdq_init(void) +{ + return platform_driver_register(>a02hdq_driver); +} + +static void __exit gta02hdq_exit(void) +{ + platform_driver_unregister(>a02hdq_driver); +} + +module_init(gta02hdq_init); +module_exit(gta02hdq_exit); + +MODULE_AUTHOR("Andy Green "); +MODULE_DESCRIPTION("GTA02 HDQ driver"); +MODULE_LICENSE("GPL"); diff --git a/include/asm-arm/arch-s3c2410/fiq_ipc_gta02.h b/include/asm-arm/arch-s3c2410/fiq_ipc_gta02.h index 507d235..c5eb3df 100644 --- a/include/asm-arm/arch-s3c2410/fiq_ipc_gta02.h +++ b/include/asm-arm/arch-s3c2410/fiq_ipc_gta02.h @@ -19,12 +19,35 @@ #include #include +enum hdq_bitbang_states { + HDQB_IDLE = 0, + HDQB_TX_BREAK, + HDQB_TX_BREAK_RECOVERY, + HDQB_ADS_CALC, + HDQB_ADS_LOW, + HDQB_ADS_HIGH, + HDQB_WAIT_RX, + HDQB_DATA_RX_LOW, + HDQB_DATA_RX_HIGH, + HDQB_WAIT_TX, +}; struct fiq_ipc { /* vibrator */ unsigned long vib_gpio_pin; /* which pin to meddle with */ u8 vib_pwm; /* 0 = OFF -- will ensure GPIO deasserted and stop FIQ */ u8 vib_pwm_latched; + + /* hdq */ + u8 hdq_probed; /* nonzero after HDQ driver probed */ + struct mutex hdq_lock; /* if you want to use hdq, you have to take lock */ + unsigned long hdq_gpio_pin; /* GTA02 = GPD14 which pin to meddle with */ + u8 hdq_ads; /* b7..b6 = register address, b0 = r/w */ + u8 hdq_tx_data; /* data to tx for write action */ + u8 hdq_rx_data; /* data received in read action */ + u8 hdq_request_ctr; /* incremented by "user" to request a transfer */ + u8 hdq_transaction_ctr; /* incremented after each transfer */ + u8 hdq_error; /* 0 = no error */ }; /* actual definition lives in arch/arm/mach-s3c2440/fiq_c_isr.c */ diff --git a/include/asm-arm/arch-s3c2410/gta02.h b/include/asm-arm/arch-s3c2410/gta02.h index fa49d93..f686a7a 100644 --- a/include/asm-arm/arch-s3c2410/gta02.h +++ b/include/asm-arm/arch-s3c2410/gta02.h @@ -37,6 +37,7 @@ #define GTA02v3_GPIO_nG1_CS S3C2410_GPD12 /* v3 + v4 only */ #define GTA02v3_GPIO_nG2_CS S3C2410_GPD13 /* v3 + v4 only */ +#define GTA02v5_GPIO_HDQ S3C2410_GPD14 /* v5 + */ #define GTA02_GPIO_nG1_INT S3C2410_GPF0 #define GTA02_GPIO_IO1 S3C2410_GPF1 diff --git a/include/linux/gta02_hdq.h b/include/linux/gta02_hdq.h new file mode 100644 index 0000000..2f43a62 --- /dev/null +++ b/include/linux/gta02_hdq.h @@ -0,0 +1,8 @@ +#ifndef __GTA02HDQ_H__ +#define __GTA02HDQ_H__ + +int gta02hdq_read(int address); +int gta02hdq_write(int address, u8 data); +int gta02hdq_initialized(void); + +#endif -- 1.5.6.5