diff options
Diffstat (limited to 'target')
24 files changed, 0 insertions, 12809 deletions
diff --git a/target/linux/omap24xx/patches-3.3/200-omap-platform.patch b/target/linux/omap24xx/patches-3.3/200-omap-platform.patch deleted file mode 100644 index 6c215bdbed..0000000000 --- a/target/linux/omap24xx/patches-3.3/200-omap-platform.patch +++ /dev/null @@ -1,897 +0,0 @@ ---- /dev/null -+++ b/arch/arm/plat-omap/bootreason.c -@@ -0,0 +1,79 @@ -+/* -+ * linux/arch/arm/plat-omap/bootreason.c -+ * -+ * OMAP Bootreason passing -+ * -+ * Copyright (c) 2004 Nokia -+ * -+ * Written by David Weinehall <david.weinehall@nokia.com> -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of the GNU General Public License as published by the -+ * Free Software Foundation; either version 2 of the License, or (at your -+ * option) any later version. -+ * -+ * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED -+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF -+ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN -+ * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, -+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT -+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF -+ * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON -+ * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT -+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF -+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. -+ * -+ * You should have received a copy of the GNU General Public License along -+ * with this program; if not, write to the Free Software Foundation, Inc., -+ * 675 Mass Ave, Cambridge, MA 02139, USA. -+ */ -+#include <linux/proc_fs.h> -+#include <linux/errno.h> -+#include <plat/board.h> -+ -+static char boot_reason[16]; -+ -+static int omap_bootreason_read_proc(char *page, char **start, off_t off, -+ int count, int *eof, void *data) -+{ -+ int len = 0; -+ -+ len += sprintf(page + len, "%s\n", boot_reason); -+ -+ *start = page + off; -+ -+ if (len > off) -+ len -= off; -+ else -+ len = 0; -+ -+ return len < count ? len : count; -+} -+ -+static int __init bootreason_init(void) -+{ -+ const struct omap_boot_reason_config *cfg; -+ int reason_valid = 0; -+ -+ cfg = omap_get_config(OMAP_TAG_BOOT_REASON, struct omap_boot_reason_config); -+ if (cfg != NULL) { -+ strncpy(boot_reason, cfg->reason_str, sizeof(cfg->reason_str)); -+ boot_reason[sizeof(cfg->reason_str)] = 0; -+ reason_valid = 1; -+ } else { -+ /* Read the boot reason from the OMAP registers */ -+ } -+ -+ if (!reason_valid) -+ return -ENOENT; -+ -+ printk(KERN_INFO "Bootup reason: %s\n", boot_reason); -+ -+ if (!create_proc_read_entry("bootreason", S_IRUGO, NULL, -+ omap_bootreason_read_proc, NULL)) -+ return -ENOMEM; -+ -+ return 0; -+} -+ -+late_initcall(bootreason_init); ---- a/arch/arm/plat-omap/common.c -+++ b/arch/arm/plat-omap/common.c -@@ -24,18 +24,90 @@ - - #include <plat/omap-secure.h> - -+#include <asm/setup.h> -+ - - #define NO_LENGTH_CHECK 0xffffffff - - struct omap_board_config_kernel *omap_board_config __initdata; - int omap_board_config_size; - -+unsigned char omap_bootloader_tag[1024]; -+int omap_bootloader_tag_len; -+ -+/* used by omap-smp.c and board-4430sdp.c */ -+void __iomem *gic_cpu_base_addr; -+ -+#ifdef CONFIG_OMAP_BOOT_TAG -+ -+static int __init parse_tag_omap(const struct tag *tag) -+{ -+ u32 size = tag->hdr.size - (sizeof(tag->hdr) >> 2); -+ -+ size <<= 2; -+ if (size > sizeof(omap_bootloader_tag)) -+ return -1; -+ -+ memcpy(omap_bootloader_tag, tag->u.omap.data, size); -+ omap_bootloader_tag_len = size; -+ -+ return 0; -+} -+ -+__tagtable(ATAG_BOARD, parse_tag_omap); -+ -+#endif -+ - static const void *__init get_config(u16 tag, size_t len, - int skip, size_t *len_out) - { - struct omap_board_config_kernel *kinfo = NULL; - int i; - -+#ifdef CONFIG_OMAP_BOOT_TAG -+ struct omap_board_config_entry *info = NULL; -+ -+ if (omap_bootloader_tag_len > 4) -+ info = (struct omap_board_config_entry *) omap_bootloader_tag; -+ while (info != NULL) { -+ u8 *next; -+ -+ if (info->tag == tag) { -+ if (skip == 0) -+ break; -+ skip--; -+ } -+ -+ if ((info->len & 0x03) != 0) { -+ /* We bail out to avoid an alignment fault */ -+ printk(KERN_ERR "OMAP peripheral config: Length (%d) not word-aligned (tag %04x)\n", -+ info->len, info->tag); -+ return NULL; -+ } -+ next = (u8 *) info + sizeof(*info) + info->len; -+ if (next >= omap_bootloader_tag + omap_bootloader_tag_len) -+ info = NULL; -+ else -+ info = (struct omap_board_config_entry *) next; -+ } -+ if (info != NULL) { -+ /* Check the length as a lame attempt to check for -+ * binary inconsistency. */ -+ if (len != NO_LENGTH_CHECK) { -+ /* Word-align len */ -+ if (len & 0x03) -+ len = (len + 3) & ~0x03; -+ if (info->len != len) { -+ printk(KERN_ERR "OMAP peripheral config: Length mismatch with tag %x (want %d, got %d)\n", -+ tag, len, info->len); -+ return NULL; -+ } -+ } -+ if (len_out != NULL) -+ *len_out = info->len; -+ return info->data; -+ } -+#endif - /* Try to find the config from the board-specific structures - * in the kernel. */ - for (i = 0; i < omap_board_config_size; i++) { ---- /dev/null -+++ b/arch/arm/plat-omap/component-version.c -@@ -0,0 +1,64 @@ -+/* -+ * linux/arch/arm/plat-omap/component-version.c -+ * -+ * Copyright (C) 2005 Nokia Corporation -+ * Written by Juha Yrjölä <juha.yrjola@nokia.com> -+ * -+ * 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 <linux/init.h> -+#include <linux/module.h> -+#include <linux/err.h> -+#include <linux/proc_fs.h> -+#include <plat/board.h> -+ -+static int component_version_read_proc(char *page, char **start, off_t off, -+ int count, int *eof, void *data) -+{ -+ int len, i; -+ const struct omap_version_config *ver; -+ char *p; -+ -+ i = 0; -+ p = page; -+ while ((ver = omap_get_nr_config(OMAP_TAG_VERSION_STR, -+ struct omap_version_config, i)) != NULL) { -+ p += sprintf(p, "%-12s%s\n", ver->component, ver->version); -+ i++; -+ } -+ -+ len = (p - page) - off; -+ if (len < 0) -+ len = 0; -+ -+ *eof = (len <= count) ? 1 : 0; -+ *start = page + off; -+ -+ return len; -+} -+ -+static int __init component_version_init(void) -+{ -+ if (omap_get_config(OMAP_TAG_VERSION_STR, struct omap_version_config) == NULL) -+ return -ENODEV; -+ if (!create_proc_read_entry("component_version", S_IRUGO, NULL, -+ component_version_read_proc, NULL)) -+ return -ENOMEM; -+ -+ return 0; -+} -+ -+static void __exit component_version_exit(void) -+{ -+ remove_proc_entry("component_version", NULL); -+} -+ -+late_initcall(component_version_init); -+module_exit(component_version_exit); -+ -+MODULE_AUTHOR("Juha Yrjölä <juha.yrjola@nokia.com>"); -+MODULE_DESCRIPTION("Component version driver"); -+MODULE_LICENSE("GPL"); ---- a/arch/arm/plat-omap/Kconfig -+++ b/arch/arm/plat-omap/Kconfig -@@ -84,6 +84,38 @@ config OMAP_RESET_CLOCKS - probably do not want this option enabled until your - device drivers work properly. - -+config OMAP_BOOT_TAG -+ bool "OMAP bootloader information passing" -+ depends on ARCH_OMAP -+ default n -+ help -+ Say Y, if you have a bootloader which passes information -+ about your board and its peripheral configuration. -+ -+config OMAP_BOOT_REASON -+ bool "Support for boot reason" -+ depends on OMAP_BOOT_TAG -+ default n -+ help -+ Say Y, if you want to have a procfs entry for reading the boot -+ reason in user-space. -+ -+config OMAP_COMPONENT_VERSION -+ bool "Support for component version display" -+ depends on OMAP_BOOT_TAG && PROC_FS -+ default n -+ help -+ Say Y, if you want to have a procfs entry for reading component -+ versions (supplied by the bootloader) in user-space. -+ -+config OMAP_GPIO_SWITCH -+ bool "GPIO switch support" -+ help -+ Say Y, if you want to have support for reporting of GPIO -+ switches (e.g. cover switches) via sysfs. Your bootloader has -+ to provide information about the switches to the kernel via the -+ ATAG_BOARD mechanism if they're not defined by the board config. -+ - config OMAP_MUX - bool "OMAP multiplexing support" - depends on ARCH_OMAP ---- a/arch/arm/plat-omap/Makefile -+++ b/arch/arm/plat-omap/Makefile -@@ -20,6 +20,9 @@ obj-$(CONFIG_ARCH_OMAP4) += omap_device. - obj-$(CONFIG_OMAP_MCBSP) += mcbsp.o - - obj-$(CONFIG_OMAP_DM_TIMER) += dmtimer.o -+obj-$(CONFIG_OMAP_BOOT_REASON) += bootreason.o -+obj-$(CONFIG_OMAP_COMPONENT_VERSION) += component-version.o -+obj-$(CONFIG_OMAP_GPIO_SWITCH) += gpio-switch.o - obj-$(CONFIG_OMAP_DEBUG_DEVICES) += debug-devices.o - obj-$(CONFIG_OMAP_DEBUG_LEDS) += debug-leds.o - i2c-omap-$(CONFIG_I2C_OMAP) := i2c.o ---- a/arch/arm/include/asm/setup.h -+++ b/arch/arm/include/asm/setup.h -@@ -136,6 +136,13 @@ struct tag_acorn { - __u8 adfsdrives; - }; - -+/* TI OMAP specific information */ -+#define ATAG_BOARD 0x414f4d50 -+ -+struct tag_omap { -+ u8 data[0]; -+}; -+ - /* footbridge memory clock, see arch/arm/mach-footbridge/arch.c */ - #define ATAG_MEMCLK 0x41000402 - -@@ -162,6 +169,11 @@ struct tag { - struct tag_acorn acorn; - - /* -+ * OMAP specific -+ */ -+ struct tag_omap omap; -+ -+ /* - * DC21285 specific - */ - struct tag_memclk memclk; ---- /dev/null -+++ b/arch/arm/plat-omap/gpio-switch.c -@@ -0,0 +1,554 @@ -+/* -+ * linux/arch/arm/plat-omap/gpio-switch.c -+ * -+ * Copyright (C) 2004-2006 Nokia Corporation -+ * Written by Juha Yrjölä <juha.yrjola@nokia.com> -+ * and Paul Mundt <paul.mundt@nokia.com> -+ * -+ * 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 <linux/sched.h> -+#include <linux/init.h> -+#include <linux/list.h> -+#include <linux/irq.h> -+#include <linux/interrupt.h> -+#include <linux/module.h> -+#include <linux/platform_device.h> -+#include <linux/timer.h> -+#include <linux/err.h> -+#include <linux/slab.h> -+#include <linux/gpio.h> -+#include <plat/hardware.h> -+#include <plat/irqs.h> -+#include <plat/mux.h> -+#include <plat/board.h> -+#include <plat/gpio-switch.h> -+ -+struct gpio_switch { -+ char name[14]; -+ u16 gpio; -+ unsigned flags:4; -+ unsigned type:4; -+ unsigned state:1; -+ unsigned both_edges:1; -+ -+ u16 debounce_rising; -+ u16 debounce_falling; -+ -+ void (* notify)(void *data, int state); -+ void *notify_data; -+ -+ struct work_struct work; -+ struct timer_list timer; -+ struct platform_device pdev; -+ -+ struct list_head node; -+}; -+ -+static LIST_HEAD(gpio_switches); -+static struct platform_device *gpio_sw_platform_dev; -+static struct platform_driver gpio_sw_driver; -+ -+static const struct omap_gpio_switch *board_gpio_sw_table; -+static int board_gpio_sw_count; -+ -+static const char *cover_str[2] = { "open", "closed" }; -+static const char *connection_str[2] = { "disconnected", "connected" }; -+static const char *activity_str[2] = { "inactive", "active" }; -+ -+/* -+ * GPIO switch state default debounce delay in ms -+ */ -+#define OMAP_GPIO_SW_DEFAULT_DEBOUNCE 10 -+ -+static const char **get_sw_str(struct gpio_switch *sw) -+{ -+ switch (sw->type) { -+ case OMAP_GPIO_SWITCH_TYPE_COVER: -+ return cover_str; -+ case OMAP_GPIO_SWITCH_TYPE_CONNECTION: -+ return connection_str; -+ case OMAP_GPIO_SWITCH_TYPE_ACTIVITY: -+ return activity_str; -+ default: -+ BUG(); -+ return NULL; -+ } -+} -+ -+static const char *get_sw_type(struct gpio_switch *sw) -+{ -+ switch (sw->type) { -+ case OMAP_GPIO_SWITCH_TYPE_COVER: -+ return "cover"; -+ case OMAP_GPIO_SWITCH_TYPE_CONNECTION: -+ return "connection"; -+ case OMAP_GPIO_SWITCH_TYPE_ACTIVITY: -+ return "activity"; -+ default: -+ BUG(); -+ return NULL; -+ } -+} -+ -+static void print_sw_state(struct gpio_switch *sw, int state) -+{ -+ const char **str; -+ -+ str = get_sw_str(sw); -+ if (str != NULL) -+ printk(KERN_INFO "%s (GPIO %d) is now %s\n", sw->name, sw->gpio, str[state]); -+} -+ -+static int gpio_sw_get_state(struct gpio_switch *sw) -+{ -+ int state; -+ -+ state = gpio_get_value(sw->gpio); -+ if (sw->flags & OMAP_GPIO_SWITCH_FLAG_INVERTED) -+ state = !state; -+ -+ return state; -+} -+ -+static ssize_t gpio_sw_state_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, -+ size_t count) -+{ -+ struct gpio_switch *sw = dev_get_drvdata(dev); -+ const char **str; -+ char state[16]; -+ int enable; -+ -+ if (!(sw->flags & OMAP_GPIO_SWITCH_FLAG_OUTPUT)) -+ return -EPERM; -+ -+ if (sscanf(buf, "%15s", state) != 1) -+ return -EINVAL; -+ -+ str = get_sw_str(sw); -+ if (strcmp(state, str[0]) == 0) -+ sw->state = enable = 0; -+ else if (strcmp(state, str[1]) == 0) -+ sw->state = enable = 1; -+ else -+ return -EINVAL; -+ -+ if (sw->flags & OMAP_GPIO_SWITCH_FLAG_INVERTED) -+ enable = !enable; -+ gpio_set_value(sw->gpio, enable); -+ -+ return count; -+} -+ -+static ssize_t gpio_sw_state_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct gpio_switch *sw = dev_get_drvdata(dev); -+ const char **str; -+ -+ str = get_sw_str(sw); -+ return sprintf(buf, "%s\n", str[sw->state]); -+} -+ -+static DEVICE_ATTR(state, S_IRUGO | S_IWUSR, gpio_sw_state_show, -+ gpio_sw_state_store); -+ -+static ssize_t gpio_sw_type_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct gpio_switch *sw = dev_get_drvdata(dev); -+ -+ return sprintf(buf, "%s\n", get_sw_type(sw)); -+} -+ -+static DEVICE_ATTR(type, S_IRUGO, gpio_sw_type_show, NULL); -+ -+static ssize_t gpio_sw_direction_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct gpio_switch *sw = dev_get_drvdata(dev); -+ int is_output; -+ -+ is_output = sw->flags & OMAP_GPIO_SWITCH_FLAG_OUTPUT; -+ return sprintf(buf, "%s\n", is_output ? "output" : "input"); -+} -+ -+static DEVICE_ATTR(direction, S_IRUGO, gpio_sw_direction_show, NULL); -+ -+ -+static irqreturn_t gpio_sw_irq_handler(int irq, void *arg) -+{ -+ struct gpio_switch *sw = arg; -+ unsigned long timeout; -+ int state; -+ -+ if (!sw->both_edges) { -+ if (gpio_get_value(sw->gpio)) -+ irq_set_irq_type(OMAP_GPIO_IRQ(sw->gpio), IRQ_TYPE_EDGE_FALLING); -+ else -+ irq_set_irq_type(OMAP_GPIO_IRQ(sw->gpio), IRQ_TYPE_EDGE_RISING); -+ } -+ -+ state = gpio_sw_get_state(sw); -+ if (sw->state == state) -+ return IRQ_HANDLED; -+ -+ if (state) -+ timeout = sw->debounce_rising; -+ else -+ timeout = sw->debounce_falling; -+ if (!timeout) -+ schedule_work(&sw->work); -+ else -+ mod_timer(&sw->timer, jiffies + msecs_to_jiffies(timeout)); -+ -+ return IRQ_HANDLED; -+} -+ -+static void gpio_sw_timer(unsigned long arg) -+{ -+ struct gpio_switch *sw = (struct gpio_switch *) arg; -+ -+ schedule_work(&sw->work); -+} -+ -+static void gpio_sw_handler(struct work_struct *work) -+{ -+ struct gpio_switch *sw = container_of(work, struct gpio_switch, work); -+ int state; -+ -+ state = gpio_sw_get_state(sw); -+ if (sw->state == state) -+ return; -+ -+ sw->state = state; -+ if (sw->notify != NULL) -+ sw->notify(sw->notify_data, state); -+ sysfs_notify(&sw->pdev.dev.kobj, NULL, "state"); -+ print_sw_state(sw, state); -+} -+ -+static int __init can_do_both_edges(struct gpio_switch *sw) -+{ -+ if (!cpu_class_is_omap1()) -+ return 1; -+ if (OMAP_GPIO_IS_MPUIO(sw->gpio)) -+ return 0; -+ else -+ return 1; -+} -+ -+static void gpio_sw_release(struct device *dev) -+{ -+} -+ -+static int __init new_switch(struct gpio_switch *sw) -+{ -+ int r, direction, trigger; -+ -+ switch (sw->type) { -+ case OMAP_GPIO_SWITCH_TYPE_COVER: -+ case OMAP_GPIO_SWITCH_TYPE_CONNECTION: -+ case OMAP_GPIO_SWITCH_TYPE_ACTIVITY: -+ break; -+ default: -+ printk(KERN_ERR "invalid GPIO switch type: %d\n", sw->type); -+ return -EINVAL; -+ } -+ -+ sw->pdev.name = sw->name; -+ sw->pdev.id = -1; -+ -+ sw->pdev.dev.parent = &gpio_sw_platform_dev->dev; -+ sw->pdev.dev.driver = &gpio_sw_driver.driver; -+ sw->pdev.dev.release = gpio_sw_release; -+ -+ r = platform_device_register(&sw->pdev); -+ if (r) { -+ printk(KERN_ERR "gpio-switch: platform device registration " -+ "failed for %s", sw->name); -+ return r; -+ } -+ dev_set_drvdata(&sw->pdev.dev, sw); -+ -+ r = gpio_request(sw->gpio, "gpio-switch"); -+ if (r < 0) { -+ platform_device_unregister(&sw->pdev); -+ return r; -+ } -+ -+ /* input: 1, output: 0 */ -+ direction = !(sw->flags & OMAP_GPIO_SWITCH_FLAG_OUTPUT); -+ if (direction) -+ gpio_direction_input(sw->gpio); -+ else -+ gpio_direction_output(sw->gpio, 0); -+ -+ sw->state = gpio_sw_get_state(sw); -+ -+ r = 0; -+ r |= device_create_file(&sw->pdev.dev, &dev_attr_state); -+ r |= device_create_file(&sw->pdev.dev, &dev_attr_type); -+ r |= device_create_file(&sw->pdev.dev, &dev_attr_direction); -+ if (r) -+ printk(KERN_ERR "gpio-switch: attribute file creation " -+ "failed for %s\n", sw->name); -+ -+ if (!direction) -+ return 0; -+ -+ if (can_do_both_edges(sw)) { -+ trigger = IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING; -+ sw->both_edges = 1; -+ } else { -+ if (gpio_get_value(sw->gpio)) -+ trigger = IRQF_TRIGGER_FALLING; -+ else -+ trigger = IRQF_TRIGGER_RISING; -+ } -+ r = request_irq(OMAP_GPIO_IRQ(sw->gpio), gpio_sw_irq_handler, -+ IRQF_SHARED | trigger, sw->name, sw); -+ if (r < 0) { -+ printk(KERN_ERR "gpio-switch: request_irq() failed " -+ "for GPIO %d\n", sw->gpio); -+ platform_device_unregister(&sw->pdev); -+ gpio_free(sw->gpio); -+ return r; -+ } -+ -+ INIT_WORK(&sw->work, gpio_sw_handler); -+ init_timer(&sw->timer); -+ -+ sw->timer.function = gpio_sw_timer; -+ sw->timer.data = (unsigned long)sw; -+ -+ list_add(&sw->node, &gpio_switches); -+ -+ return 0; -+} -+ -+static int __init add_atag_switches(void) -+{ -+ const struct omap_gpio_switch_config *cfg; -+ struct gpio_switch *sw; -+ int i, r; -+ -+ for (i = 0; ; i++) { -+ cfg = omap_get_nr_config(OMAP_TAG_GPIO_SWITCH, -+ struct omap_gpio_switch_config, i); -+ if (cfg == NULL) -+ break; -+ sw = kzalloc(sizeof(*sw), GFP_KERNEL); -+ if (sw == NULL) { -+ printk(KERN_ERR "gpio-switch: kmalloc failed\n"); -+ return -ENOMEM; -+ } -+ strncpy(sw->name, cfg->name, sizeof(cfg->name)); -+ sw->gpio = cfg->gpio; -+ sw->flags = cfg->flags; -+ sw->type = cfg->type; -+ sw->debounce_rising = OMAP_GPIO_SW_DEFAULT_DEBOUNCE; -+ sw->debounce_falling = OMAP_GPIO_SW_DEFAULT_DEBOUNCE; -+ if ((r = new_switch(sw)) < 0) { -+ kfree(sw); -+ return r; -+ } -+ } -+ return 0; -+} -+ -+static struct gpio_switch * __init find_switch(int gpio, const char *name) -+{ -+ struct gpio_switch *sw; -+ -+ list_for_each_entry(sw, &gpio_switches, node) { -+ if ((gpio < 0 || sw->gpio != gpio) && -+ (name == NULL || strcmp(sw->name, name) != 0)) -+ continue; -+ -+ if (gpio < 0 || name == NULL) -+ goto no_check; -+ -+ if (strcmp(sw->name, name) != 0) -+ printk("gpio-switch: name mismatch for %d (%s, %s)\n", -+ gpio, name, sw->name); -+ else if (sw->gpio != gpio) -+ printk("gpio-switch: GPIO mismatch for %s (%d, %d)\n", -+ name, gpio, sw->gpio); -+no_check: -+ return sw; -+ } -+ return NULL; -+} -+ -+static int __init add_board_switches(void) -+{ -+ int i; -+ -+ for (i = 0; i < board_gpio_sw_count; i++) { -+ const struct omap_gpio_switch *cfg; -+ struct gpio_switch *sw; -+ int r; -+ -+ cfg = board_gpio_sw_table + i; -+ if (strlen(cfg->name) > sizeof(sw->name) - 1) -+ return -EINVAL; -+ /* Check whether we only update an existing switch -+ * or add a new switch. */ -+ sw = find_switch(cfg->gpio, cfg->name); -+ if (sw != NULL) { -+ sw->debounce_rising = cfg->debounce_rising; -+ sw->debounce_falling = cfg->debounce_falling; -+ sw->notify = cfg->notify; -+ sw->notify_data = cfg->notify_data; -+ continue; -+ } else { -+ if (cfg->gpio < 0 || cfg->name == NULL) { -+ printk("gpio-switch: required switch not " -+ "found (%d, %s)\n", cfg->gpio, -+ cfg->name); -+ continue; -+ } -+ } -+ sw = kzalloc(sizeof(*sw), GFP_KERNEL); -+ if (sw == NULL) { -+ printk(KERN_ERR "gpio-switch: kmalloc failed\n"); -+ return -ENOMEM; -+ } -+ strlcpy(sw->name, cfg->name, sizeof(sw->name)); -+ sw->gpio = cfg->gpio; -+ sw->flags = cfg->flags; -+ sw->type = cfg->type; -+ sw->debounce_rising = cfg->debounce_rising; -+ sw->debounce_falling = cfg->debounce_falling; -+ sw->notify = cfg->notify; -+ sw->notify_data = cfg->notify_data; -+ if ((r = new_switch(sw)) < 0) { -+ kfree(sw); -+ return r; -+ } -+ } -+ return 0; -+} -+ -+static void gpio_sw_cleanup(void) -+{ -+ struct gpio_switch *sw = NULL, *old = NULL; -+ -+ list_for_each_entry(sw, &gpio_switches, node) { -+ if (old != NULL) -+ kfree(old); -+ flush_scheduled_work(); -+ del_timer_sync(&sw->timer); -+ -+ free_irq(OMAP_GPIO_IRQ(sw->gpio), sw); -+ -+ device_remove_file(&sw->pdev.dev, &dev_attr_state); -+ device_remove_file(&sw->pdev.dev, &dev_attr_type); -+ device_remove_file(&sw->pdev.dev, &dev_attr_direction); -+ -+ platform_device_unregister(&sw->pdev); -+ gpio_free(sw->gpio); -+ old = sw; -+ } -+ kfree(old); -+} -+ -+static void __init report_initial_state(void) -+{ -+ struct gpio_switch *sw; -+ -+ list_for_each_entry(sw, &gpio_switches, node) { -+ int state; -+ -+ state = gpio_get_value(sw->gpio); -+ if (sw->flags & OMAP_GPIO_SWITCH_FLAG_INVERTED) -+ state = !state; -+ if (sw->notify != NULL) -+ sw->notify(sw->notify_data, state); -+ print_sw_state(sw, state); -+ } -+} -+ -+static int gpio_sw_remove(struct platform_device *dev) -+{ -+ return 0; -+} -+ -+static struct platform_driver gpio_sw_driver = { -+ .remove = gpio_sw_remove, -+ .driver = { -+ .name = "gpio-switch", -+ }, -+}; -+ -+void __init omap_register_gpio_switches(const struct omap_gpio_switch *tbl, -+ int count) -+{ -+ BUG_ON(board_gpio_sw_table != NULL); -+ -+ board_gpio_sw_table = tbl; -+ board_gpio_sw_count = count; -+} -+ -+static int __init gpio_sw_init(void) -+{ -+ int r; -+ -+ printk(KERN_INFO "OMAP GPIO switch handler initializing\n"); -+ -+ r = platform_driver_register(&gpio_sw_driver); -+ if (r) -+ return r; -+ -+ gpio_sw_platform_dev = platform_device_register_simple("gpio-switch", -+ -1, NULL, 0); -+ if (IS_ERR(gpio_sw_platform_dev)) { -+ r = PTR_ERR(gpio_sw_platform_dev); -+ goto err1; -+ } -+ -+ r = add_atag_switches(); -+ if (r < 0) -+ goto err2; -+ -+ r = add_board_switches(); -+ if (r < 0) -+ goto err2; -+ -+ report_initial_state(); -+ -+ return 0; -+err2: -+ gpio_sw_cleanup(); -+ platform_device_unregister(gpio_sw_platform_dev); -+err1: -+ platform_driver_unregister(&gpio_sw_driver); -+ return r; -+} -+ -+static void __exit gpio_sw_exit(void) -+{ -+ gpio_sw_cleanup(); -+ platform_device_unregister(gpio_sw_platform_dev); -+ platform_driver_unregister(&gpio_sw_driver); -+} -+ -+#ifndef MODULE -+late_initcall(gpio_sw_init); -+#else -+module_init(gpio_sw_init); -+#endif -+module_exit(gpio_sw_exit); -+ -+MODULE_AUTHOR("Juha Yrjölä <juha.yrjola@nokia.com>, Paul Mundt <paul.mundt@nokia.com"); -+MODULE_DESCRIPTION("GPIO switch driver"); -+MODULE_LICENSE("GPL"); ---- a/arch/arm/plat-omap/include/plat/board.h -+++ b/arch/arm/plat-omap/include/plat/board.h -@@ -151,6 +151,14 @@ struct omap_board_config_kernel { - const void *data; - }; - -+struct omap_gpio_switch_config { -+ char name[12]; -+ u16 gpio; -+ int flags:4; -+ int type:4; -+ int key_code:24; /* Linux key code */ -+}; -+ - extern const void *__init __omap_get_config(u16 tag, size_t len, int nr); - - #define omap_get_config(tag, type) \ diff --git a/target/linux/omap24xx/patches-3.3/250-cbus.patch b/target/linux/omap24xx/patches-3.3/250-cbus.patch deleted file mode 100644 index b152a00b5b..0000000000 --- a/target/linux/omap24xx/patches-3.3/250-cbus.patch +++ /dev/null @@ -1,3463 +0,0 @@ ---- /dev/null -+++ b/drivers/cbus/cbus.c -@@ -0,0 +1,335 @@ -+/* -+ * drivers/cbus/cbus.c -+ * -+ * Support functions for CBUS serial protocol -+ * -+ * Copyright (C) 2004-2010 Nokia Corporation -+ * Contact: Felipe Balbi <felipe.balbi@nokia.com> -+ * -+ * Written by Juha Yrjölä <juha.yrjola@nokia.com>, -+ * David Weinehall <david.weinehall@nokia.com>, and -+ * Mikko Ylinen <mikko.k.ylinen@nokia.com> -+ * -+ * Several updates and cleanups by Felipe Balbi <felipe.balbi@nokia.com> -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#include <linux/device.h> -+#include <linux/init.h> -+#include <linux/kernel.h> -+#include <linux/export.h> -+#include <linux/module.h> -+#include <linux/slab.h> -+#include <linux/spinlock.h> -+#include <linux/gpio.h> -+#include <linux/platform_device.h> -+#include <linux/platform_data/cbus.h> -+ -+#include "cbus.h" -+ -+#define CBUS_XFER_READ 1 -+#define CBUS_XFER_WRITE 0 -+ -+struct cbus_host { -+ /* host lock */ -+ spinlock_t lock; -+ -+ struct device *dev; -+ -+ int clk_gpio; -+ int dat_gpio; -+ int sel_gpio; -+}; -+ -+/** -+ * cbus_send_bit - sends one bit over the bus -+ * @host: the host we're using -+ * @bit: one bit of information to send -+ * @input: whether to set data pin as input after sending -+ */ -+static int cbus_send_bit(struct cbus_host *host, unsigned bit, -+ unsigned input) -+{ -+ int ret = 0; -+ -+ gpio_set_value(host->dat_gpio, bit ? 1 : 0); -+ gpio_set_value(host->clk_gpio, 1); -+ -+ /* The data bit is read on the rising edge of CLK */ -+ if (input) -+ ret = gpio_direction_input(host->dat_gpio); -+ -+ gpio_set_value(host->clk_gpio, 0); -+ -+ return ret; -+} -+ -+/** -+ * cbus_send_data - sends @len amount of data over the bus -+ * @host: the host we're using -+ * @data: the data to send -+ * @len: size of the transfer -+ * @input: whether to set data pin as input after sending -+ */ -+static int cbus_send_data(struct cbus_host *host, unsigned data, unsigned len, -+ unsigned input) -+{ -+ int ret = 0; -+ int i; -+ -+ for (i = len; i > 0; i--) { -+ ret = cbus_send_bit(host, data & (1 << (i - 1)), -+ input && (i == 1)); -+ if (ret < 0) -+ goto out; -+ } -+ -+out: -+ return ret; -+} -+ -+/** -+ * cbus_receive_bit - receives one bit from the bus -+ * @host: the host we're using -+ */ -+static int cbus_receive_bit(struct cbus_host *host) -+{ -+ int ret; -+ -+ gpio_set_value(host->clk_gpio, 1); -+ ret = gpio_get_value(host->dat_gpio); -+ if (ret < 0) -+ goto out; -+ gpio_set_value(host->clk_gpio, 0); -+ -+out: -+ return ret; -+} -+ -+/** -+ * cbus_receive_data - receives @len data from the bus -+ * @host: the host we're using -+ * @len: the length of data to receive -+ */ -+static int cbus_receive_data(struct cbus_host *host, unsigned len) -+{ -+ int ret = 0; -+ int i; -+ -+ for (i = 16; i > 0; i--) { -+ int bit = cbus_receive_bit(host); -+ -+ if (bit < 0) -+ goto out; -+ -+ if (bit) -+ ret |= 1 << (i - 1); -+ } -+ -+out: -+ return ret; -+} -+ -+/** -+ * cbus_transfer - transfers data over the bus -+ * @host: the host we're using -+ * @rw: read/write flag -+ * @dev: device address -+ * @reg: register address -+ * @data: if @rw == 0 data to send otherwise 0 -+ */ -+static int cbus_transfer(struct cbus_host *host, unsigned rw, unsigned dev, -+ unsigned reg, unsigned data) -+{ -+ unsigned long flags; -+ int input = 0; -+ int ret = 0; -+ -+ /* We don't want interrupts disturbing our transfer */ -+ spin_lock_irqsave(&host->lock, flags); -+ -+ /* Reset state and start of transfer, SEL stays down during transfer */ -+ gpio_set_value(host->sel_gpio, 0); -+ -+ /* Set the DAT pin to output */ -+ gpio_direction_output(host->dat_gpio, 1); -+ -+ /* Send the device address */ -+ ret = cbus_send_data(host, dev, 3, 0); -+ if (ret < 0) { -+ dev_dbg(host->dev, "failed sending device addr\n"); -+ goto out; -+ } -+ -+ /* Send the rw flag */ -+ ret = cbus_send_bit(host, rw, 0); -+ if (ret < 0) { -+ dev_dbg(host->dev, "failed sending read/write flag\n"); -+ goto out; -+ } -+ -+ /* Send the register address */ -+ if (rw) -+ input = true; -+ -+ ret = cbus_send_data(host, reg, 5, input); -+ if (ret < 0) { -+ dev_dbg(host->dev, "failed sending register addr\n"); -+ goto out; -+ } -+ -+ if (!rw) { -+ ret = cbus_send_data(host, data, 16, 0); -+ if (ret < 0) { -+ dev_dbg(host->dev, "failed sending data\n"); -+ goto out; -+ } -+ } else { -+ gpio_set_value(host->clk_gpio, 1); -+ -+ ret = cbus_receive_data(host, 16); -+ if (ret < 0) { -+ dev_dbg(host->dev, "failed receiving data\n"); -+ goto out; -+ } -+ } -+ -+ /* Indicate end of transfer, SEL goes up until next transfer */ -+ gpio_set_value(host->sel_gpio, 1); -+ gpio_set_value(host->clk_gpio, 1); -+ gpio_set_value(host->clk_gpio, 0); -+ -+out: -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ return ret; -+} -+ -+/** -+ * cbus_read_reg - reads a given register from the device -+ * @child: the child device -+ * @dev: device address -+ * @reg: register address -+ */ -+int cbus_read_reg(struct device *child, unsigned dev, unsigned reg) -+{ -+ struct cbus_host *host = dev_get_drvdata(child->parent); -+ -+ return cbus_transfer(host, CBUS_XFER_READ, dev, reg, 0); -+} -+EXPORT_SYMBOL(cbus_read_reg); -+ -+/** -+ * cbus_write_reg - writes to a given register of the device -+ * @child: the child device -+ * @dev: device address -+ * @reg: register address -+ * @val: data to be written to @reg -+ */ -+int cbus_write_reg(struct device *child, unsigned dev, unsigned reg, -+ unsigned val) -+{ -+ struct cbus_host *host = dev_get_drvdata(child->parent); -+ -+ return cbus_transfer(host, CBUS_XFER_WRITE, dev, reg, val); -+} -+EXPORT_SYMBOL(cbus_write_reg); -+ -+static int __init cbus_bus_probe(struct platform_device *pdev) -+{ -+ struct cbus_host *chost; -+ struct cbus_host_platform_data *pdata = pdev->dev.platform_data; -+ int ret; -+ -+ chost = kzalloc(sizeof(*chost), GFP_KERNEL); -+ if (chost == NULL) -+ return -ENOMEM; -+ -+ spin_lock_init(&chost->lock); -+ -+ chost->clk_gpio = pdata->clk_gpio; -+ chost->dat_gpio = pdata->dat_gpio; -+ chost->sel_gpio = pdata->sel_gpio; -+ chost->dev = &pdev->dev; -+ -+ ret = gpio_request(chost->clk_gpio, "CBUS clk"); -+ if (ret < 0) -+ goto exit1; -+ -+ ret = gpio_request(chost->dat_gpio, "CBUS data"); -+ if (ret < 0) -+ goto exit2; -+ -+ ret = gpio_request(chost->sel_gpio, "CBUS sel"); -+ if (ret < 0) -+ goto exit3; -+ -+ gpio_direction_output(chost->clk_gpio, 0); -+ gpio_direction_input(chost->dat_gpio); -+ gpio_direction_output(chost->sel_gpio, 1); -+ -+ gpio_set_value(chost->clk_gpio, 1); -+ gpio_set_value(chost->clk_gpio, 0); -+ -+ platform_set_drvdata(pdev, chost); -+ -+ return 0; -+exit3: -+ gpio_free(chost->dat_gpio); -+exit2: -+ gpio_free(chost->clk_gpio); -+exit1: -+ kfree(chost); -+ -+ return ret; -+} -+ -+static void __exit cbus_bus_remove(struct platform_device *pdev) -+{ -+ struct cbus_host *chost = platform_get_drvdata(pdev); -+ -+ gpio_free(chost->sel_gpio); -+ gpio_free(chost->dat_gpio); -+ gpio_free(chost->clk_gpio); -+ -+ kfree(chost); -+} -+ -+static struct platform_driver cbus_driver = { -+ .remove = __exit_p(cbus_bus_remove), -+ .driver = { -+ .name = "cbus", -+ }, -+}; -+ -+static int __init cbus_bus_init(void) -+{ -+ return platform_driver_probe(&cbus_driver, cbus_bus_probe); -+} -+subsys_initcall(cbus_bus_init); -+ -+static void __exit cbus_bus_exit(void) -+{ -+ platform_driver_unregister(&cbus_driver); -+} -+module_exit(cbus_bus_exit); -+ -+MODULE_DESCRIPTION("CBUS serial protocol"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Juha Yrjölä"); -+MODULE_AUTHOR("David Weinehall"); -+MODULE_AUTHOR("Mikko Ylinen"); -+MODULE_AUTHOR("Felipe Balbi <felipe.balbi@nokia.com>"); -+ ---- /dev/null -+++ b/drivers/cbus/cbus.h -@@ -0,0 +1,30 @@ -+/* -+ * drivers/cbus/cbus.h -+ * -+ * Copyright (C) 2004, 2005 Nokia Corporation -+ * -+ * Written by Juha Yrjölä <juha.yrjola@nokia.com> and -+ * David Weinehall <david.weinehall@nokia.com> -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#ifndef __DRIVERS_CBUS_CBUS_H -+#define __DRIVERS_CBUS_CBUS_H -+ -+extern int cbus_read_reg(struct device *, unsigned dev, unsigned reg); -+extern int cbus_write_reg(struct device *, unsigned dev, unsigned reg, -+ unsigned val); -+ -+#endif /* __DRIVERS_CBUS_CBUS_H */ ---- /dev/null -+++ b/drivers/cbus/Kconfig -@@ -0,0 +1,86 @@ -+# -+# CBUS device configuration -+# -+ -+menu "CBUS support" -+ -+config CBUS -+ bool "CBUS support on OMAP" -+ ---help--- -+ CBUS is a proprietary serial protocol by Nokia. It is mainly -+ used for accessing Energy Management auxiliary chips. -+ -+ If you want CBUS support, you should say Y here. -+ -+config CBUS_TAHVO -+ depends on CBUS -+ bool "Support for Tahvo" -+ ---help--- -+ Tahvo is a mixed signal ASIC with some system features -+ -+ If you want Tahvo support, you should say Y here. -+ -+if CBUS_TAHVO -+ -+config CBUS_TAHVO_USB -+ depends on USB -+ depends on ARCH_OMAP -+ select USB_OTG_UTILS -+ tristate "Support for Tahvo USB transceiver" -+ ---help--- -+ If you want Tahvo support for USB transceiver, say Y or M here. -+ -+config CBUS_TAHVO_USB_HOST_BY_DEFAULT -+ depends on CBUS_TAHVO_USB && USB_OTG -+ boolean "Device in USB host mode by default" -+ ---help--- -+ Say Y here, if you want the device to enter USB host mode -+ by default on bootup. -+ -+endif # CBUS_TAHVO -+ -+config CBUS_RETU -+ depends on CBUS -+ bool "Support for Retu" -+ ---help--- -+ Retu is a mixed signal ASIC with some system features -+ -+ If you want Retu support, you should say Y here. -+ -+if CBUS_RETU -+ -+config CBUS_RETU_POWERBUTTON -+ depends on INPUT -+ bool "Support for Retu power button" -+ ---help--- -+ The power button on Nokia 770 is connected to the Retu ASIC. -+ -+ If you want support for the Retu power button, you should say Y here. -+ -+config CBUS_RETU_RTC -+ depends on RTC_CLASS -+ depends on ARCH_OMAP -+ tristate "Support for Retu pseudo-RTC" -+ ---help--- -+ Say Y here if you want support for the device that alleges to be an -+ RTC in Retu. This will expose a sysfs interface for it. -+ -+config CBUS_RETU_WDT -+ depends on SYSFS && WATCHDOG -+ depends on ARCH_OMAP -+ tristate "Support for Retu watchdog timer" -+ ---help--- -+ Say Y here if you want support for the watchdog in Retu. This will -+ expose a sysfs interface to grok it. -+ -+config CBUS_RETU_HEADSET -+ depends on SYSFS -+ tristate "Support for headset detection with Retu/Vilma" -+ ---help--- -+ Say Y here if you want support detecting a headset that's connected -+ to Retu/Vilma. Detection state and events are exposed through -+ sysfs. -+ -+endif # CBUS_RETU -+ -+endmenu ---- /dev/null -+++ b/drivers/cbus/Makefile -@@ -0,0 +1,13 @@ -+# -+# Makefile for CBUS. -+# -+ -+obj-$(CONFIG_CBUS) += cbus.o -+obj-$(CONFIG_CBUS_TAHVO) += tahvo.o -+obj-$(CONFIG_CBUS_RETU) += retu.o -+obj-$(CONFIG_CBUS_TAHVO_USB) += tahvo-usb.o -+ -+obj-$(CONFIG_CBUS_RETU_POWERBUTTON) += retu-pwrbutton.o -+obj-$(CONFIG_CBUS_RETU_RTC) += retu-rtc.o -+obj-$(CONFIG_CBUS_RETU_WDT) += retu-wdt.o -+obj-$(CONFIG_CBUS_RETU_HEADSET) += retu-headset.o ---- /dev/null -+++ b/drivers/cbus/retu.c -@@ -0,0 +1,549 @@ -+/** -+ * drivers/cbus/retu.c -+ * -+ * Support functions for Retu ASIC -+ * -+ * Copyright (C) 2004, 2005 Nokia Corporation -+ * -+ * Written by Juha Yrjölä <juha.yrjola@nokia.com>, -+ * David Weinehall <david.weinehall@nokia.com>, and -+ * Mikko Ylinen <mikko.k.ylinen@nokia.com> -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#include <linux/module.h> -+#include <linux/init.h> -+ -+#include <linux/slab.h> -+#include <linux/kernel.h> -+#include <linux/errno.h> -+#include <linux/device.h> -+#include <linux/mutex.h> -+#include <linux/irq.h> -+#include <linux/interrupt.h> -+#include <linux/platform_device.h> -+#include <linux/platform_data/cbus.h> -+ -+#include <asm/bitops.h> -+ -+#include "cbus.h" -+#include "retu.h" -+ -+struct retu { -+ /* Device lock */ -+ struct mutex mutex; -+ struct device *dev; -+ -+ int devid; -+ -+ int irq_base; -+ int irq_end; -+ -+ int irq; -+ -+ int ack; -+ bool ack_pending; -+ -+ int mask; -+ bool mask_pending; -+ -+ bool is_vilma; -+}; -+ -+static struct retu *the_retu; -+ -+/** -+ * __retu_read_reg - Read a value from a register in Retu -+ * @retu: pointer to retu structure -+ * @reg: the register address to read from -+ */ -+static int __retu_read_reg(struct retu *retu, unsigned reg) -+{ -+ return cbus_read_reg(retu->dev, retu->devid, reg); -+} -+ -+/** -+ * __retu_write_reg - Writes a value to a register in Retu -+ * @retu: pointer to retu structure -+ * @reg: the register address to write to -+ * @val: the value to write to the register -+ */ -+static void __retu_write_reg(struct retu *retu, unsigned reg, u16 val) -+{ -+ cbus_write_reg(retu->dev, retu->devid, reg, val); -+} -+ -+/** -+ * retu_read_reg - Read a value from a register in Retu -+ * @child: device pointer for the calling child -+ * @reg: the register to read from -+ * -+ * This function returns the contents of the specified register -+ */ -+int retu_read_reg(struct device *child, unsigned reg) -+{ -+ struct retu *retu = dev_get_drvdata(child->parent); -+ -+ return __retu_read_reg(retu, reg); -+} -+EXPORT_SYMBOL_GPL(retu_read_reg); -+ -+/** -+ * retu_write_reg - Write a value to a register in Retu -+ * @child: the pointer to our calling child -+ * @reg: the register to write to -+ * @val: the value to write to the register -+ * -+ * This function writes a value to the specified register -+ */ -+void retu_write_reg(struct device *child, unsigned reg, u16 val) -+{ -+ struct retu *retu = dev_get_drvdata(child->parent); -+ -+ mutex_lock(&retu->mutex); -+ __retu_write_reg(retu, reg, val); -+ mutex_unlock(&retu->mutex); -+} -+EXPORT_SYMBOL_GPL(retu_write_reg); -+ -+/** -+ * retu_set_clear_reg_bits - helper function to read/set/clear bits -+ * @child: device pointer to calling child -+ * @reg: the register address -+ * @set: mask for setting bits -+ * @clear: mask for clearing bits -+ */ -+void retu_set_clear_reg_bits(struct device *child, unsigned reg, u16 set, -+ u16 clear) -+{ -+ struct retu *retu = dev_get_drvdata(child->parent); -+ u16 w; -+ -+ mutex_lock(&retu->mutex); -+ w = __retu_read_reg(retu, reg); -+ w &= ~clear; -+ w |= set; -+ __retu_write_reg(retu, reg, w); -+ mutex_unlock(&retu->mutex); -+} -+EXPORT_SYMBOL_GPL(retu_set_clear_reg_bits); -+ -+#define ADC_MAX_CHAN_NUMBER 13 -+ -+/** -+ * retu_read_adc - Reads AD conversion result -+ * @child: device pointer to calling child -+ * @channel: the ADC channel to read from -+ */ -+int retu_read_adc(struct device *child, int channel) -+{ -+ struct retu *retu = dev_get_drvdata(child->parent); -+ int res; -+ -+ if (!retu) -+ return -ENODEV; -+ -+ if (channel < 0 || channel > ADC_MAX_CHAN_NUMBER) -+ return -EINVAL; -+ -+ mutex_lock(&retu->mutex); -+ -+ if ((channel == 8) && retu->is_vilma) { -+ int scr = __retu_read_reg(retu, RETU_REG_ADCSCR); -+ int ch = (__retu_read_reg(retu, RETU_REG_ADCR) >> 10) & 0xf; -+ if (((scr & 0xff) != 0) && (ch != 8)) -+ __retu_write_reg(retu, RETU_REG_ADCSCR, (scr & ~0xff)); -+ } -+ -+ /* Select the channel and read result */ -+ __retu_write_reg(retu, RETU_REG_ADCR, channel << 10); -+ res = __retu_read_reg(retu, RETU_REG_ADCR) & 0x3ff; -+ -+ if (retu->is_vilma) -+ __retu_write_reg(retu, RETU_REG_ADCR, (1 << 13)); -+ -+ /* Unlock retu */ -+ mutex_unlock(&retu->mutex); -+ -+ return res; -+} -+EXPORT_SYMBOL_GPL(retu_read_adc); -+ -+static irqreturn_t retu_irq_handler(int irq, void *_retu) -+{ -+ struct retu *retu = _retu; -+ -+ u16 idr; -+ u16 imr; -+ -+ mutex_lock(&retu->mutex); -+ idr = __retu_read_reg(retu, RETU_REG_IDR); -+ imr = __retu_read_reg(retu, RETU_REG_IMR); -+ mutex_unlock(&retu->mutex); -+ -+ idr &= ~imr; -+ if (!idr) { -+ dev_vdbg(retu->dev, "No IRQ, spurious?\n"); -+ return IRQ_NONE; -+ } -+ -+ while (idr) { -+ unsigned long pending = __ffs(idr); -+ unsigned int irq; -+ -+ idr &= ~BIT(pending); -+ irq = pending + retu->irq_base; -+ handle_nested_irq(irq); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+/* -------------------------------------------------------------------------- */ -+ -+static void retu_irq_mask(struct irq_data *data) -+{ -+ struct retu *retu = irq_data_get_irq_chip_data(data); -+ int irq = data->irq; -+ -+ retu->mask |= (1 << (irq - retu->irq_base)); -+ retu->mask_pending = true; -+} -+ -+static void retu_irq_unmask(struct irq_data *data) -+{ -+ struct retu *retu = irq_data_get_irq_chip_data(data); -+ int irq = data->irq; -+ -+ retu->mask &= ~(1 << (irq - retu->irq_base)); -+ retu->mask_pending = true; -+ -+} -+ -+static void retu_irq_ack(struct irq_data *data) -+{ -+ struct retu *retu = irq_data_get_irq_chip_data(data); -+ int irq = data->irq; -+ -+ retu->ack |= (1 << (irq - retu->irq_base)); -+ retu->ack_pending = true; -+} -+ -+static void retu_bus_lock(struct irq_data *data) -+{ -+ struct retu *retu = irq_data_get_irq_chip_data(data); -+ -+ mutex_lock(&retu->mutex); -+} -+ -+static void retu_bus_sync_unlock(struct irq_data *data) -+{ -+ struct retu *retu = irq_data_get_irq_chip_data(data); -+ -+ if (retu->mask_pending) { -+ __retu_write_reg(retu, RETU_REG_IMR, retu->mask); -+ retu->mask_pending = false; -+ } -+ -+ if (retu->ack_pending) { -+ __retu_write_reg(retu, RETU_REG_IDR, retu->ack); -+ retu->ack_pending = false; -+ } -+ -+ mutex_unlock(&retu->mutex); -+} -+ -+static struct irq_chip retu_irq_chip = { -+ .name = "retu", -+ .irq_bus_lock = retu_bus_lock, -+ .irq_bus_sync_unlock = retu_bus_sync_unlock, -+ .irq_mask = retu_irq_mask, -+ .irq_unmask = retu_irq_unmask, -+ .irq_ack = retu_irq_ack, -+}; -+ -+static inline void retu_irq_setup(int irq) -+{ -+#ifdef CONFIG_ARM -+ set_irq_flags(irq, IRQF_VALID); -+#else -+ irq_set_noprobe(irq); -+#endif -+} -+ -+static void retu_irq_init(struct retu *retu) -+{ -+ int base = retu->irq_base; -+ int end = retu->irq_end; -+ int irq; -+ -+ for (irq = base; irq < end; irq++) { -+ irq_set_chip_data(irq, retu); -+ irq_set_chip_and_handler(irq, &retu_irq_chip, -+ handle_simple_irq); -+ irq_set_nested_thread(irq, 1); -+ retu_irq_setup(irq); -+ } -+} -+ -+static void retu_irq_exit(struct retu *retu) -+{ -+ int base = retu->irq_base; -+ int end = retu->irq_end; -+ int irq; -+ -+ for (irq = base; irq < end; irq++) { -+#ifdef CONFIG_ARM -+ set_irq_flags(irq, 0); -+#endif -+ irq_set_chip_and_handler(irq, NULL, NULL); -+ irq_set_chip_data(irq, NULL); -+ } -+} -+ -+/* -------------------------------------------------------------------------- */ -+ -+/** -+ * retu_power_off - Shut down power to system -+ * -+ * This function puts the system in power off state -+ */ -+static void retu_power_off(void) -+{ -+ struct retu *retu = the_retu; -+ unsigned reg; -+ -+ reg = __retu_read_reg(retu, RETU_REG_CC1); -+ -+ /* Ignore power button state */ -+ __retu_write_reg(retu, RETU_REG_CC1, reg | 2); -+ /* Expire watchdog immediately */ -+ __retu_write_reg(retu, RETU_REG_WATCHDOG, 0); -+ /* Wait for poweroff*/ -+ for (;;); -+} -+ -+static struct resource generic_resources[] = { -+ { -+ .start = -EINVAL, /* fixed later */ -+ .flags = IORESOURCE_IRQ, -+ }, -+ { -+ .start = -EINVAL, /* fixed later */ -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+/** -+ * retu_allocate_child - Allocates one Retu child -+ * @name: name of new child -+ * @parent: parent device for this child -+ */ -+static struct device *retu_allocate_child(char *name, struct device *parent, -+ int irq_base, int irq1, int irq2, int num) -+{ -+ struct platform_device *pdev; -+ int status; -+ -+ pdev = platform_device_alloc(name, -1); -+ if (!pdev) { -+ dev_dbg(parent, "can't allocate %s\n", name); -+ goto err; -+ } -+ -+ pdev->dev.parent = parent; -+ -+ if (num) { -+ generic_resources[0].start = irq_base + irq1; -+ generic_resources[1].start = irq_base + irq2; -+ -+ status = platform_device_add_resources(pdev, -+ generic_resources, num); -+ if (status < 0) { -+ dev_dbg(parent, "can't add resources to %s\n", name); -+ goto err; -+ } -+ } -+ -+ status = platform_device_add(pdev); -+ if (status < 0) { -+ dev_dbg(parent, "can't add %s\n", name); -+ goto err; -+ } -+ -+ return &pdev->dev; -+ -+err: -+ platform_device_put(pdev); -+ -+ return NULL; -+} -+ -+/** -+ * retu_allocate_children - Allocates Retu's children -+ */ -+static int retu_allocate_children(struct device *parent, int irq_base) -+{ -+ struct device *child; -+ -+ child = retu_allocate_child("retu-pwrbutton", parent, irq_base, -+ RETU_INT_PWR, -1, 1); -+ if (!child) -+ return -ENOMEM; -+ -+ child = retu_allocate_child("retu-headset", parent, irq_base, -+ RETU_INT_HOOK, -1, 1); -+ if (!child) -+ return -ENOMEM; -+ -+ child = retu_allocate_child("retu-rtc", parent, irq_base, -+ RETU_INT_RTCS, RETU_INT_RTCA, 2); -+ if (!child) -+ return -ENOMEM; -+ -+ child = retu_allocate_child("retu-wdt", parent, -1, -1, -1, 0); -+ if (!child) -+ return -ENOMEM; -+ -+ return 0; -+} -+ -+/** -+ * retu_probe - Probe for Retu ASIC -+ * @dev: the Retu device -+ * -+ * Probe for the Retu ASIC and allocate memory -+ * for its device-struct if found -+ */ -+static int __devinit retu_probe(struct platform_device *pdev) -+{ -+ struct retu *retu; -+ struct cbus_retu_platform_data *pdata = pdev->dev.platform_data; -+ -+ int ret = -ENOMEM; -+ int rev; -+ -+ retu = kzalloc(sizeof(*retu), GFP_KERNEL); -+ if (!retu) { -+ dev_err(&pdev->dev, "not enough memory\n"); -+ goto err0; -+ } -+ -+ platform_set_drvdata(pdev, retu); -+ -+ ret = irq_alloc_descs(-1, 0, MAX_RETU_IRQ_HANDLERS, 0); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "failed to allocate IRQ descs\n"); -+ goto err1; -+ } -+ -+ retu->irq = platform_get_irq(pdev, 0); -+ retu->irq_base = ret; -+ retu->irq_end = ret + MAX_RETU_IRQ_HANDLERS; -+ retu->devid = pdata->devid; -+ retu->dev = &pdev->dev; -+ the_retu = retu; -+ -+ mutex_init(&retu->mutex); -+ -+ retu_irq_init(retu); -+ -+ rev = __retu_read_reg(retu, RETU_REG_ASICR) & 0xff; -+ if (rev & (1 << 7)) -+ retu->is_vilma = true; -+ -+ dev_info(&pdev->dev, "%s v%d.%d found\n", -+ retu->is_vilma ? "Vilma" : "Retu", -+ (rev >> 4) & 0x07, rev & 0x0f); -+ -+ /* Mask all RETU interrupts */ -+ __retu_write_reg(retu, RETU_REG_IMR, 0xffff); -+ -+ ret = request_threaded_irq(retu->irq, NULL, retu_irq_handler, -+ IRQF_ONESHOT, "retu", retu); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "Unable to register IRQ handler\n"); -+ goto err2; -+ } -+ -+ irq_set_irq_wake(retu->irq, 1); -+ -+ /* Register power off function */ -+ pm_power_off = retu_power_off; -+ -+ ret = retu_allocate_children(&pdev->dev, retu->irq_base); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "Unable to allocate Retu children\n"); -+ goto err3; -+ } -+ -+ return 0; -+ -+err3: -+ pm_power_off = NULL; -+ free_irq(retu->irq, retu); -+ -+err2: -+ retu_irq_exit(retu); -+ irq_free_descs(retu->irq_base, MAX_RETU_IRQ_HANDLERS); -+ -+err1: -+ kfree(retu); -+ the_retu = NULL; -+ -+err0: -+ return ret; -+} -+ -+static int __devexit retu_remove(struct platform_device *pdev) -+{ -+ struct retu *retu = platform_get_drvdata(pdev); -+ -+ pm_power_off = NULL; -+ the_retu = NULL; -+ -+ free_irq(retu->irq, retu); -+ retu_irq_exit(retu); -+ irq_free_descs(retu->irq_base, MAX_RETU_IRQ_HANDLERS); -+ kfree(retu); -+ -+ return 0; -+} -+ -+static struct platform_driver retu_driver = { -+ .probe = retu_probe, -+ .remove = __devexit_p(retu_remove), -+ .driver = { -+ .name = "retu", -+ }, -+}; -+ -+static int __init retu_init(void) -+{ -+ return platform_driver_register(&retu_driver); -+} -+subsys_initcall(retu_init); -+ -+static void __exit retu_exit(void) -+{ -+ platform_driver_unregister(&retu_driver); -+} -+module_exit(retu_exit); -+ -+MODULE_DESCRIPTION("Retu ASIC control"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Juha Yrjölä"); -+MODULE_AUTHOR("David Weinehall"); -+MODULE_AUTHOR("Mikko Ylinen"); ---- /dev/null -+++ b/drivers/cbus/retu.h -@@ -0,0 +1,85 @@ -+/** -+ * drivers/cbus/retu.h -+ * -+ * Copyright (C) 2004, 2005 Nokia Corporation -+ * -+ * Written by Juha Yrjölä <juha.yrjola@nokia.com> and -+ * David Weinehall <david.weinehall@nokia.com> -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#ifndef __DRIVERS_CBUS_RETU_H -+#define __DRIVERS_CBUS_RETU_H -+ -+#include <linux/types.h> -+ -+/* Registers */ -+#define RETU_REG_ASICR 0x00 /* ASIC ID & revision */ -+#define RETU_REG_IDR 0x01 /* Interrupt ID */ -+#define RETU_REG_IMR 0x02 /* Interrupt mask */ -+#define RETU_REG_RTCDSR 0x03 /* RTC seconds register */ -+#define RETU_REG_RTCHMR 0x04 /* RTC hours and minutes register */ -+#define RETU_REG_RTCHMAR 0x05 /* RTC hours and minutes alarm and time set register */ -+#define RETU_REG_RTCCALR 0x06 /* RTC calibration register */ -+#define RETU_REG_ADCR 0x08 /* ADC result */ -+#define RETU_REG_ADCSCR 0x09 /* ADC sample ctrl */ -+#define RETU_REG_CC1 0x0d /* Common control register 1 */ -+#define RETU_REG_CC2 0x0e /* Common control register 2 */ -+#define RETU_REG_CTRL_CLR 0x0f /* Regulator clear register */ -+#define RETU_REG_CTRL_SET 0x10 /* Regulator set register */ -+#define RETU_REG_STATUS 0x16 /* Status register */ -+#define RETU_REG_STATUS_BATAVAIL 0x0100 /* Battery available */ -+#define RETU_REG_STATUS_CHGPLUG 0x1000 /* Charger is plugged in */ -+#define RETU_REG_WATCHDOG 0x17 /* Watchdog register */ -+#define RETU_REG_AUDTXR 0x18 /* Audio Codec Tx register */ -+#define RETU_REG_MAX 0x1f -+ -+/* Interrupt sources */ -+#define RETU_INT_PWR 0 -+#define RETU_INT_CHAR 1 -+#define RETU_INT_RTCS 2 -+#define RETU_INT_RTCM 3 -+#define RETU_INT_RTCD 4 -+#define RETU_INT_RTCA 5 -+#define RETU_INT_HOOK 6 -+#define RETU_INT_HEAD 7 -+#define RETU_INT_ADCS 8 -+ -+#define MAX_RETU_IRQ_HANDLERS 16 -+ -+/* ADC channels */ -+#define RETU_ADC_GND 0x00 /* Ground */ -+#define RETU_ADC_BSI 0x01 /* Battery Size Indicator */ -+#define RETU_ADC_BATTEMP 0x02 /* Battery temperature */ -+#define RETU_ADC_CHGVOLT 0x03 /* Charger voltage */ -+#define RETU_ADC_HEADSET 0x04 /* Headset detection */ -+#define RETU_ADC_HOOKDET 0x05 /* Hook detection */ -+#define RETU_ADC_RFGP 0x06 /* RF GP */ -+#define RETU_ADC_WBTX 0x07 /* Wideband Tx detection */ -+#define RETU_ADC_BATTVOLT 0x08 /* Battery voltage measurement */ -+#define RETU_ADC_GND2 0x09 /* Ground */ -+#define RETU_ADC_LIGHTSENS 0x0A /* Light sensor */ -+#define RETU_ADC_LIGHTTEMP 0x0B /* Light sensor temperature */ -+#define RETU_ADC_BKUPVOLT 0x0C /* Backup battery voltage */ -+#define RETU_ADC_TEMP 0x0D /* RETU temperature */ -+ -+ -+int retu_read_reg(struct device *child, unsigned reg); -+void retu_write_reg(struct device *child, unsigned reg, u16 val); -+void retu_set_clear_reg_bits(struct device *child, unsigned reg, u16 set, -+ u16 clear); -+int retu_read_adc(struct device *child, int channel); -+ -+#endif /* __DRIVERS_CBUS_RETU_H */ ---- /dev/null -+++ b/drivers/cbus/retu-headset.c -@@ -0,0 +1,359 @@ -+/** -+ * Retu/Vilma headset detection -+ * -+ * Copyright (C) 2006 Nokia Corporation -+ * -+ * Written by Juha Yrjölä -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#include <linux/module.h> -+#include <linux/init.h> -+#include <linux/kernel.h> -+#include <linux/irq.h> -+#include <linux/interrupt.h> -+#include <linux/slab.h> -+#include <linux/delay.h> -+#include <linux/input.h> -+#include <linux/platform_device.h> -+ -+#include "retu.h" -+ -+#define RETU_ADC_CHANNEL_HOOKDET 0x05 -+ -+#define RETU_HEADSET_KEY KEY_PHONE -+ -+struct retu_headset { -+ spinlock_t lock; -+ struct mutex mutex; -+ struct device *dev; -+ struct input_dev *idev; -+ unsigned bias_enabled; -+ unsigned detection_enabled; -+ unsigned pressed; -+ struct timer_list enable_timer; -+ struct timer_list detect_timer; -+ int irq; -+}; -+ -+static void retu_headset_set_bias(struct retu_headset *hs, int enable) -+{ -+ if (enable) { -+ retu_set_clear_reg_bits(hs->dev, RETU_REG_AUDTXR, -+ (1 << 0) | (1 << 1), 0); -+ msleep(2); -+ retu_set_clear_reg_bits(hs->dev, RETU_REG_AUDTXR, -+ 1 << 3, 0); -+ } else { -+ retu_set_clear_reg_bits(hs->dev, RETU_REG_AUDTXR, 0, -+ (1 << 0) | (1 << 1) | (1 << 3)); -+ } -+} -+ -+static void retu_headset_enable(struct retu_headset *hs) -+{ -+ mutex_lock(&hs->mutex); -+ if (!hs->bias_enabled) { -+ hs->bias_enabled = 1; -+ retu_headset_set_bias(hs, 1); -+ } -+ mutex_unlock(&hs->mutex); -+} -+ -+static void retu_headset_disable(struct retu_headset *hs) -+{ -+ mutex_lock(&hs->mutex); -+ if (hs->bias_enabled) { -+ hs->bias_enabled = 0; -+ retu_headset_set_bias(hs, 0); -+ } -+ mutex_unlock(&hs->mutex); -+} -+ -+static void retu_headset_det_enable(struct retu_headset *hs) -+{ -+ mutex_lock(&hs->mutex); -+ if (!hs->detection_enabled) { -+ hs->detection_enabled = 1; -+ retu_set_clear_reg_bits(hs->dev, RETU_REG_CC1, -+ (1 << 10) | (1 << 8), 0); -+ } -+ mutex_unlock(&hs->mutex); -+} -+ -+static void retu_headset_det_disable(struct retu_headset *hs) -+{ -+ unsigned long flags; -+ -+ mutex_lock(&hs->mutex); -+ if (hs->detection_enabled) { -+ hs->detection_enabled = 0; -+ del_timer_sync(&hs->enable_timer); -+ del_timer_sync(&hs->detect_timer); -+ spin_lock_irqsave(&hs->lock, flags); -+ if (hs->pressed) -+ input_report_key(hs->idev, RETU_HEADSET_KEY, 0); -+ spin_unlock_irqrestore(&hs->lock, flags); -+ retu_set_clear_reg_bits(hs->dev, RETU_REG_CC1, 0, -+ (1 << 10) | (1 << 8)); -+ } -+ mutex_unlock(&hs->mutex); -+} -+ -+static ssize_t retu_headset_hookdet_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ int val; -+ -+ val = retu_read_adc(dev, RETU_ADC_CHANNEL_HOOKDET); -+ return sprintf(buf, "%d\n", val); -+} -+ -+static DEVICE_ATTR(hookdet, S_IRUGO, retu_headset_hookdet_show, NULL); -+ -+static ssize_t retu_headset_enable_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct retu_headset *hs = dev_get_drvdata(dev); -+ -+ return sprintf(buf, "%u\n", hs->bias_enabled); -+} -+ -+static ssize_t retu_headset_enable_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct retu_headset *hs = dev_get_drvdata(dev); -+ int enable; -+ -+ if (sscanf(buf, "%u", &enable) != 1) -+ return -EINVAL; -+ if (enable) -+ retu_headset_enable(hs); -+ else -+ retu_headset_disable(hs); -+ return count; -+} -+ -+static DEVICE_ATTR(enable, S_IRUGO | S_IWUSR | S_IWGRP, -+ retu_headset_enable_show, retu_headset_enable_store); -+ -+static ssize_t retu_headset_enable_det_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct retu_headset *hs = dev_get_drvdata(dev); -+ -+ return sprintf(buf, "%u\n", hs->detection_enabled); -+} -+ -+static ssize_t retu_headset_enable_det_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct retu_headset *hs = dev_get_drvdata(dev); -+ int enable; -+ -+ if (sscanf(buf, "%u", &enable) != 1) -+ return -EINVAL; -+ if (enable) -+ retu_headset_det_enable(hs); -+ else -+ retu_headset_det_disable(hs); -+ return count; -+} -+ -+static DEVICE_ATTR(enable_det, S_IRUGO | S_IWUSR | S_IWGRP, -+ retu_headset_enable_det_show, -+ retu_headset_enable_det_store); -+ -+static irqreturn_t retu_headset_hook_interrupt(int irq, void *_hs) -+{ -+ struct retu_headset *hs = _hs; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&hs->lock, flags); -+ if (!hs->pressed) { -+ /* Headset button was just pressed down. */ -+ hs->pressed = 1; -+ input_report_key(hs->idev, RETU_HEADSET_KEY, 1); -+ } -+ spin_unlock_irqrestore(&hs->lock, flags); -+ retu_set_clear_reg_bits(hs->dev, RETU_REG_CC1, 0, -+ (1 << 10) | (1 << 8)); -+ mod_timer(&hs->enable_timer, jiffies + msecs_to_jiffies(50)); -+ -+ return IRQ_HANDLED; -+} -+ -+static void retu_headset_enable_timer(unsigned long arg) -+{ -+ struct retu_headset *hs = (struct retu_headset *) arg; -+ -+ retu_set_clear_reg_bits(hs->dev, RETU_REG_CC1, -+ (1 << 10) | (1 << 8), 0); -+ mod_timer(&hs->detect_timer, jiffies + msecs_to_jiffies(350)); -+} -+ -+static void retu_headset_detect_timer(unsigned long arg) -+{ -+ struct retu_headset *hs = (struct retu_headset *) arg; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&hs->lock, flags); -+ if (hs->pressed) { -+ hs->pressed = 0; -+ input_report_key(hs->idev, RETU_HEADSET_KEY, 0); -+ } -+ spin_unlock_irqrestore(&hs->lock, flags); -+} -+ -+static int __init retu_headset_probe(struct platform_device *pdev) -+{ -+ struct retu_headset *hs; -+ int irq; -+ int r; -+ -+ hs = kzalloc(sizeof(*hs), GFP_KERNEL); -+ if (hs == NULL) -+ return -ENOMEM; -+ -+ hs->dev = &pdev->dev; -+ -+ hs->idev = input_allocate_device(); -+ if (hs->idev == NULL) { -+ r = -ENOMEM; -+ goto err1; -+ } -+ hs->idev->name = "retu-headset"; -+ hs->idev->dev.parent = &pdev->dev; -+ set_bit(EV_KEY, hs->idev->evbit); -+ set_bit(RETU_HEADSET_KEY, hs->idev->keybit); -+ r = input_register_device(hs->idev); -+ if (r < 0) -+ goto err2; -+ -+ r = device_create_file(&pdev->dev, &dev_attr_hookdet); -+ if (r < 0) -+ goto err3; -+ r = device_create_file(&pdev->dev, &dev_attr_enable); -+ if (r < 0) -+ goto err4; -+ r = device_create_file(&pdev->dev, &dev_attr_enable_det); -+ if (r < 0) -+ goto err5; -+ platform_set_drvdata(pdev, hs); -+ -+ spin_lock_init(&hs->lock); -+ mutex_init(&hs->mutex); -+ setup_timer(&hs->enable_timer, retu_headset_enable_timer, -+ (unsigned long) hs); -+ setup_timer(&hs->detect_timer, retu_headset_detect_timer, -+ (unsigned long) hs); -+ -+ irq = platform_get_irq(pdev, 0); -+ hs->irq = irq; -+ -+ r = request_threaded_irq(irq, NULL, retu_headset_hook_interrupt, 0, -+ "hookdet", hs); -+ if (r != 0) { -+ dev_err(&pdev->dev, "hookdet IRQ not available\n"); -+ goto err6; -+ } -+ -+ return 0; -+err6: -+ device_remove_file(&pdev->dev, &dev_attr_enable_det); -+err5: -+ device_remove_file(&pdev->dev, &dev_attr_enable); -+err4: -+ device_remove_file(&pdev->dev, &dev_attr_hookdet); -+err3: -+ input_unregister_device(hs->idev); -+err2: -+ input_free_device(hs->idev); -+err1: -+ kfree(hs); -+ return r; -+} -+ -+static int retu_headset_remove(struct platform_device *pdev) -+{ -+ struct retu_headset *hs = platform_get_drvdata(pdev); -+ -+ device_remove_file(&pdev->dev, &dev_attr_hookdet); -+ device_remove_file(&pdev->dev, &dev_attr_enable); -+ device_remove_file(&pdev->dev, &dev_attr_enable_det); -+ retu_headset_disable(hs); -+ retu_headset_det_disable(hs); -+ free_irq(hs->irq, hs); -+ input_unregister_device(hs->idev); -+ input_free_device(hs->idev); -+ -+ return 0; -+} -+ -+static int retu_headset_suspend(struct platform_device *pdev, -+ pm_message_t mesg) -+{ -+ struct retu_headset *hs = platform_get_drvdata(pdev); -+ -+ mutex_lock(&hs->mutex); -+ if (hs->bias_enabled) -+ retu_headset_set_bias(hs, 0); -+ mutex_unlock(&hs->mutex); -+ -+ return 0; -+} -+ -+static int retu_headset_resume(struct platform_device *pdev) -+{ -+ struct retu_headset *hs = platform_get_drvdata(pdev); -+ -+ mutex_lock(&hs->mutex); -+ if (hs->bias_enabled) -+ retu_headset_set_bias(hs, 1); -+ mutex_unlock(&hs->mutex); -+ -+ return 0; -+} -+ -+static struct platform_driver retu_headset_driver = { -+ .remove = retu_headset_remove, -+ .suspend = retu_headset_suspend, -+ .resume = retu_headset_resume, -+ .driver = { -+ .name = "retu-headset", -+ }, -+}; -+ -+static int __init retu_headset_init(void) -+{ -+ return platform_driver_probe(&retu_headset_driver, retu_headset_probe); -+} -+ -+static void __exit retu_headset_exit(void) -+{ -+ platform_driver_unregister(&retu_headset_driver); -+} -+ -+module_init(retu_headset_init); -+module_exit(retu_headset_exit); -+ -+MODULE_DESCRIPTION("Retu/Vilma headset detection"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Juha Yrjölä"); ---- /dev/null -+++ b/drivers/cbus/retu-pwrbutton.c -@@ -0,0 +1,165 @@ -+/** -+ * drivers/cbus/retu-pwrbutton.c -+ * -+ * Driver for sending retu power button event to input-layer -+ * -+ * Copyright (C) 2004-2010 Nokia Corporation -+ * -+ * Written by -+ * Ari Saastamoinen <ari.saastamoinen@elektrobit.com> -+ * Juha Yrjola <juha.yrjola@solidboot.com> -+ * -+ * Contact: Felipe Balbi <felipe.balbi@nokia.com> -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#include <linux/module.h> -+#include <linux/init.h> -+#include <linux/kernel.h> -+#include <linux/errno.h> -+#include <linux/input.h> -+#include <linux/jiffies.h> -+#include <linux/bitops.h> -+#include <linux/irq.h> -+#include <linux/interrupt.h> -+#include <linux/platform_device.h> -+#include <linux/slab.h> -+ -+#include "retu.h" -+ -+#define RETU_STATUS_PWRONX (1 << 5) -+ -+#define PWRBTN_DELAY 20 -+#define PWRBTN_UP 0 -+#define PWRBTN_PRESSED 1 -+ -+struct retu_pwrbutton { -+ struct input_dev *idev; -+ struct device *dev; -+ -+ int state; -+ int irq; -+}; -+ -+static irqreturn_t retubutton_irq(int irq, void *_pwr) -+{ -+ struct retu_pwrbutton *pwr = _pwr; -+ int state; -+ -+ if (retu_read_reg(pwr->dev, RETU_REG_STATUS) & RETU_STATUS_PWRONX) -+ state = PWRBTN_UP; -+ else -+ state = PWRBTN_PRESSED; -+ -+ if (pwr->state != state) { -+ input_report_key(pwr->idev, KEY_POWER, state); -+ input_sync(pwr->idev); -+ pwr->state = state; -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static int __init retubutton_probe(struct platform_device *pdev) -+{ -+ struct retu_pwrbutton *pwr; -+ int ret = 0; -+ -+ pwr = kzalloc(sizeof(*pwr), GFP_KERNEL); -+ if (!pwr) { -+ dev_err(&pdev->dev, "not enough memory\n"); -+ ret = -ENOMEM; -+ goto err0; -+ } -+ -+ pwr->dev = &pdev->dev; -+ pwr->irq = platform_get_irq(pdev, 0); -+ platform_set_drvdata(pdev, pwr); -+ -+ ret = request_threaded_irq(pwr->irq, NULL, retubutton_irq, 0, -+ "retu-pwrbutton", pwr); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "Cannot allocate irq\n"); -+ goto err1; -+ } -+ -+ pwr->idev = input_allocate_device(); -+ if (!pwr->idev) { -+ dev_err(&pdev->dev, "can't allocate input device\n"); -+ ret = -ENOMEM; -+ goto err2; -+ } -+ -+ pwr->idev->evbit[0] = BIT_MASK(EV_KEY); -+ pwr->idev->keybit[BIT_WORD(KEY_POWER)] = BIT_MASK(KEY_POWER); -+ pwr->idev->name = "retu-pwrbutton"; -+ -+ ret = input_register_device(pwr->idev); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "failed to register input device\n"); -+ goto err3; -+ } -+ -+ return 0; -+ -+err3: -+ input_free_device(pwr->idev); -+ -+err2: -+ free_irq(pwr->irq, pwr); -+ -+err1: -+ kfree(pwr); -+ -+err0: -+ return ret; -+} -+ -+static int __exit retubutton_remove(struct platform_device *pdev) -+{ -+ struct retu_pwrbutton *pwr = platform_get_drvdata(pdev); -+ -+ free_irq(pwr->irq, pwr); -+ input_unregister_device(pwr->idev); -+ input_free_device(pwr->idev); -+ kfree(pwr); -+ -+ return 0; -+} -+ -+static struct platform_driver retu_pwrbutton_driver = { -+ .remove = __exit_p(retubutton_remove), -+ .driver = { -+ .name = "retu-pwrbutton", -+ }, -+}; -+ -+static int __init retubutton_init(void) -+{ -+ return platform_driver_probe(&retu_pwrbutton_driver, retubutton_probe); -+} -+module_init(retubutton_init); -+ -+static void __exit retubutton_exit(void) -+{ -+ platform_driver_unregister(&retu_pwrbutton_driver); -+} -+module_exit(retubutton_exit); -+ -+MODULE_DESCRIPTION("Retu Power Button"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Ari Saastamoinen"); -+MODULE_AUTHOR("Felipe Balbi <felipe.balbi@nokia.com>"); -+ ---- /dev/null -+++ b/drivers/cbus/retu-rtc.c -@@ -0,0 +1,287 @@ -+/** -+ * drivers/cbus/retu-rtc.c -+ * -+ * Support for Retu RTC -+ * -+ * Copyright (C) 2004, 2005 Nokia Corporation -+ * -+ * Written by Paul Mundt <paul.mundt@nokia.com> and -+ * Igor Stoppa <igor.stoppa@nokia.com> -+ * -+ * The Retu RTC is essentially a partial read-only RTC that gives us Retu's -+ * idea of what time actually is. It's left as a userspace excercise to map -+ * this back to time in the real world and ensure that calibration settings -+ * are sane to compensate for any horrible drift (on account of not being able -+ * to set the clock to anything). -+ * -+ * Days are semi-writeable. Namely, Retu will only track 255 days for us -+ * consecutively, after which the counter is explicitly stuck at 255 until -+ * someone comes along and clears it with a write. In the event that no one -+ * comes along and clears it, we no longer have any idea what day it is. -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#include <linux/device.h> -+#include <linux/init.h> -+#include <linux/kernel.h> -+#include <linux/slab.h> -+#include <linux/module.h> -+#include <linux/platform_device.h> -+#include <linux/mutex.h> -+#include <linux/rtc.h> -+ -+#include "cbus.h" -+#include "retu.h" -+ -+struct retu_rtc { -+ /* device lock */ -+ struct mutex mutex; -+ struct device *dev; -+ struct rtc_device *rtc; -+ -+ u16 alarm_expired; -+ int irq_rtcs; -+ int irq_rtca; -+}; -+ -+static void retu_rtc_do_reset(struct retu_rtc *rtc) -+{ -+ u16 ccr1; -+ -+ ccr1 = retu_read_reg(rtc->dev, RETU_REG_CC1); -+ /* RTC in reset */ -+ retu_write_reg(rtc->dev, RETU_REG_CC1, ccr1 | 0x0001); -+ /* RTC in normal operating mode */ -+ retu_write_reg(rtc->dev, RETU_REG_CC1, ccr1 & ~0x0001); -+ -+ /* Disable alarm and RTC WD */ -+ retu_write_reg(rtc->dev, RETU_REG_RTCHMAR, 0x7f3f); -+ /* Set Calibration register to default value */ -+ retu_write_reg(rtc->dev, RETU_REG_RTCCALR, 0x00c0); -+ -+ rtc->alarm_expired = 0; -+} -+ -+static irqreturn_t retu_rtc_interrupt(int irq, void *_rtc) -+{ -+ struct retu_rtc *rtc = _rtc; -+ -+ mutex_lock(&rtc->mutex); -+ rtc->alarm_expired = 1; -+ retu_write_reg(rtc->dev, RETU_REG_RTCHMAR, (24 << 8) | 60); -+ mutex_unlock(&rtc->mutex); -+ -+ return IRQ_HANDLED; -+} -+ -+static int retu_rtc_init_irq(struct retu_rtc *rtc) -+{ -+ int irq; -+ int ret; -+ -+ irq = platform_get_irq(to_platform_device(rtc->dev), 0); -+ rtc->irq_rtcs = irq; -+ -+ irq = platform_get_irq(to_platform_device(rtc->dev), 1); -+ rtc->irq_rtca = irq; -+ -+ ret = request_threaded_irq(rtc->irq_rtcs, NULL, retu_rtc_interrupt, -+ 0, "RTCS", rtc); -+ if (ret != 0) -+ return ret; -+ -+ ret = request_threaded_irq(rtc->irq_rtca, NULL, retu_rtc_interrupt, -+ 0, "RTCA", rtc); -+ if (ret != 0) { -+ free_irq(rtc->irq_rtcs, rtc); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static int retu_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alm) -+{ -+ struct retu_rtc *rtc = dev_get_drvdata(dev); -+ u16 chmar; -+ -+ mutex_lock(&rtc->mutex); -+ -+ chmar = ((alm->time.tm_hour & 0x1f) << 8) | (alm->time.tm_min & 0x3f); -+ retu_write_reg(rtc->dev, RETU_REG_RTCHMAR, chmar); -+ -+ mutex_unlock(&rtc->mutex); -+ -+ return 0; -+} -+ -+static int retu_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alm) -+{ -+ struct retu_rtc *rtc = dev_get_drvdata(dev); -+ u16 chmar; -+ -+ mutex_lock(&rtc->mutex); -+ -+ chmar = retu_read_reg(rtc->dev, RETU_REG_RTCHMAR); -+ -+ alm->time.tm_hour = (chmar >> 8) & 0x1f; -+ alm->time.tm_min = chmar & 0x3f; -+ alm->enabled = !!rtc->alarm_expired; -+ -+ mutex_unlock(&rtc->mutex); -+ -+ return 0; -+} -+ -+static int retu_rtc_set_time(struct device *dev, struct rtc_time *tm) -+{ -+ struct retu_rtc *rtc = dev_get_drvdata(dev); -+ u16 dsr; -+ u16 hmr; -+ -+ dsr = ((tm->tm_mday & 0xff) << 8) | (tm->tm_hour & 0xff); -+ hmr = ((tm->tm_min & 0xff) << 8) | (tm->tm_sec & 0xff); -+ -+ mutex_lock(&rtc->mutex); -+ -+ retu_write_reg(rtc->dev, RETU_REG_RTCDSR, dsr); -+ retu_write_reg(rtc->dev, RETU_REG_RTCHMR, hmr); -+ -+ mutex_unlock(&rtc->mutex); -+ -+ return 0; -+} -+ -+static int retu_rtc_read_time(struct device *dev, struct rtc_time *tm) -+{ -+ struct retu_rtc *rtc = dev_get_drvdata(dev); -+ u16 dsr; -+ u16 hmr; -+ -+ /* -+ * DSR holds days and hours -+ * HMR hols minutes and seconds -+ * -+ * both are 16 bit registers with 8-bit for each field. -+ */ -+ -+ mutex_lock(&rtc->mutex); -+ -+ dsr = retu_read_reg(rtc->dev, RETU_REG_RTCDSR); -+ hmr = retu_read_reg(rtc->dev, RETU_REG_RTCHMR); -+ -+ tm->tm_sec = hmr & 0xff; -+ tm->tm_min = hmr >> 8; -+ tm->tm_hour = dsr & 0xff; -+ tm->tm_mday = dsr >> 8; -+ -+ mutex_unlock(&rtc->mutex); -+ -+ return 0; -+} -+ -+static struct rtc_class_ops retu_rtc_ops = { -+ .read_time = retu_rtc_read_time, -+ .set_time = retu_rtc_set_time, -+ .read_alarm = retu_rtc_read_alarm, -+ .set_alarm = retu_rtc_set_alarm, -+}; -+ -+static int __init retu_rtc_probe(struct platform_device *pdev) -+{ -+ struct retu_rtc *rtc; -+ int r; -+ -+ rtc = kzalloc(sizeof(*rtc), GFP_KERNEL); -+ if (!rtc) { -+ dev_err(&pdev->dev, "not enough memory\n"); -+ r = -ENOMEM; -+ goto err0; -+ } -+ -+ rtc->dev = &pdev->dev; -+ platform_set_drvdata(pdev, rtc); -+ mutex_init(&rtc->mutex); -+ -+ rtc->alarm_expired = retu_read_reg(rtc->dev, RETU_REG_IDR) & -+ (0x1 << RETU_INT_RTCA); -+ -+ r = retu_rtc_init_irq(rtc); -+ if (r < 0) { -+ dev_err(&pdev->dev, "failed to request retu irq\n"); -+ goto err1; -+ } -+ -+ /* If the calibration register is zero, we've probably lost power */ -+ if (!(retu_read_reg(rtc->dev, RETU_REG_RTCCALR) & 0x00ff)) -+ retu_rtc_do_reset(rtc); -+ -+ rtc->rtc = rtc_device_register(pdev->name, &pdev->dev, & -+ retu_rtc_ops, THIS_MODULE); -+ if (IS_ERR(rtc->rtc)) { -+ dev_err(&pdev->dev, "can't register RTC device\n"); -+ goto err2; -+ } -+ -+ return 0; -+ -+err2: -+ free_irq(rtc->irq_rtcs, rtc); -+ free_irq(rtc->irq_rtca, rtc); -+ -+err1: -+ kfree(rtc); -+ -+err0: -+ return r; -+} -+ -+static int __devexit retu_rtc_remove(struct platform_device *pdev) -+{ -+ struct retu_rtc *rtc = platform_get_drvdata(pdev); -+ -+ free_irq(rtc->irq_rtcs, rtc); -+ free_irq(rtc->irq_rtca, rtc); -+ rtc_device_unregister(rtc->rtc); -+ kfree(rtc); -+ -+ return 0; -+} -+ -+static struct platform_driver retu_rtc_driver = { -+ .remove = __exit_p(retu_rtc_remove), -+ .driver = { -+ .name = "retu-rtc", -+ }, -+}; -+ -+static int __init retu_rtc_init(void) -+{ -+ return platform_driver_probe(&retu_rtc_driver, retu_rtc_probe); -+} -+module_init(retu_rtc_init); -+ -+static void __exit retu_rtc_exit(void) -+{ -+ platform_driver_unregister(&retu_rtc_driver); -+} -+module_exit(retu_rtc_exit); -+ -+MODULE_DESCRIPTION("Retu RTC"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Paul Mundt"); -+MODULE_AUTHOR("Igor Stoppa"); -+MODULE_AUTHOR("Felipe Balbi <felipe.balbi@nokia.com>"); -+ ---- /dev/null -+++ b/drivers/cbus/retu-wdt.c -@@ -0,0 +1,272 @@ -+/** -+ * drivers/cbus/retu-wdt.c -+ * -+ * Driver for Retu watchdog -+ * -+ * Copyright (C) 2004, 2005 Nokia Corporation -+ * -+ * Written by Amit Kucheria <amit.kucheria@nokia.com> -+ * -+ * Cleanups by Michael Buesch <mb@bu3sch.de> (C) 2011 -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#include <linux/kernel.h> -+#include <linux/slab.h> -+#include <linux/module.h> -+#include <linux/device.h> -+#include <linux/init.h> -+#include <linux/fs.h> -+#include <linux/io.h> -+#include <linux/platform_device.h> -+ -+#include <linux/completion.h> -+#include <linux/errno.h> -+#include <linux/moduleparam.h> -+#include <linux/miscdevice.h> -+#include <linux/watchdog.h> -+ -+#include <asm/uaccess.h> -+ -+#include <plat/prcm.h> -+ -+#include "cbus.h" -+#include "retu.h" -+ -+/* Watchdog timeout in seconds */ -+#define RETU_WDT_MIN_TIMER 0 -+#define RETU_WDT_DEFAULT_TIMER 32 -+#define RETU_WDT_MAX_TIMER 63 -+ -+struct retu_wdt_dev { -+ struct device *dev; -+ unsigned int period_val; /* Current period of watchdog */ -+ unsigned long users; -+ struct miscdevice miscdev; -+ struct delayed_work ping_work; -+ struct mutex mutex; -+}; -+ -+ -+static inline void _retu_modify_counter(struct retu_wdt_dev *wdev, -+ unsigned int new) -+{ -+ retu_write_reg(wdev->dev, RETU_REG_WATCHDOG, (u16)new); -+} -+ -+static int retu_modify_counter(struct retu_wdt_dev *wdev, unsigned int new) -+{ -+ if (new < RETU_WDT_MIN_TIMER || new > RETU_WDT_MAX_TIMER) -+ return -EINVAL; -+ -+ mutex_lock(&wdev->mutex); -+ wdev->period_val = new; -+ _retu_modify_counter(wdev, wdev->period_val); -+ mutex_unlock(&wdev->mutex); -+ -+ return 0; -+} -+ -+/* -+ * Since retu watchdog cannot be disabled in hardware, we must kick it -+ * with a timer until userspace watchdog software takes over. Do this -+ * unless /dev/watchdog is open or CONFIG_WATCHDOG_NOWAYOUT is set. -+ */ -+static void retu_wdt_ping_enable(struct retu_wdt_dev *wdev) -+{ -+ _retu_modify_counter(wdev, RETU_WDT_MAX_TIMER); -+ schedule_delayed_work(&wdev->ping_work, -+ round_jiffies_relative(RETU_WDT_DEFAULT_TIMER * HZ)); -+} -+ -+static void retu_wdt_ping_disable(struct retu_wdt_dev *wdev) -+{ -+ _retu_modify_counter(wdev, RETU_WDT_MAX_TIMER); -+ cancel_delayed_work_sync(&wdev->ping_work); -+} -+ -+static void retu_wdt_ping_work(struct work_struct *work) -+{ -+ struct retu_wdt_dev *wdev = container_of(to_delayed_work(work), -+ struct retu_wdt_dev, ping_work); -+ retu_wdt_ping_enable(wdev); -+} -+ -+static int retu_wdt_open(struct inode *inode, struct file *file) -+{ -+ struct miscdevice *mdev = file->private_data; -+ struct retu_wdt_dev *wdev = container_of(mdev, struct retu_wdt_dev, miscdev); -+ -+ if (test_and_set_bit(0, &wdev->users)) -+ return -EBUSY; -+ -+ retu_wdt_ping_disable(wdev); -+ -+ return nonseekable_open(inode, file); -+} -+ -+static int retu_wdt_release(struct inode *inode, struct file *file) -+{ -+ struct miscdevice *mdev = file->private_data; -+ struct retu_wdt_dev *wdev = container_of(mdev, struct retu_wdt_dev, miscdev); -+ -+#ifndef CONFIG_WATCHDOG_NOWAYOUT -+ retu_wdt_ping_enable(wdev); -+#endif -+ clear_bit(0, &wdev->users); -+ -+ return 0; -+} -+ -+static ssize_t retu_wdt_write(struct file *file, const char __user *data, -+ size_t len, loff_t *ppos) -+{ -+ struct miscdevice *mdev = file->private_data; -+ struct retu_wdt_dev *wdev = container_of(mdev, struct retu_wdt_dev, miscdev); -+ -+ if (len) -+ retu_modify_counter(wdev, RETU_WDT_MAX_TIMER); -+ -+ return len; -+} -+ -+static long retu_wdt_ioctl(struct file *file, unsigned int cmd, -+ unsigned long arg) -+{ -+ struct miscdevice *mdev = file->private_data; -+ struct retu_wdt_dev *wdev = container_of(mdev, struct retu_wdt_dev, miscdev); -+ int new_margin; -+ -+ static const struct watchdog_info ident = { -+ .identity = "Retu Watchdog", -+ .options = WDIOF_SETTIMEOUT, -+ .firmware_version = 0, -+ }; -+ -+ switch (cmd) { -+ default: -+ return -ENOTTY; -+ case WDIOC_GETSUPPORT: -+ return copy_to_user((struct watchdog_info __user *)arg, &ident, -+ sizeof(ident)); -+ case WDIOC_GETSTATUS: -+ return put_user(0, (int __user *)arg); -+ case WDIOC_GETBOOTSTATUS: -+ if (cpu_is_omap16xx()) -+ return put_user(omap_readw(ARM_SYSST), -+ (int __user *)arg); -+ if (cpu_is_omap24xx()) -+ return put_user(omap_prcm_get_reset_sources(), -+ (int __user *)arg); -+ case WDIOC_KEEPALIVE: -+ retu_modify_counter(wdev, RETU_WDT_MAX_TIMER); -+ break; -+ case WDIOC_SETTIMEOUT: -+ if (get_user(new_margin, (int __user *)arg)) -+ return -EFAULT; -+ retu_modify_counter(wdev, new_margin); -+ /* Fall through */ -+ case WDIOC_GETTIMEOUT: -+ return put_user(wdev->period_val, (int __user *)arg); -+ } -+ -+ return 0; -+} -+ -+static const struct file_operations retu_wdt_fops = { -+ .owner = THIS_MODULE, -+ .write = retu_wdt_write, -+ .unlocked_ioctl = retu_wdt_ioctl, -+ .open = retu_wdt_open, -+ .release = retu_wdt_release, -+}; -+ -+static int __init retu_wdt_probe(struct platform_device *pdev) -+{ -+ struct retu_wdt_dev *wdev; -+ int ret; -+ -+ wdev = kzalloc(sizeof(struct retu_wdt_dev), GFP_KERNEL); -+ if (!wdev) -+ return -ENOMEM; -+ -+ wdev->dev = &pdev->dev; -+ wdev->period_val = RETU_WDT_DEFAULT_TIMER; -+ mutex_init(&wdev->mutex); -+ -+ platform_set_drvdata(pdev, wdev); -+ -+ wdev->miscdev.parent = &pdev->dev; -+ wdev->miscdev.minor = WATCHDOG_MINOR; -+ wdev->miscdev.name = "watchdog"; -+ wdev->miscdev.fops = &retu_wdt_fops; -+ -+ ret = misc_register(&wdev->miscdev); -+ if (ret) -+ goto err_free_wdev; -+ -+ INIT_DELAYED_WORK(&wdev->ping_work, retu_wdt_ping_work); -+ -+ /* Kick the watchdog for kernel booting to finish. -+ * If nowayout is not set, we start the ping work. */ -+#ifdef CONFIG_WATCHDOG_NOWAYOUT -+ retu_modify_counter(wdev, RETU_WDT_MAX_TIMER); -+#else -+ retu_wdt_ping_enable(wdev); -+#endif -+ -+ return 0; -+ -+err_free_wdev: -+ kfree(wdev); -+ -+ return ret; -+} -+ -+static int __devexit retu_wdt_remove(struct platform_device *pdev) -+{ -+ struct retu_wdt_dev *wdev; -+ -+ wdev = platform_get_drvdata(pdev); -+ misc_deregister(&wdev->miscdev); -+ cancel_delayed_work_sync(&wdev->ping_work); -+ kfree(wdev); -+ -+ return 0; -+} -+ -+static struct platform_driver retu_wdt_driver = { -+ .remove = __exit_p(retu_wdt_remove), -+ .driver = { -+ .name = "retu-wdt", -+ }, -+}; -+ -+static int __init retu_wdt_init(void) -+{ -+ return platform_driver_probe(&retu_wdt_driver, retu_wdt_probe); -+} -+ -+static void __exit retu_wdt_exit(void) -+{ -+ platform_driver_unregister(&retu_wdt_driver); -+} -+ -+module_init(retu_wdt_init); -+module_exit(retu_wdt_exit); -+ -+MODULE_DESCRIPTION("Retu WatchDog"); -+MODULE_AUTHOR("Amit Kucheria"); -+MODULE_LICENSE("GPL"); ---- /dev/null -+++ b/drivers/cbus/tahvo.c -@@ -0,0 +1,423 @@ -+/** -+ * drivers/cbus/tahvo.c -+ * -+ * Support functions for Tahvo ASIC -+ * -+ * Copyright (C) 2004, 2005 Nokia Corporation -+ * -+ * Written by Juha Yrjölä <juha.yrjola@nokia.com>, -+ * David Weinehall <david.weinehall@nokia.com>, and -+ * Mikko Ylinen <mikko.k.ylinen@nokia.com> -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#include <linux/module.h> -+#include <linux/init.h> -+ -+#include <linux/slab.h> -+#include <linux/kernel.h> -+#include <linux/errno.h> -+#include <linux/device.h> -+#include <linux/irq.h> -+#include <linux/interrupt.h> -+#include <linux/platform_device.h> -+#include <linux/platform_data/cbus.h> -+#include <linux/mutex.h> -+ -+#include "cbus.h" -+#include "tahvo.h" -+ -+struct tahvo { -+ /* device lock */ -+ struct mutex mutex; -+ struct device *dev; -+ -+ int irq_base; -+ int irq_end; -+ int irq; -+ -+ int ack; -+ int mask; -+ -+ unsigned int mask_pending:1; -+ unsigned int ack_pending:1; -+ unsigned int is_betty:1; -+}; -+ -+/** -+ * __tahvo_read_reg - Reads a value from a register in Tahvo -+ * @tahvo: pointer to tahvo structure -+ * @reg: the register address to read from -+ */ -+static int __tahvo_read_reg(struct tahvo *tahvo, unsigned reg) -+{ -+ return cbus_read_reg(tahvo->dev, CBUS_TAHVO_DEVICE_ID, reg); -+} -+ -+/** -+ * __tahvo_write_reg - Writes a value to a register in Tahvo -+ * @tahvo: pointer to tahvo structure -+ * @reg: register address to write to -+ * @val: the value to be written to @reg -+ */ -+static void __tahvo_write_reg(struct tahvo *tahvo, unsigned reg, u16 val) -+{ -+ cbus_write_reg(tahvo->dev, CBUS_TAHVO_DEVICE_ID, reg, val); -+} -+ -+/** -+ * tahvo_read_reg - Read a value from a register in Tahvo -+ * @child: device pointer from the calling child -+ * @reg: the register to read from -+ * -+ * This function returns the contents of the specified register -+ */ -+int tahvo_read_reg(struct device *child, unsigned reg) -+{ -+ struct tahvo *tahvo = dev_get_drvdata(child->parent); -+ -+ return __tahvo_read_reg(tahvo, reg); -+} -+EXPORT_SYMBOL(tahvo_read_reg); -+ -+/** -+ * tahvo_write_reg - Write a value to a register in Tahvo -+ * @child: device pointer from the calling child -+ * @reg: the register to write to -+ * @val : the value to write to the register -+ * -+ * This function writes a value to the specified register -+ */ -+void tahvo_write_reg(struct device *child, unsigned reg, u16 val) -+{ -+ struct tahvo *tahvo = dev_get_drvdata(child->parent); -+ -+ __tahvo_write_reg(tahvo, reg, val); -+} -+EXPORT_SYMBOL(tahvo_write_reg); -+ -+/** -+ * tahvo_set_clear_reg_bits - set and clear register bits atomically -+ * @child: device pointer from the calling child -+ * @reg: the register to write to -+ * @bits: the bits to set -+ * -+ * This function sets and clears the specified Tahvo register bits atomically -+ */ -+void tahvo_set_clear_reg_bits(struct device *child, unsigned reg, u16 set, -+ u16 clear) -+{ -+ struct tahvo *tahvo = dev_get_drvdata(child->parent); -+ u16 w; -+ -+ mutex_lock(&tahvo->mutex); -+ w = __tahvo_read_reg(tahvo, reg); -+ w &= ~clear; -+ w |= set; -+ __tahvo_write_reg(tahvo, reg, w); -+ mutex_unlock(&tahvo->mutex); -+} -+ -+static irqreturn_t tahvo_irq_handler(int irq, void *_tahvo) -+{ -+ struct tahvo *tahvo = _tahvo; -+ u16 id; -+ u16 im; -+ -+ id = __tahvo_read_reg(tahvo, TAHVO_REG_IDR); -+ im = __tahvo_read_reg(tahvo, TAHVO_REG_IMR); -+ id &= ~im; -+ -+ if (!id) { -+ dev_vdbg(tahvo->dev, "No IRQ, spurious ?\n"); -+ return IRQ_NONE; -+ } -+ -+ while (id) { -+ unsigned long pending = __ffs(id); -+ unsigned int irq; -+ -+ id &= ~BIT(pending); -+ irq = pending + tahvo->irq_base; -+ handle_nested_irq(irq); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+/* -------------------------------------------------------------------------- */ -+ -+static void tahvo_irq_bus_lock(struct irq_data *data) -+{ -+ struct tahvo *tahvo = irq_data_get_irq_chip_data(data); -+ -+ mutex_lock(&tahvo->mutex); -+} -+ -+static void tahvo_irq_bus_sync_unlock(struct irq_data *data) -+{ -+ struct tahvo *tahvo = irq_data_get_irq_chip_data(data); -+ -+ if (tahvo->mask_pending) { -+ __tahvo_write_reg(tahvo, TAHVO_REG_IMR, tahvo->mask); -+ tahvo->mask_pending = false; -+ } -+ -+ if (tahvo->ack_pending) { -+ __tahvo_write_reg(tahvo, TAHVO_REG_IDR, tahvo->ack); -+ tahvo->ack_pending = false; -+ } -+ -+ mutex_unlock(&tahvo->mutex); -+} -+ -+static void tahvo_irq_mask(struct irq_data *data) -+{ -+ struct tahvo *tahvo = irq_data_get_irq_chip_data(data); -+ int irq = data->irq; -+ -+ tahvo->mask |= (1 << (irq - tahvo->irq_base)); -+ tahvo->mask_pending = true; -+} -+ -+static void tahvo_irq_unmask(struct irq_data *data) -+{ -+ struct tahvo *tahvo = irq_data_get_irq_chip_data(data); -+ int irq = data->irq; -+ -+ tahvo->mask &= ~(1 << (irq - tahvo->irq_base)); -+ tahvo->mask_pending = true; -+} -+ -+static void tahvo_irq_ack(struct irq_data *data) -+{ -+ struct tahvo *tahvo = irq_data_get_irq_chip_data(data); -+ int irq = data->irq; -+ -+ tahvo->ack |= (1 << (irq - tahvo->irq_base)); -+ tahvo->ack_pending = true; -+} -+ -+static struct irq_chip tahvo_irq_chip = { -+ .name = "tahvo", -+ .irq_bus_lock = tahvo_irq_bus_lock, -+ .irq_bus_sync_unlock = tahvo_irq_bus_sync_unlock, -+ .irq_mask = tahvo_irq_mask, -+ .irq_unmask = tahvo_irq_unmask, -+ .irq_ack = tahvo_irq_ack, -+}; -+ -+static inline void tahvo_irq_setup(int irq) -+{ -+#ifdef CONFIG_ARM -+ set_irq_flags(irq, IRQF_VALID); -+#else -+ irq_set_noprobe(irq); -+#endif -+} -+ -+static void tahvo_irq_init(struct tahvo *tahvo) -+{ -+ int base = tahvo->irq_base; -+ int end = tahvo->irq_end; -+ int irq; -+ -+ for (irq = base; irq < end; irq++) { -+ irq_set_chip_data(irq, tahvo); -+ irq_set_chip_and_handler(irq, &tahvo_irq_chip, -+ handle_simple_irq); -+ irq_set_nested_thread(irq, 1); -+ tahvo_irq_setup(irq); -+ } -+} -+ -+/* -------------------------------------------------------------------------- */ -+ -+static struct resource generic_resources[] = { -+ { -+ .start = -EINVAL, /* fixed later */ -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct device *tahvo_allocate_child(const char *name, -+ struct device *parent, int irq) -+{ -+ struct platform_device *pdev; -+ int ret; -+ -+ pdev = platform_device_alloc(name, -1); -+ if (!pdev) { -+ dev_dbg(parent, "can't allocate %s\n", name); -+ goto err0; -+ } -+ -+ pdev->dev.parent = parent; -+ -+ if (irq > 0) { -+ generic_resources[0].start = irq; -+ -+ ret = platform_device_add_resources(pdev, generic_resources, -+ ARRAY_SIZE(generic_resources)); -+ if (ret < 0) { -+ dev_dbg(parent, "can't add resources to %s\n", name); -+ goto err1; -+ } -+ } -+ -+ ret = platform_device_add(pdev); -+ if (ret < 0) { -+ dev_dbg(parent, "can't add %s\n", name); -+ goto err1; -+ } -+ -+ return &pdev->dev; -+ -+err1: -+ platform_device_put(pdev); -+ -+err0: -+ return NULL; -+} -+ -+static int tahvo_allocate_children(struct device *parent, int irq_base) -+{ -+ struct device *child; -+ -+ child = tahvo_allocate_child("tahvo-usb", parent, -+ irq_base + TAHVO_INT_VBUSON); -+ if (!child) -+ return -ENOMEM; -+ -+ child = tahvo_allocate_child("tahvo-pwm", parent, -1); -+ if (!child) -+ return -ENOMEM; -+ -+ return 0; -+} -+ -+static int __devinit tahvo_probe(struct platform_device *pdev) -+{ -+ struct tahvo *tahvo; -+ int rev; -+ int ret; -+ int irq; -+ int id; -+ -+ tahvo = kzalloc(sizeof(*tahvo), GFP_KERNEL); -+ if (!tahvo) { -+ dev_err(&pdev->dev, "not enough memory\n"); -+ ret = -ENOMEM; -+ goto err0; -+ } -+ -+ irq = platform_get_irq(pdev, 0); -+ platform_set_drvdata(pdev, tahvo); -+ -+ mutex_init(&tahvo->mutex); -+ -+ ret = irq_alloc_descs(-1, 0, MAX_TAHVO_IRQ_HANDLERS, 0); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "failed to allocate IRQ descs\n"); -+ goto err1; -+ } -+ -+ tahvo->irq_base = ret; -+ tahvo->irq_end = ret + MAX_TAHVO_IRQ_HANDLERS; -+ tahvo->dev = &pdev->dev; -+ tahvo->irq = irq; -+ -+ tahvo_irq_init(tahvo); -+ -+ rev = __tahvo_read_reg(tahvo, TAHVO_REG_ASICR); -+ -+ id = (rev >> 8) & 0xff; -+ -+ if (id == 0x0b) -+ tahvo->is_betty = true; -+ -+ ret = tahvo_allocate_children(&pdev->dev, tahvo->irq_base); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "failed to allocate children\n"); -+ goto err2; -+ } -+ -+ dev_err(&pdev->dev, "%s v%d.%d found\n", -+ tahvo->is_betty ? "Betty" : "Tahvo", -+ (rev >> 4) & 0x0f, rev & 0x0f); -+ -+ /* Mask all TAHVO interrupts */ -+ __tahvo_write_reg(tahvo, TAHVO_REG_IMR, 0xffff); -+ -+ ret = request_threaded_irq(irq, NULL, tahvo_irq_handler, -+ IRQF_TRIGGER_RISING | IRQF_ONESHOT, -+ "tahvo", tahvo); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "Unable to register IRQ handler\n"); -+ goto err2; -+ } -+ -+ return 0; -+ -+err2: -+ irq_free_descs(tahvo->irq_base, MAX_TAHVO_IRQ_HANDLERS); -+ -+err1: -+ kfree(tahvo); -+ -+err0: -+ return ret; -+} -+ -+static int __devexit tahvo_remove(struct platform_device *pdev) -+{ -+ struct tahvo *tahvo = platform_get_drvdata(pdev); -+ int irq; -+ -+ irq = platform_get_irq(pdev, 0); -+ -+ free_irq(irq, 0); -+ irq_free_descs(tahvo->irq_base, MAX_TAHVO_IRQ_HANDLERS); -+ kfree(tahvo); -+ -+ return 0; -+} -+ -+static struct platform_driver tahvo_driver = { -+ .probe = tahvo_probe, -+ .remove = __devexit_p(tahvo_remove), -+ .driver = { -+ .name = "tahvo", -+ }, -+}; -+ -+static int __init tahvo_init(void) -+{ -+ return platform_driver_register(&tahvo_driver); -+} -+subsys_initcall(tahvo_init); -+ -+static void __exit tahvo_exit(void) -+{ -+ platform_driver_unregister(&tahvo_driver); -+} -+module_exit(tahvo_exit); -+ -+MODULE_DESCRIPTION("Tahvo ASIC control"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Juha Yrjölä"); -+MODULE_AUTHOR("David Weinehall"); -+MODULE_AUTHOR("Mikko Ylinen"); -+ ---- /dev/null -+++ b/drivers/cbus/tahvo.h -@@ -0,0 +1,58 @@ -+/* -+ * drivers/cbus/tahvo.h -+ * -+ * Copyright (C) 2004, 2005 Nokia Corporation -+ * -+ * Written by Juha Yrjölä <juha.yrjola@nokia.com> and -+ * David Weinehall <david.weinehall@nokia.com> -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#ifndef __DRIVERS_CBUS_TAHVO_H -+#define __DRIVERS_CBUS_TAHVO_H -+ -+#include <linux/types.h> -+ -+/* Registers */ -+#define TAHVO_REG_ASICR 0x00 /* ASIC ID & revision */ -+#define TAHVO_REG_IDR 0x01 /* Interrupt ID */ -+#define TAHVO_REG_IDSR 0x02 /* Interrupt status */ -+#define TAHVO_REG_IMR 0x03 /* Interrupt mask */ -+#define TAHVO_REG_CHGCURR 0x04 /* Charge current control PWM (8-bit) */ -+#define TAHVO_REG_LEDPWMR 0x05 /* LED PWM */ -+#define TAHVO_REG_USBR 0x06 /* USB control */ -+#define TAHVO_REG_CHGCTL 0x08 /* Charge control register */ -+#define TAHVO_REG_CHGCTL_EN 0x0001 /* Global charge enable */ -+#define TAHVO_REG_CHGCTL_PWMOVR 0x0004 /* PWM override. Force charge PWM to 0%/100% duty cycle. */ -+#define TAHVO_REG_CHGCTL_PWMOVRZERO 0x0008 /* If set, PWM override is 0% (If unset -> 100%) */ -+#define TAHVO_REG_CHGCTL_CURMEAS 0x0040 /* Enable battery current measurement. */ -+#define TAHVO_REG_CHGCTL_CURTIMRST 0x0080 /* Current measure timer reset. */ -+#define TAHVO_REG_BATCURRTIMER 0x0c /* Battery current measure timer (8-bit) */ -+#define TAHVO_REG_BATCURR 0x0d /* Battery (dis)charge current (signed 16-bit) */ -+ -+#define TAHVO_REG_MAX 0x0d -+ -+/* Interrupt sources */ -+#define TAHVO_INT_VBUSON 0 -+#define TAHVO_INT_BATCURR 7 /* Battery current measure timer */ -+ -+#define MAX_TAHVO_IRQ_HANDLERS 8 -+ -+int tahvo_read_reg(struct device *child, unsigned reg); -+void tahvo_write_reg(struct device *child, unsigned reg, u16 val); -+void tahvo_set_clear_reg_bits(struct device *child, unsigned reg, u16 set, -+ u16 clear); -+ -+#endif /* __DRIVERS_CBUS_TAHVO_H */ ---- /dev/null -+++ b/drivers/cbus/tahvo-usb.c -@@ -0,0 +1,740 @@ -+/** -+ * drivers/cbus/tahvo-usb.c -+ * -+ * Tahvo USB transeiver -+ * -+ * Copyright (C) 2005-2006 Nokia Corporation -+ * -+ * Parts copied from drivers/i2c/chips/isp1301_omap.c -+ * Copyright (C) 2004 Texas Instruments -+ * Copyright (C) 2004 David Brownell -+ * -+ * Written by Juha Yrjölä <juha.yrjola@nokia.com>, -+ * Tony Lindgren <tony@atomide.com>, and -+ * Timo Teräs <timo.teras@nokia.com> -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#include <linux/kernel.h> -+#include <linux/module.h> -+#include <linux/init.h> -+#include <linux/slab.h> -+#include <linux/io.h> -+#include <linux/interrupt.h> -+#include <linux/platform_device.h> -+#include <linux/usb/ch9.h> -+#include <linux/usb/gadget.h> -+#include <linux/usb.h> -+#include <linux/usb/otg.h> -+#include <linux/i2c.h> -+#include <linux/workqueue.h> -+#include <linux/kobject.h> -+#include <linux/clk.h> -+#include <linux/mutex.h> -+ -+#include <asm/irq.h> -+#include <plat/usb.h> -+ -+#include "cbus.h" -+#include "tahvo.h" -+ -+#define DRIVER_NAME "tahvo-usb" -+ -+#define USBR_SLAVE_CONTROL (1 << 8) -+#define USBR_VPPVIO_SW (1 << 7) -+#define USBR_SPEED (1 << 6) -+#define USBR_REGOUT (1 << 5) -+#define USBR_MASTER_SW2 (1 << 4) -+#define USBR_MASTER_SW1 (1 << 3) -+#define USBR_SLAVE_SW (1 << 2) -+#define USBR_NSUSPEND (1 << 1) -+#define USBR_SEMODE (1 << 0) -+ -+/* bits in OTG_CTRL */ -+ -+/* Bits that are controlled by OMAP OTG and are read-only */ -+#define OTG_CTRL_OMAP_MASK (OTG_PULLDOWN|OTG_PULLUP|OTG_DRV_VBUS|\ -+ OTG_PD_VBUS|OTG_PU_VBUS|OTG_PU_ID) -+/* Bits that are controlled by transceiver */ -+#define OTG_CTRL_XCVR_MASK (OTG_ASESSVLD|OTG_BSESSEND|\ -+ OTG_BSESSVLD|OTG_VBUSVLD|OTG_ID) -+/* Bits that are controlled by system */ -+#define OTG_CTRL_SYS_MASK (OTG_A_BUSREQ|OTG_A_SETB_HNPEN|OTG_B_BUSREQ|\ -+ OTG_B_HNPEN|OTG_BUSDROP) -+ -+#if defined(CONFIG_USB_OHCI_HCD) && !defined(CONFIG_USB_OTG) -+#error tahvo-otg.c does not work with OCHI yet! -+#endif -+ -+#define TAHVO_MODE_HOST 0 -+#define TAHVO_MODE_PERIPHERAL 1 -+ -+#ifdef CONFIG_USB_OTG -+#define TAHVO_MODE(tu) (tu)->tahvo_mode -+#elif defined(CONFIG_USB_GADGET_OMAP) -+#define TAHVO_MODE(tu) TAHVO_MODE_PERIPHERAL -+#else -+#define TAHVO_MODE(tu) TAHVO_MODE_HOST -+#endif -+ -+struct tahvo_usb { -+ struct device *dev; -+ struct platform_device *pt_dev; -+ struct otg_transceiver otg; -+ int vbus_state; -+ struct mutex serialize; -+#ifdef CONFIG_USB_OTG -+ int tahvo_mode; -+#endif -+ struct clk *ick; -+ -+ int irq; -+}; -+static struct tahvo_usb *tahvo_usb_device; -+ -+/* -+ * --------------------------------------------------------------------------- -+ * OTG related functions -+ * -+ * These shoud be separated into omap-otg.c driver module, as they are used -+ * by various transceivers. These functions are needed in the UDC-only case -+ * as well. These functions are copied from GPL isp1301_omap.c -+ * --------------------------------------------------------------------------- -+ */ -+static struct platform_device *tahvo_otg_dev; -+ -+static irqreturn_t omap_otg_irq(int irq, void *arg) -+{ -+ u16 otg_irq; -+ -+ otg_irq = omap_readw(OTG_IRQ_SRC); -+ if (otg_irq & OPRT_CHG) { -+ omap_writew(OPRT_CHG, OTG_IRQ_SRC); -+ } else if (otg_irq & B_SRP_TMROUT) { -+ omap_writew(B_SRP_TMROUT, OTG_IRQ_SRC); -+ } else if (otg_irq & B_HNP_FAIL) { -+ omap_writew(B_HNP_FAIL, OTG_IRQ_SRC); -+ } else if (otg_irq & A_SRP_DETECT) { -+ omap_writew(A_SRP_DETECT, OTG_IRQ_SRC); -+ } else if (otg_irq & A_REQ_TMROUT) { -+ omap_writew(A_REQ_TMROUT, OTG_IRQ_SRC); -+ } else if (otg_irq & A_VBUS_ERR) { -+ omap_writew(A_VBUS_ERR, OTG_IRQ_SRC); -+ } else if (otg_irq & DRIVER_SWITCH) { -+#ifdef CONFIG_USB_OTG -+ if ((!(omap_readl(OTG_CTRL) & OTG_DRIVER_SEL)) && -+ tu->otg.host && tu->otg.state == OTG_STATE_A_HOST) { -+ /* role is host */ -+ usb_bus_start_enum(tu->otg.host, -+ tu->otg.host->otg_port); -+ } -+#endif -+ omap_writew(DRIVER_SWITCH, OTG_IRQ_SRC); -+ } else -+ return IRQ_NONE; -+ -+ return IRQ_HANDLED; -+ -+} -+ -+static int tahvo_otg_init(void) -+{ -+ u32 l; -+ -+#ifdef CONFIG_USB_OTG -+ if (!tahvo_otg_dev) { -+ printk("tahvo-usb: no tahvo_otg_dev\n"); -+ return -ENODEV; -+ } -+#endif -+ -+ l = omap_readl(OTG_SYSCON_1); -+ l &= ~OTG_IDLE_EN; -+ omap_writel(l, OTG_SYSCON_1); -+ udelay(100); -+ -+ /* some of these values are board-specific... */ -+ l = omap_readl(OTG_SYSCON_2); -+ l |= OTG_EN -+ /* for B-device: */ -+ | SRP_GPDATA /* 9msec Bdev D+ pulse */ -+ | SRP_GPDVBUS /* discharge after VBUS pulse */ -+ // | (3 << 24) /* 2msec VBUS pulse */ -+ /* for A-device: */ -+ | (0 << 20) /* 200ms nominal A_WAIT_VRISE timer */ -+ | SRP_DPW /* detect 167+ns SRP pulses */ -+ | SRP_DATA | SRP_VBUS; /* accept both kinds of SRP pulse */ -+ omap_writel(l, OTG_SYSCON_2); -+ -+ omap_writew(DRIVER_SWITCH | OPRT_CHG -+ | B_SRP_TMROUT | B_HNP_FAIL -+ | A_VBUS_ERR | A_SRP_DETECT | A_REQ_TMROUT, -+ OTG_IRQ_EN); -+ l = omap_readl(OTG_SYSCON_2); -+ l |= OTG_EN; -+ omap_writel(l, OTG_SYSCON_2); -+ -+ return 0; -+} -+ -+static int __init omap_otg_probe(struct platform_device *pdev) -+{ -+ int ret; -+ -+ tahvo_otg_dev = pdev; -+ ret = tahvo_otg_init(); -+ if (ret != 0) { -+ printk(KERN_ERR "tahvo-usb: tahvo_otg_init failed\n"); -+ return ret; -+ } -+ -+ return request_irq(tahvo_otg_dev->resource[1].start, -+ omap_otg_irq, IRQF_DISABLED, DRIVER_NAME, -+ tahvo_usb_device); -+} -+ -+static int __exit omap_otg_remove(struct platform_device *pdev) -+{ -+ free_irq(tahvo_otg_dev->resource[1].start, tahvo_usb_device); -+ tahvo_otg_dev = NULL; -+ -+ return 0; -+} -+ -+struct platform_driver omap_otg_driver = { -+ .driver = { -+ .name = "omap_otg", -+ }, -+ .remove = __exit_p(omap_otg_remove), -+}; -+ -+/* -+ * --------------------------------------------------------------------------- -+ * Tahvo related functions -+ * These are Nokia proprietary code, except for the OTG register settings, -+ * which are copied from isp1301.c -+ * --------------------------------------------------------------------------- -+ */ -+static ssize_t vbus_state_show(struct device *device, -+ struct device_attribute *attr, char *buf) -+{ -+ struct tahvo_usb *tu = dev_get_drvdata(device); -+ return sprintf(buf, "%d\n", tu->vbus_state); -+} -+static DEVICE_ATTR(vbus_state, 0444, vbus_state_show, NULL); -+ -+int vbus_active = 0; -+ -+static void check_vbus_state(struct tahvo_usb *tu) -+{ -+ int reg, prev_state; -+ -+ reg = tahvo_read_reg(tu->dev, TAHVO_REG_IDSR); -+ if (reg & 0x01) { -+ u32 l; -+ -+ vbus_active = 1; -+ switch (tu->otg.state) { -+ case OTG_STATE_B_IDLE: -+ /* Enable the gadget driver */ -+ if (tu->otg.gadget) -+ usb_gadget_vbus_connect(tu->otg.gadget); -+ /* Set B-session valid and not B-sessio ended to indicate -+ * Vbus to be ok. */ -+ l = omap_readl(OTG_CTRL); -+ l &= ~OTG_BSESSEND; -+ l |= OTG_BSESSVLD; -+ omap_writel(l, OTG_CTRL); -+ -+ tu->otg.state = OTG_STATE_B_PERIPHERAL; -+ break; -+ case OTG_STATE_A_IDLE: -+ /* Session is now valid assuming the USB hub is driving Vbus */ -+ tu->otg.state = OTG_STATE_A_HOST; -+ break; -+ default: -+ break; -+ } -+ printk("USB cable connected\n"); -+ } else { -+ switch (tu->otg.state) { -+ case OTG_STATE_B_PERIPHERAL: -+ if (tu->otg.gadget) -+ usb_gadget_vbus_disconnect(tu->otg.gadget); -+ tu->otg.state = OTG_STATE_B_IDLE; -+ break; -+ case OTG_STATE_A_HOST: -+ tu->otg.state = OTG_STATE_A_IDLE; -+ break; -+ default: -+ break; -+ } -+ printk("USB cable disconnected\n"); -+ vbus_active = 0; -+ } -+ -+ prev_state = tu->vbus_state; -+ tu->vbus_state = reg & 0x01; -+ if (prev_state != tu->vbus_state) -+ sysfs_notify(&tu->pt_dev->dev.kobj, NULL, "vbus_state"); -+} -+ -+static void tahvo_usb_become_host(struct tahvo_usb *tu) -+{ -+ u32 l; -+ -+ /* Clear system and transceiver controlled bits -+ * also mark the A-session is always valid */ -+ tahvo_otg_init(); -+ -+ l = omap_readl(OTG_CTRL); -+ l &= ~(OTG_CTRL_XCVR_MASK | OTG_CTRL_SYS_MASK); -+ l |= OTG_ASESSVLD; -+ omap_writel(l, OTG_CTRL); -+ -+ /* Power up the transceiver in USB host mode */ -+ tahvo_write_reg(tu->dev, TAHVO_REG_USBR, USBR_REGOUT | USBR_NSUSPEND | -+ USBR_MASTER_SW2 | USBR_MASTER_SW1); -+ tu->otg.state = OTG_STATE_A_IDLE; -+ -+ check_vbus_state(tu); -+} -+ -+static void tahvo_usb_stop_host(struct tahvo_usb *tu) -+{ -+ tu->otg.state = OTG_STATE_A_IDLE; -+} -+ -+static void tahvo_usb_become_peripheral(struct tahvo_usb *tu) -+{ -+ u32 l; -+ -+ /* Clear system and transceiver controlled bits -+ * and enable ID to mark peripheral mode and -+ * BSESSEND to mark no Vbus */ -+ tahvo_otg_init(); -+ l = omap_readl(OTG_CTRL); -+ l &= ~(OTG_CTRL_XCVR_MASK | OTG_CTRL_SYS_MASK | OTG_BSESSVLD); -+ l |= OTG_ID | OTG_BSESSEND; -+ omap_writel(l, OTG_CTRL); -+ -+ /* Power up transceiver and set it in USB perhiperal mode */ -+ tahvo_write_reg(tu->dev, TAHVO_REG_USBR, USBR_SLAVE_CONTROL | USBR_REGOUT | USBR_NSUSPEND | USBR_SLAVE_SW); -+ tu->otg.state = OTG_STATE_B_IDLE; -+ -+ check_vbus_state(tu); -+} -+ -+static void tahvo_usb_stop_peripheral(struct tahvo_usb *tu) -+{ -+ u32 l; -+ -+ l = omap_readl(OTG_CTRL); -+ l &= ~OTG_BSESSVLD; -+ l |= OTG_BSESSEND; -+ omap_writel(l, OTG_CTRL); -+ -+ if (tu->otg.gadget) -+ usb_gadget_vbus_disconnect(tu->otg.gadget); -+ tu->otg.state = OTG_STATE_B_IDLE; -+ -+} -+ -+static void tahvo_usb_power_off(struct tahvo_usb *tu) -+{ -+ u32 l; -+ int id; -+ -+ /* Disable gadget controller if any */ -+ if (tu->otg.gadget) -+ usb_gadget_vbus_disconnect(tu->otg.gadget); -+ -+ /* Disable OTG and interrupts */ -+ if (TAHVO_MODE(tu) == TAHVO_MODE_PERIPHERAL) -+ id = OTG_ID; -+ else -+ id = 0; -+ l = omap_readl(OTG_CTRL); -+ l &= ~(OTG_CTRL_XCVR_MASK | OTG_CTRL_SYS_MASK | OTG_BSESSVLD); -+ l |= id | OTG_BSESSEND; -+ omap_writel(l, OTG_CTRL); -+ omap_writew(0, OTG_IRQ_EN); -+ -+ l = omap_readl(OTG_SYSCON_2); -+ l &= ~OTG_EN; -+ omap_writel(l, OTG_SYSCON_2); -+ -+ l = omap_readl(OTG_SYSCON_1); -+ l |= OTG_IDLE_EN; -+ omap_writel(l, OTG_SYSCON_1); -+ -+ /* Power off transceiver */ -+ tahvo_write_reg(tu->dev, TAHVO_REG_USBR, 0); -+ tu->otg.state = OTG_STATE_UNDEFINED; -+} -+ -+ -+static int tahvo_usb_set_power(struct otg_transceiver *dev, unsigned mA) -+{ -+ struct tahvo_usb *tu = container_of(dev, struct tahvo_usb, otg); -+ -+ dev_dbg(&tu->pt_dev->dev, "set_power %d mA\n", mA); -+ -+ if (dev->state == OTG_STATE_B_PERIPHERAL) { -+ /* REVISIT: Can Tahvo charge battery from VBUS? */ -+ } -+ return 0; -+} -+ -+static int tahvo_usb_set_suspend(struct otg_transceiver *dev, int suspend) -+{ -+ struct tahvo_usb *tu = container_of(dev, struct tahvo_usb, otg); -+ u16 w; -+ -+ dev_dbg(&tu->pt_dev->dev, "set_suspend\n"); -+ -+ w = tahvo_read_reg(tu->dev, TAHVO_REG_USBR); -+ if (suspend) -+ w &= ~USBR_NSUSPEND; -+ else -+ w |= USBR_NSUSPEND; -+ tahvo_write_reg(tu->dev, TAHVO_REG_USBR, w); -+ -+ return 0; -+} -+ -+static int tahvo_usb_start_srp(struct otg_transceiver *dev) -+{ -+ struct tahvo_usb *tu = container_of(dev, struct tahvo_usb, otg); -+ u32 otg_ctrl; -+ -+ dev_dbg(&tu->pt_dev->dev, "start_srp\n"); -+ -+ if (!dev || tu->otg.state != OTG_STATE_B_IDLE) -+ return -ENODEV; -+ -+ otg_ctrl = omap_readl(OTG_CTRL); -+ if (!(otg_ctrl & OTG_BSESSEND)) -+ return -EINVAL; -+ -+ otg_ctrl |= OTG_B_BUSREQ; -+ otg_ctrl &= ~OTG_A_BUSREQ & OTG_CTRL_SYS_MASK; -+ omap_writel(otg_ctrl, OTG_CTRL); -+ tu->otg.state = OTG_STATE_B_SRP_INIT; -+ -+ return 0; -+} -+ -+static int tahvo_usb_start_hnp(struct otg_transceiver *otg) -+{ -+ struct tahvo_usb *tu = container_of(otg, struct tahvo_usb, otg); -+ -+ dev_dbg(&tu->pt_dev->dev, "start_hnp\n"); -+#ifdef CONFIG_USB_OTG -+ /* REVISIT: Add this for OTG */ -+#endif -+ return -EINVAL; -+} -+ -+static int tahvo_usb_set_host(struct otg_transceiver *otg, struct usb_bus *host) -+{ -+ struct tahvo_usb *tu = container_of(otg, struct tahvo_usb, otg); -+ u32 l; -+ -+ dev_dbg(&tu->pt_dev->dev, "set_host %p\n", host); -+ -+ if (otg == NULL) -+ return -ENODEV; -+ -+#if defined(CONFIG_USB_OTG) || !defined(CONFIG_USB_GADGET_OMAP) -+ -+ mutex_lock(&tu->serialize); -+ -+ if (host == NULL) { -+ if (TAHVO_MODE(tu) == TAHVO_MODE_HOST) -+ tahvo_usb_power_off(tu); -+ tu->otg.host = NULL; -+ mutex_unlock(&tu->serialize); -+ return 0; -+ } -+ -+ l = omap_readl(OTG_SYSCON_1); -+ l &= ~(OTG_IDLE_EN | HST_IDLE_EN | DEV_IDLE_EN); -+ omap_writel(l, OTG_SYSCON_1); -+ -+ if (TAHVO_MODE(tu) == TAHVO_MODE_HOST) { -+ tu->otg.host = NULL; -+ tahvo_usb_become_host(tu); -+ } -+ -+ tu->otg.host = host; -+ -+ mutex_unlock(&tu->serialize); -+#else -+ /* No host mode configured, so do not allow host controlled to be set */ -+ return -EINVAL; -+#endif -+ -+ return 0; -+} -+ -+static int tahvo_usb_set_peripheral(struct otg_transceiver *otg, struct usb_gadget *gadget) -+{ -+ struct tahvo_usb *tu = container_of(otg, struct tahvo_usb, otg); -+ -+ dev_dbg(&tu->pt_dev->dev, "set_peripheral %p\n", gadget); -+ -+ if (!otg) -+ return -ENODEV; -+ -+#if defined(CONFIG_USB_OTG) || defined(CONFIG_USB_GADGET_OMAP) -+ -+ mutex_lock(&tu->serialize); -+ -+ if (!gadget) { -+ if (TAHVO_MODE(tu) == TAHVO_MODE_PERIPHERAL) -+ tahvo_usb_power_off(tu); -+ tu->otg.gadget = NULL; -+ mutex_unlock(&tu->serialize); -+ return 0; -+ } -+ -+ tu->otg.gadget = gadget; -+ if (TAHVO_MODE(tu) == TAHVO_MODE_PERIPHERAL) -+ tahvo_usb_become_peripheral(tu); -+ -+ mutex_unlock(&tu->serialize); -+#else -+ /* No gadget mode configured, so do not allow host controlled to be set */ -+ return -EINVAL; -+#endif -+ -+ return 0; -+} -+ -+static irqreturn_t tahvo_usb_vbus_interrupt(int irq, void *_tu) -+{ -+ struct tahvo_usb *tu = _tu; -+ -+ check_vbus_state(tu); -+ -+ return IRQ_HANDLED; -+} -+ -+#ifdef CONFIG_USB_OTG -+static ssize_t otg_mode_show(struct device *device, -+ struct device_attribute *attr, char *buf) -+{ -+ struct tahvo_usb *tu = dev_get_drvdata(device); -+ switch (tu->tahvo_mode) { -+ case TAHVO_MODE_HOST: -+ return sprintf(buf, "host\n"); -+ case TAHVO_MODE_PERIPHERAL: -+ return sprintf(buf, "peripheral\n"); -+ } -+ return sprintf(buf, "unknown\n"); -+} -+ -+static ssize_t otg_mode_store(struct device *device, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct tahvo_usb *tu = dev_get_drvdata(device); -+ int r; -+ -+ r = strlen(buf); -+ mutex_lock(&tu->serialize); -+ if (strncmp(buf, "host", 4) == 0) { -+ if (tu->tahvo_mode == TAHVO_MODE_PERIPHERAL) -+ tahvo_usb_stop_peripheral(tu); -+ tu->tahvo_mode = TAHVO_MODE_HOST; -+ if (tu->otg.host) { -+ printk(KERN_INFO "Selected HOST mode: host controller present.\n"); -+ tahvo_usb_become_host(tu); -+ } else { -+ printk(KERN_INFO "Selected HOST mode: no host controller, powering off.\n"); -+ tahvo_usb_power_off(tu); -+ } -+ } else if (strncmp(buf, "peripheral", 10) == 0) { -+ if (tu->tahvo_mode == TAHVO_MODE_HOST) -+ tahvo_usb_stop_host(tu); -+ tu->tahvo_mode = TAHVO_MODE_PERIPHERAL; -+ if (tu->otg.gadget) { -+ printk(KERN_INFO "Selected PERIPHERAL mode: gadget driver present.\n"); -+ tahvo_usb_become_peripheral(tu); -+ } else { -+ printk(KERN_INFO "Selected PERIPHERAL mode: no gadget driver, powering off.\n"); -+ tahvo_usb_power_off(tu); -+ } -+ } else -+ r = -EINVAL; -+ -+ mutex_unlock(&tu->serialize); -+ return r; -+} -+ -+static DEVICE_ATTR(otg_mode, 0644, otg_mode_show, otg_mode_store); -+#endif -+ -+static int __init tahvo_usb_probe(struct platform_device *pdev) -+{ -+ struct tahvo_usb *tu; -+ struct device *dev = &pdev->dev; -+ int ret; -+ int irq; -+ -+ dev_dbg(dev, "probe\n"); -+ -+ /* Create driver data */ -+ tu = kzalloc(sizeof(*tu), GFP_KERNEL); -+ if (!tu) -+ return -ENOMEM; -+ tahvo_usb_device = tu; -+ -+ tu->dev = dev; -+ tu->pt_dev = pdev; -+#ifdef CONFIG_USB_OTG -+ /* Default mode */ -+#ifdef CONFIG_CBUS_TAHVO_USB_HOST_BY_DEFAULT -+ tu->tahvo_mode = TAHVO_MODE_HOST; -+#else -+ tu->tahvo_mode = TAHVO_MODE_PERIPHERAL; -+#endif -+#endif -+ -+ mutex_init(&tu->serialize); -+ -+ tu->ick = clk_get(NULL, "usb_l4_ick"); -+ if (IS_ERR(tu->ick)) { -+ dev_err(dev, "Failed to get usb_l4_ick\n"); -+ ret = PTR_ERR(tu->ick); -+ goto err_free_tu; -+ } -+ clk_enable(tu->ick); -+ -+ /* Set initial state, so that we generate kevents only on -+ * state changes */ -+ tu->vbus_state = tahvo_read_reg(tu->dev, TAHVO_REG_IDSR) & 0x01; -+ -+ irq = platform_get_irq(pdev, 0); -+ tu->irq = irq; -+ -+ /* We cannot enable interrupt until omap_udc is initialized */ -+ ret = request_threaded_irq(irq, NULL, tahvo_usb_vbus_interrupt, -+ IRQF_ONESHOT, "tahvo-vbus", tu); -+ if (ret != 0) { -+ printk(KERN_ERR "Could not register Tahvo interrupt for VBUS\n"); -+ goto err_release_clk; -+ } -+ -+ /* Attributes */ -+ ret = device_create_file(dev, &dev_attr_vbus_state); -+#ifdef CONFIG_USB_OTG -+ ret |= device_create_file(dev, &dev_attr_otg_mode); -+#endif -+ if (ret) -+ printk(KERN_ERR "attribute creation failed: %d\n", ret); -+ -+ /* Create OTG interface */ -+ tahvo_usb_power_off(tu); -+ tu->otg.state = OTG_STATE_UNDEFINED; -+ tu->otg.label = DRIVER_NAME; -+ tu->otg.set_host = tahvo_usb_set_host; -+ tu->otg.set_peripheral = tahvo_usb_set_peripheral; -+ tu->otg.set_power = tahvo_usb_set_power; -+ tu->otg.set_suspend = tahvo_usb_set_suspend; -+ tu->otg.start_srp = tahvo_usb_start_srp; -+ tu->otg.start_hnp = tahvo_usb_start_hnp; -+ -+ ret = otg_set_transceiver(&tu->otg); -+ if (ret < 0) { -+ printk(KERN_ERR "Cannot register USB transceiver\n"); -+ goto err_free_irq; -+ } -+ -+ dev_set_drvdata(dev, tu); -+ -+ return 0; -+ -+err_free_irq: -+ free_irq(tu->irq, tu); -+err_release_clk: -+ clk_disable(tu->ick); -+ clk_put(tu->ick); -+err_free_tu: -+ kfree(tu); -+ tahvo_usb_device = NULL; -+ -+ return ret; -+} -+ -+static int __exit tahvo_usb_remove(struct platform_device *pdev) -+{ -+ struct tahvo_usb *tu = platform_get_drvdata(pdev); -+ -+ dev_dbg(&pdev->dev, "remove\n"); -+ -+ free_irq(tu->irq, tu); -+ flush_scheduled_work(); -+ otg_set_transceiver(0); -+ device_remove_file(&pdev->dev, &dev_attr_vbus_state); -+#ifdef CONFIG_USB_OTG -+ device_remove_file(&pdev->dev, &dev_attr_otg_mode); -+#endif -+ clk_disable(tu->ick); -+ clk_put(tu->ick); -+ -+ kfree(tu); -+ tahvo_usb_device = NULL; -+ -+ return 0; -+} -+ -+static struct platform_driver tahvo_usb_driver = { -+ .driver = { -+ .name = "tahvo-usb", -+ }, -+ .remove = __exit_p(tahvo_usb_remove), -+}; -+ -+static int __init tahvo_usb_init(void) -+{ -+ int ret = 0; -+ -+ ret = platform_driver_probe(&tahvo_usb_driver, tahvo_usb_probe); -+ if (ret) -+ return ret; -+ -+ ret = platform_driver_probe(&omap_otg_driver, omap_otg_probe); -+ if (ret) { -+ platform_driver_unregister(&tahvo_usb_driver); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+subsys_initcall(tahvo_usb_init); -+ -+static void __exit tahvo_usb_exit(void) -+{ -+ platform_driver_unregister(&omap_otg_driver); -+ platform_driver_unregister(&tahvo_usb_driver); -+} -+module_exit(tahvo_usb_exit); -+ -+MODULE_DESCRIPTION("Tahvo USB OTG Transceiver Driver"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Juha Yrjölä, Tony Lindgren, and Timo Teräs"); ---- a/drivers/Makefile -+++ b/drivers/Makefile -@@ -78,7 +78,7 @@ obj-$(CONFIG_GAMEPORT) += input/gamepor - obj-$(CONFIG_INPUT) += input/ - obj-$(CONFIG_I2O) += message/ - obj-$(CONFIG_RTC_LIB) += rtc/ --obj-y += i2c/ media/ -+obj-y += i2c/ media/ cbus/ - obj-$(CONFIG_PPS) += pps/ - obj-$(CONFIG_PTP_1588_CLOCK) += ptp/ - obj-$(CONFIG_W1) += w1/ ---- a/drivers/Kconfig -+++ b/drivers/Kconfig -@@ -2,6 +2,8 @@ menu "Device Drivers" - - source "drivers/base/Kconfig" - -+source "drivers/cbus/Kconfig" -+ - source "drivers/connector/Kconfig" - - source "drivers/mtd/Kconfig" diff --git a/target/linux/omap24xx/patches-3.3/251-cbus-tahvo-lock-fix.patch b/target/linux/omap24xx/patches-3.3/251-cbus-tahvo-lock-fix.patch deleted file mode 100644 index be406716ae..0000000000 --- a/target/linux/omap24xx/patches-3.3/251-cbus-tahvo-lock-fix.patch +++ /dev/null @@ -1,12 +0,0 @@ ---- a/drivers/cbus/tahvo.c -+++ b/drivers/cbus/tahvo.c -@@ -104,7 +104,9 @@ void tahvo_write_reg(struct device *chil - { - struct tahvo *tahvo = dev_get_drvdata(child->parent); - -+ mutex_lock(&tahvo->mutex); - __tahvo_write_reg(tahvo, reg, val); -+ mutex_unlock(&tahvo->mutex); - } - EXPORT_SYMBOL(tahvo_write_reg); - diff --git a/target/linux/omap24xx/patches-3.3/252-cbus-retu-tahvo-ack-fix.patch b/target/linux/omap24xx/patches-3.3/252-cbus-retu-tahvo-ack-fix.patch deleted file mode 100644 index 86f2f770e9..0000000000 --- a/target/linux/omap24xx/patches-3.3/252-cbus-retu-tahvo-ack-fix.patch +++ /dev/null @@ -1,142 +0,0 @@ ---- a/drivers/cbus/retu.c -+++ b/drivers/cbus/retu.c -@@ -53,9 +53,6 @@ struct retu { - - int irq; - -- int ack; -- bool ack_pending; -- - int mask; - bool mask_pending; - -@@ -191,9 +188,10 @@ static irqreturn_t retu_irq_handler(int - mutex_lock(&retu->mutex); - idr = __retu_read_reg(retu, RETU_REG_IDR); - imr = __retu_read_reg(retu, RETU_REG_IMR); -+ idr &= ~imr; -+ __retu_write_reg(retu, RETU_REG_IDR, idr); - mutex_unlock(&retu->mutex); - -- idr &= ~imr; - if (!idr) { - dev_vdbg(retu->dev, "No IRQ, spurious?\n"); - return IRQ_NONE; -@@ -232,15 +230,6 @@ static void retu_irq_unmask(struct irq_d - - } - --static void retu_irq_ack(struct irq_data *data) --{ -- struct retu *retu = irq_data_get_irq_chip_data(data); -- int irq = data->irq; -- -- retu->ack |= (1 << (irq - retu->irq_base)); -- retu->ack_pending = true; --} -- - static void retu_bus_lock(struct irq_data *data) - { - struct retu *retu = irq_data_get_irq_chip_data(data); -@@ -257,11 +246,6 @@ static void retu_bus_sync_unlock(struct - retu->mask_pending = false; - } - -- if (retu->ack_pending) { -- __retu_write_reg(retu, RETU_REG_IDR, retu->ack); -- retu->ack_pending = false; -- } -- - mutex_unlock(&retu->mutex); - } - -@@ -271,7 +255,6 @@ static struct irq_chip retu_irq_chip = { - .irq_bus_sync_unlock = retu_bus_sync_unlock, - .irq_mask = retu_irq_mask, - .irq_unmask = retu_irq_unmask, -- .irq_ack = retu_irq_ack, - }; - - static inline void retu_irq_setup(int irq) -@@ -291,8 +274,7 @@ static void retu_irq_init(struct retu *r - - for (irq = base; irq < end; irq++) { - irq_set_chip_data(irq, retu); -- irq_set_chip_and_handler(irq, &retu_irq_chip, -- handle_simple_irq); -+ irq_set_chip(irq, &retu_irq_chip); - irq_set_nested_thread(irq, 1); - retu_irq_setup(irq); - } ---- a/drivers/cbus/tahvo.c -+++ b/drivers/cbus/tahvo.c -@@ -48,11 +48,9 @@ struct tahvo { - int irq_end; - int irq; - -- int ack; - int mask; - - unsigned int mask_pending:1; -- unsigned int ack_pending:1; - unsigned int is_betty:1; - }; - -@@ -138,9 +136,12 @@ static irqreturn_t tahvo_irq_handler(int - u16 id; - u16 im; - -+ mutex_lock(&tahvo->mutex); - id = __tahvo_read_reg(tahvo, TAHVO_REG_IDR); - im = __tahvo_read_reg(tahvo, TAHVO_REG_IMR); - id &= ~im; -+ __tahvo_write_reg(tahvo, TAHVO_REG_IDR, id); -+ mutex_unlock(&tahvo->mutex); - - if (!id) { - dev_vdbg(tahvo->dev, "No IRQ, spurious ?\n"); -@@ -177,11 +178,6 @@ static void tahvo_irq_bus_sync_unlock(st - tahvo->mask_pending = false; - } - -- if (tahvo->ack_pending) { -- __tahvo_write_reg(tahvo, TAHVO_REG_IDR, tahvo->ack); -- tahvo->ack_pending = false; -- } -- - mutex_unlock(&tahvo->mutex); - } - -@@ -203,22 +199,12 @@ static void tahvo_irq_unmask(struct irq_ - tahvo->mask_pending = true; - } - --static void tahvo_irq_ack(struct irq_data *data) --{ -- struct tahvo *tahvo = irq_data_get_irq_chip_data(data); -- int irq = data->irq; -- -- tahvo->ack |= (1 << (irq - tahvo->irq_base)); -- tahvo->ack_pending = true; --} -- - static struct irq_chip tahvo_irq_chip = { - .name = "tahvo", - .irq_bus_lock = tahvo_irq_bus_lock, - .irq_bus_sync_unlock = tahvo_irq_bus_sync_unlock, - .irq_mask = tahvo_irq_mask, - .irq_unmask = tahvo_irq_unmask, -- .irq_ack = tahvo_irq_ack, - }; - - static inline void tahvo_irq_setup(int irq) -@@ -238,8 +224,7 @@ static void tahvo_irq_init(struct tahvo - - for (irq = base; irq < end; irq++) { - irq_set_chip_data(irq, tahvo); -- irq_set_chip_and_handler(irq, &tahvo_irq_chip, -- handle_simple_irq); -+ irq_set_chip(irq, &tahvo_irq_chip); - irq_set_nested_thread(irq, 1); - tahvo_irq_setup(irq); - } diff --git a/target/linux/omap24xx/patches-3.3/254-cbus-retu-tahvo-irq-mask-init-fix.patch b/target/linux/omap24xx/patches-3.3/254-cbus-retu-tahvo-irq-mask-init-fix.patch deleted file mode 100644 index a1be6b793e..0000000000 --- a/target/linux/omap24xx/patches-3.3/254-cbus-retu-tahvo-irq-mask-init-fix.patch +++ /dev/null @@ -1,24 +0,0 @@ ---- a/drivers/cbus/retu.c -+++ b/drivers/cbus/retu.c -@@ -451,7 +451,8 @@ static int __devinit retu_probe(struct p - (rev >> 4) & 0x07, rev & 0x0f); - - /* Mask all RETU interrupts */ -- __retu_write_reg(retu, RETU_REG_IMR, 0xffff); -+ retu->mask = 0xFFFF; -+ __retu_write_reg(retu, RETU_REG_IMR, retu->mask); - - ret = request_threaded_irq(retu->irq, NULL, retu_irq_handler, - IRQF_ONESHOT, "retu", retu); ---- a/drivers/cbus/tahvo.c -+++ b/drivers/cbus/tahvo.c -@@ -346,7 +346,8 @@ static int __devinit tahvo_probe(struct - (rev >> 4) & 0x0f, rev & 0x0f); - - /* Mask all TAHVO interrupts */ -- __tahvo_write_reg(tahvo, TAHVO_REG_IMR, 0xffff); -+ tahvo->mask = 0xFFFF; -+ __tahvo_write_reg(tahvo, TAHVO_REG_IMR, tahvo->mask); - - ret = request_threaded_irq(irq, NULL, tahvo_irq_handler, - IRQF_TRIGGER_RISING | IRQF_ONESHOT, diff --git a/target/linux/omap24xx/patches-3.3/300-cbus-platform.patch b/target/linux/omap24xx/patches-3.3/300-cbus-platform.patch deleted file mode 100644 index 7f0c7b4bfc..0000000000 --- a/target/linux/omap24xx/patches-3.3/300-cbus-platform.patch +++ /dev/null @@ -1,175 +0,0 @@ ---- a/arch/arm/mach-omap2/board-n8x0.c -+++ b/arch/arm/mach-omap2/board-n8x0.c -@@ -15,8 +15,11 @@ - #include <linux/delay.h> - #include <linux/gpio.h> - #include <linux/init.h> -+#include <linux/irq.h> - #include <linux/io.h> - #include <linux/stddef.h> -+#include <linux/platform_device.h> -+#include <linux/platform_data/cbus.h> - #include <linux/i2c.h> - #include <linux/spi/spi.h> - #include <linux/usb/musb.h> -@@ -193,6 +196,110 @@ static struct omap_onenand_platform_data - }; - #endif - -+#if defined(CONFIG_CBUS) || defined(CONFIG_CBUS_MODULE) -+ -+static struct cbus_host_platform_data n8x0_cbus_data = { -+ .clk_gpio = 66, -+ .dat_gpio = 65, -+ .sel_gpio = 64, -+}; -+ -+static struct platform_device n8x0_cbus_device = { -+ .name = "cbus", -+ .id = -1, -+ .dev = { -+ .platform_data = &n8x0_cbus_data, -+ }, -+}; -+ -+static struct resource retu_resource[] = { -+ { -+ .start = -EINVAL, /* set later */ -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct cbus_retu_platform_data n8x0_retu_data = { -+ .devid = CBUS_RETU_DEVICE_ID, -+}; -+ -+static struct platform_device retu_device = { -+ .name = "retu", -+ .id = -1, -+ .resource = retu_resource, -+ .num_resources = ARRAY_SIZE(retu_resource), -+ .dev = { -+ .platform_data = &n8x0_retu_data, -+ .parent = &n8x0_cbus_device.dev, -+ }, -+}; -+ -+static struct resource tahvo_resource[] = { -+ { -+ .start = -EINVAL, /* set later */ -+ .flags = IORESOURCE_IRQ, -+ } -+}; -+ -+static struct platform_device tahvo_device = { -+ .name = "tahvo", -+ .id = -1, -+ .resource = tahvo_resource, -+ .num_resources = ARRAY_SIZE(tahvo_resource), -+ .dev = { -+ .parent = &n8x0_cbus_device.dev, -+ }, -+}; -+ -+static void __init n8x0_cbus_init(void) -+{ -+ int ret; -+ -+ platform_device_register(&n8x0_cbus_device); -+ -+ ret = gpio_request(108, "RETU irq"); -+ if (ret < 0) { -+ pr_err("retu: Unable to reserve IRQ GPIO\n"); -+ return; -+ } -+ -+ ret = gpio_direction_input(108); -+ if (ret < 0) { -+ pr_err("retu: Unable to change gpio direction\n"); -+ gpio_free(108); -+ return; -+ } -+ -+ irq_set_irq_type(gpio_to_irq(108), IRQ_TYPE_EDGE_RISING); -+ retu_resource[0].start = gpio_to_irq(108); -+ platform_device_register(&retu_device); -+ -+ ret = gpio_request(111, "TAHVO irq"); -+ if (ret) { -+ pr_err("tahvo: Unable to reserve IRQ GPIO\n"); -+ gpio_free(108); -+ return; -+ } -+ -+ /* Set the pin as input */ -+ ret = gpio_direction_input(111); -+ if (ret) { -+ pr_err("tahvo: Unable to change direction\n"); -+ gpio_free(108); -+ gpio_free(111); -+ return; -+ } -+ -+ tahvo_resource[0].start = gpio_to_irq(111); -+ platform_device_register(&tahvo_device); -+} -+ -+#else -+static inline void __init n8x0_cbus_init(void) -+{ -+} -+#endif -+ - #if defined(CONFIG_MENELAUS) && \ - (defined(CONFIG_MMC_OMAP) || defined(CONFIG_MMC_OMAP_MODULE)) - -@@ -671,6 +778,8 @@ static inline void board_serial_init(voi - static void __init n8x0_init_machine(void) - { - omap2420_mux_init(board_mux, OMAP_PACKAGE_ZAC); -+ n8x0_cbus_init(); -+ - /* FIXME: add n810 spi devices */ - spi_register_board_info(n800_spi_board_info, - ARRAY_SIZE(n800_spi_board_info)); ---- /dev/null -+++ b/include/linux/platform_data/cbus.h -@@ -0,0 +1,38 @@ -+/* -+ * cbus.h - CBUS platform_data definition -+ * -+ * Copyright (C) 2004 - 2009 Nokia Corporation -+ * -+ * Written by Felipe Balbi <felipe.balbi@nokia.com> -+ * -+ * This file is subject to the terms and conditions of the GNU General -+ * Public License. See the file "COPYING" in the main directory of this -+ * archive for more details. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+#ifndef __INCLUDE_LINUX_CBUS_H -+#define __INCLUDE_LINUX_CBUS_H -+ -+#define CBUS_RETU_DEVICE_ID 0x01 -+#define CBUS_TAHVO_DEVICE_ID 0x02 -+ -+struct cbus_host_platform_data { -+ int dat_gpio; -+ int clk_gpio; -+ int sel_gpio; -+}; -+ -+struct cbus_retu_platform_data { -+ int devid; -+}; -+ -+#endif /* __INCLUDE_LINUX_CBUS_H */ diff --git a/target/linux/omap24xx/patches-3.3/309-omapfb-circular-mutex-workaround.patch b/target/linux/omap24xx/patches-3.3/309-omapfb-circular-mutex-workaround.patch deleted file mode 100644 index e5e083e241..0000000000 --- a/target/linux/omap24xx/patches-3.3/309-omapfb-circular-mutex-workaround.patch +++ /dev/null @@ -1,41 +0,0 @@ ---- a/drivers/video/omap/omapfb_main.c -+++ b/drivers/video/omap/omapfb_main.c -@@ -420,10 +420,10 @@ static void set_fb_fix(struct fb_info *f - fbi->screen_base = rg->vaddr; - - if (!from_init) { -- mutex_lock(&fbi->mm_lock); -+ preempt_disable(); - fix->smem_start = rg->paddr; - fix->smem_len = rg->size; -- mutex_unlock(&fbi->mm_lock); -+ preempt_enable(); - } else { - fix->smem_start = rg->paddr; - fix->smem_len = rg->size; -@@ -933,10 +933,10 @@ static int omapfb_setup_mem(struct fb_in - * plane memory is dealloce'd, the other - * screen parameters in var / fix are invalid. - */ -- mutex_lock(&fbi->mm_lock); -+ preempt_disable(); - fbi->fix.smem_start = 0; - fbi->fix.smem_len = 0; -- mutex_unlock(&fbi->mm_lock); -+ preempt_enable(); - } - } - } ---- a/drivers/video/fbmem.c -+++ b/drivers/video/fbmem.c -@@ -1383,8 +1383,10 @@ fb_mmap(struct file *file, struct vm_are - } - - /* frame buffer memory */ -+ preempt_disable(); - start = info->fix.smem_start; - len = PAGE_ALIGN((start & ~PAGE_MASK) + info->fix.smem_len); -+ preempt_enable(); - if (off >= len) { - /* memory mapped io */ - off -= len; diff --git a/target/linux/omap24xx/patches-3.3/310-n810-lcd.patch b/target/linux/omap24xx/patches-3.3/310-n810-lcd.patch deleted file mode 100644 index 2ee79f2de5..0000000000 --- a/target/linux/omap24xx/patches-3.3/310-n810-lcd.patch +++ /dev/null @@ -1,368 +0,0 @@ ---- a/arch/arm/mach-omap2/board-n8x0.c -+++ b/arch/arm/mach-omap2/board-n8x0.c -@@ -24,6 +24,7 @@ - #include <linux/spi/spi.h> - #include <linux/usb/musb.h> - #include <sound/tlv320aic3x.h> -+#include <linux/spi/tsc2005.h> - - #include <asm/mach/arch.h> - #include <asm/mach-types.h> -@@ -43,6 +44,66 @@ static int slot1_cover_open; - static int slot2_cover_open; - static struct device *mmc_device; - -+#define RX51_TSC2005_RESET_GPIO 94 -+#define RX51_TSC2005_IRQ_GPIO 106 -+ -+#ifdef CONFIG_TOUCHSCREEN_TSC2005 -+static struct tsc2005_platform_data tsc2005_config; -+static void rx51_tsc2005_set_reset(bool enable) -+{ -+ gpio_set_value(RX51_TSC2005_RESET_GPIO, enable); -+} -+ -+static struct omap2_mcspi_device_config tsc2005_mcspi_config = { -+ .turbo_mode = 0, -+ .single_channel = 1, -+}; -+#endif -+ -+static void __init tsc2005_set_config(void) -+{ -+ const struct omap_lcd_config *conf; -+ -+ conf = omap_get_config(OMAP_TAG_LCD, struct omap_lcd_config); -+ if (conf != NULL) { -+#ifdef CONFIG_TOUCHSCREEN_TSC2005 -+ if (strcmp(conf->panel_name, "lph8923") == 0) { -+ tsc2005_config.ts_x_plate_ohm = 180; -+ tsc2005_config.ts_pressure_max = 2048; -+ tsc2005_config.ts_pressure_fudge = 2; -+ tsc2005_config.ts_x_max = 4096; -+ tsc2005_config.ts_x_fudge = 4; -+ tsc2005_config.ts_y_max = 4096; -+ tsc2005_config.ts_y_fudge = 7; -+ tsc2005_config.set_reset = rx51_tsc2005_set_reset; -+ } else if (strcmp(conf->panel_name, "ls041y3") == 0) { -+ tsc2005_config.ts_x_plate_ohm = 280; -+ tsc2005_config.ts_pressure_max = 2048; -+ tsc2005_config.ts_pressure_fudge = 2; -+ tsc2005_config.ts_x_max = 4096; -+ tsc2005_config.ts_x_fudge = 4; -+ tsc2005_config.ts_y_max = 4096; -+ tsc2005_config.ts_y_fudge = 7; -+ tsc2005_config.set_reset = rx51_tsc2005_set_reset; -+ } else { -+ printk(KERN_ERR "Unknown panel type, set default " -+ "touchscreen configuration\n"); -+ tsc2005_config.ts_x_plate_ohm = 200; -+ } -+#endif -+ } -+} -+ -+static struct omap2_mcspi_device_config mipid_mcspi_config = { -+ .turbo_mode = 0, -+ .single_channel = 1, -+}; -+ -+extern struct mipid_platform_data n8x0_mipid_platform_data; -+ -+extern void n8x0_mipid_init(void); -+extern void n8x0_blizzard_init(void); -+ - #define TUSB6010_ASYNC_CS 1 - #define TUSB6010_SYNC_CS 4 - #define TUSB6010_GPIO_INT 58 -@@ -145,12 +206,29 @@ static struct omap2_mcspi_device_config - - static struct spi_board_info n800_spi_board_info[] __initdata = { - { -+ .modalias = "lcd_mipid", -+ .bus_num = 1, -+ .chip_select = 1, -+ .max_speed_hz = 4000000, -+ .controller_data= &mipid_mcspi_config, -+ .platform_data = &n8x0_mipid_platform_data, -+ }, -+ { - .modalias = "p54spi", - .bus_num = 2, - .chip_select = 0, - .max_speed_hz = 48000000, - .controller_data = &p54spi_mcspi_config, - }, -+ { -+ .modalias = "tsc2005", -+ .bus_num = 1, -+ .chip_select = 0, -+ .irq = OMAP_GPIO_IRQ(RX51_TSC2005_IRQ_GPIO), -+ .max_speed_hz = 6000000, -+ .controller_data = &tsc2005_mcspi_config, -+ .platform_data = &tsc2005_config, -+ }, - }; - - #if defined(CONFIG_MTD_ONENAND_OMAP2) || \ -@@ -781,6 +859,7 @@ static void __init n8x0_init_machine(voi - n8x0_cbus_init(); - - /* FIXME: add n810 spi devices */ -+ tsc2005_set_config(); - spi_register_board_info(n800_spi_board_info, - ARRAY_SIZE(n800_spi_board_info)); - omap_register_i2c_bus(1, 400, n8x0_i2c_board_info_1, -@@ -790,6 +869,8 @@ static void __init n8x0_init_machine(voi - i2c_register_board_info(2, n810_i2c_board_info_2, - ARRAY_SIZE(n810_i2c_board_info_2)); - board_serial_init(); -+ n8x0_mipid_init(); -+ n8x0_blizzard_init(); - omap_sdrc_init(NULL, NULL); - gpmc_onenand_init(board_onenand_data); - n8x0_mmc_init(); ---- /dev/null -+++ b/arch/arm/mach-omap2/board-n8x0-lcd.c -@@ -0,0 +1,231 @@ -+/* -+ * linux/arch/arm/mach-omap2/board-n8x0.c -+ * -+ * Copyright (C) 2005-2009 Nokia Corporation -+ * Author: Juha Yrjola <juha.yrjola@nokia.com> -+ * -+ * Modified from mach-omap2/board-generic.c -+ * -+ * 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 <linux/clk.h> -+#include <linux/delay.h> -+#include <linux/gpio.h> -+#include <linux/omapfb.h> -+ -+#include <plat/lcd_mipid.h> -+#include <plat/blizzard.h> -+ -+#include "../../../drivers/cbus/tahvo.h" -+ -+ -+struct tahvo_pwm_device { -+ struct device *dev; -+ int tahvo_7bit_backlight; -+}; -+ -+static struct tahvo_pwm_device *tahvo_pwm; -+ -+static unsigned int tahvo_pwm_get_backlight_level(struct tahvo_pwm_device *pd) -+{ -+ unsigned int mask; -+ -+ if (pd->tahvo_7bit_backlight) -+ mask = 0x7f; -+ else -+ mask = 0x0f; -+ return tahvo_read_reg(pd->dev, TAHVO_REG_LEDPWMR) & mask; -+} -+ -+static unsigned int tahvo_pwm_get_max_backlight_level(struct tahvo_pwm_device *pd) -+{ -+ if (pd->tahvo_7bit_backlight) -+ return 0x7f; -+ return 0x0f; -+} -+ -+static void tahvo_pwm_set_backlight_level(struct tahvo_pwm_device *pd, unsigned int level) -+{ -+ unsigned int max_level; -+ -+ max_level = tahvo_pwm_get_max_backlight_level(pd); -+ if (level > max_level) -+ level = max_level; -+ tahvo_write_reg(pd->dev, TAHVO_REG_LEDPWMR, level); -+} -+ -+static int __init n8x0_tahvo_pwm_probe(struct platform_device *pdev) -+{ -+ struct tahvo_pwm_device *pd; -+ unsigned int rev, id; -+ -+ pd = kzalloc(sizeof(*pd), GFP_KERNEL); -+ if (WARN_ON(!pd)) -+ return -ENOMEM; -+ pd->dev = &pdev->dev; -+ -+ rev = tahvo_read_reg(pd->dev, TAHVO_REG_ASICR); -+ id = (rev >> 8) & 0xff; -+ if (id == 0x03) { -+ if ((rev & 0xff) >= 0x50) -+ pd->tahvo_7bit_backlight = 1; -+ } else if (id == 0x0b) -+ pd->tahvo_7bit_backlight = 1; -+ -+ dev_set_drvdata(pd->dev, pd); -+ tahvo_pwm = pd; -+ -+ return 0; -+} -+ -+static struct platform_driver n8x0_tahvo_pwm_driver = { -+ .driver = { -+ .name = "tahvo-pwm", -+ }, -+}; -+ -+static int __init n8x0_tahvo_pwm_init(void) -+{ -+ return platform_driver_probe(&n8x0_tahvo_pwm_driver, n8x0_tahvo_pwm_probe); -+} -+fs_initcall(n8x0_tahvo_pwm_init); -+ -+static int n8x0_get_backlight_level(struct mipid_platform_data *pdata) -+{ -+ return tahvo_pwm_get_backlight_level(tahvo_pwm); -+} -+ -+static int n8x0_get_max_backlight_level(struct mipid_platform_data *pdata) -+{ -+ return tahvo_pwm_get_max_backlight_level(tahvo_pwm); -+} -+ -+static void n8x0_set_backlight_level(struct mipid_platform_data *pdata, int level) -+{ -+ tahvo_pwm_set_backlight_level(tahvo_pwm, level); -+} -+ -+#define N8X0_BLIZZARD_POWERDOWN_GPIO 15 -+ -+// MIPID LCD Panel -+ -+static void mipid_shutdown(struct mipid_platform_data *pdata) -+{ -+ if (pdata->nreset_gpio != -1) { -+ pr_info("shutdown LCD\n"); -+ gpio_set_value(pdata->nreset_gpio, 0); -+ msleep(120); -+ } -+} -+ -+struct mipid_platform_data n8x0_mipid_platform_data = { -+ .shutdown = mipid_shutdown, -+ .get_bklight_level = n8x0_get_backlight_level, -+ .set_bklight_level = n8x0_set_backlight_level, -+ .get_bklight_max = n8x0_get_max_backlight_level, -+}; -+ -+void __init n8x0_mipid_init(void) -+{ -+ const struct omap_lcd_config *conf; -+ int err; -+ -+ conf = omap_get_config(OMAP_TAG_LCD, struct omap_lcd_config); -+ if (conf != NULL) { -+ n8x0_mipid_platform_data.nreset_gpio = conf->nreset_gpio; -+ n8x0_mipid_platform_data.data_lines = conf->data_lines; -+ if (conf->nreset_gpio != -1) { -+ err = gpio_request(conf->nreset_gpio, "MIPID nreset"); -+ if (err) { -+ printk(KERN_ERR "N8x0 MIPID failed to request nreset GPIO %d\n", -+ conf->nreset_gpio); -+ } else { -+ err = gpio_direction_output(conf->nreset_gpio, 1); -+ if (err) { -+ printk(KERN_ERR "N8x0 MIPID failed to set nreset GPIO %d\n", -+ conf->nreset_gpio); -+ } -+ } -+ } -+ printk(KERN_INFO "N8x0 MIPID config loaded"); -+ } -+ else -+ printk(KERN_INFO "N8x0 MIPID config not provided"); -+} -+ -+ -+// Epson Blizzard LCD Controller -+ -+static struct { -+ struct clk *sys_ck; -+} blizzard; -+ -+static int blizzard_get_clocks(void) -+{ -+ blizzard.sys_ck = clk_get(0, "osc_ck"); -+ if (IS_ERR(blizzard.sys_ck)) { -+ printk(KERN_ERR "can't get Blizzard clock\n"); -+ return PTR_ERR(blizzard.sys_ck); -+ } -+ return 0; -+} -+ -+static unsigned long blizzard_get_clock_rate(struct device *dev) -+{ -+ return clk_get_rate(blizzard.sys_ck); -+} -+ -+static void blizzard_enable_clocks(int enable) -+{ -+ if (enable) -+ clk_enable(blizzard.sys_ck); -+ else -+ clk_disable(blizzard.sys_ck); -+} -+ -+static void blizzard_power_up(struct device *dev) -+{ -+ /* Vcore to 1.475V */ -+ tahvo_set_clear_reg_bits(tahvo_pwm->dev, 0x07, 0, 0xf); -+ msleep(10); -+ -+ blizzard_enable_clocks(1); -+ gpio_set_value(N8X0_BLIZZARD_POWERDOWN_GPIO, 1); -+} -+ -+static void blizzard_power_down(struct device *dev) -+{ -+ gpio_set_value(N8X0_BLIZZARD_POWERDOWN_GPIO, 0); -+ blizzard_enable_clocks(0); -+ -+ /* Vcore to 1.005V */ -+ tahvo_set_clear_reg_bits(tahvo_pwm->dev, 0x07, 0xf, 0); -+} -+ -+static struct blizzard_platform_data n8x0_blizzard_data = { -+ .power_up = blizzard_power_up, -+ .power_down = blizzard_power_down, -+ .get_clock_rate = blizzard_get_clock_rate, -+ .te_connected = 1, -+}; -+ -+void __init n8x0_blizzard_init(void) -+{ -+ int r; -+ -+ r = gpio_request(N8X0_BLIZZARD_POWERDOWN_GPIO, "Blizzard pd"); -+ if (r < 0) -+ { -+ printk(KERN_ERR "Can't get N8x0 Blizzard powerdown GPIO %d\n", N8X0_BLIZZARD_POWERDOWN_GPIO); -+ return; -+ } -+ gpio_direction_output(N8X0_BLIZZARD_POWERDOWN_GPIO, 1); -+ -+ blizzard_get_clocks(); -+ omapfb_set_ctrl_platform_data(&n8x0_blizzard_data); -+ -+ printk(KERN_INFO "N8x0 Blizzard initialized"); -+} ---- a/arch/arm/mach-omap2/Makefile -+++ b/arch/arm/mach-omap2/Makefile -@@ -205,6 +205,7 @@ obj-$(CONFIG_MACH_OMAP3EVM) += board-om - obj-$(CONFIG_MACH_OMAP3_PANDORA) += board-omap3pandora.o - obj-$(CONFIG_MACH_OMAP_3430SDP) += board-3430sdp.o - obj-$(CONFIG_MACH_NOKIA_N8X0) += board-n8x0.o -+obj-$(CONFIG_MACH_NOKIA_N8X0) += board-n8x0-lcd.o - obj-$(CONFIG_MACH_NOKIA_RM680) += board-rm680.o \ - sdram-nokia.o - obj-$(CONFIG_MACH_NOKIA_RX51) += board-rx51.o \ diff --git a/target/linux/omap24xx/patches-3.3/311-omapfb-clock-fixes.patch b/target/linux/omap24xx/patches-3.3/311-omapfb-clock-fixes.patch deleted file mode 100644 index 6df6958204..0000000000 --- a/target/linux/omap24xx/patches-3.3/311-omapfb-clock-fixes.patch +++ /dev/null @@ -1,30 +0,0 @@ ---- a/drivers/video/omap/dispc.c -+++ b/drivers/video/omap/dispc.c -@@ -923,14 +923,14 @@ static int get_dss_clocks(void) - return PTR_ERR(dispc.dss_ick); - } - -- dispc.dss1_fck = clk_get(&dispc.fbdev->dssdev->dev, "fck"); -+ dispc.dss1_fck = clk_get(&dispc.fbdev->dssdev->dev, "dss1_fck"); - if (IS_ERR(dispc.dss1_fck)) { - dev_err(dispc.fbdev->dev, "can't get dss1_fck\n"); - clk_put(dispc.dss_ick); - return PTR_ERR(dispc.dss1_fck); - } - -- dispc.dss_54m_fck = clk_get(&dispc.fbdev->dssdev->dev, "tv_clk"); -+ dispc.dss_54m_fck = clk_get(&dispc.fbdev->dssdev->dev, "dss_54m_fck"); - if (IS_ERR(dispc.dss_54m_fck)) { - dev_err(dispc.fbdev->dev, "can't get tv_fck\n"); - clk_put(dispc.dss_ick); ---- a/drivers/video/omap/rfbi.c -+++ b/drivers/video/omap/rfbi.c -@@ -90,7 +90,7 @@ static int rfbi_get_clocks(void) - return PTR_ERR(rfbi.dss_ick); - } - -- rfbi.dss1_fck = clk_get(&rfbi.fbdev->dssdev->dev, "fck"); -+ rfbi.dss1_fck = clk_get(&rfbi.fbdev->dssdev->dev, "dss1_fck"); - if (IS_ERR(rfbi.dss1_fck)) { - dev_err(rfbi.fbdev->dev, "can't get dss1_fck\n"); - clk_put(rfbi.dss_ick); diff --git a/target/linux/omap24xx/patches-3.3/312-no-hwmod-reset.patch b/target/linux/omap24xx/patches-3.3/312-no-hwmod-reset.patch deleted file mode 100644 index 65c14ab3a7..0000000000 --- a/target/linux/omap24xx/patches-3.3/312-no-hwmod-reset.patch +++ /dev/null @@ -1,28 +0,0 @@ ---- a/arch/arm/mach-omap2/omap_hwmod.c -+++ b/arch/arm/mach-omap2/omap_hwmod.c -@@ -146,6 +146,8 @@ - #include <plat/omap_hwmod.h> - #include <plat/prcm.h> - -+#include <asm/mach-types.h> -+ - #include "cm2xxx_3xxx.h" - #include "cminst44xx.h" - #include "prm2xxx_3xxx.h" -@@ -1769,6 +1771,16 @@ static int _setup(struct omap_hwmod *oh, - - oh->_state = _HWMOD_STATE_INITIALIZED; - -+ if (machine_is_nokia770() || -+ machine_is_nokia_n800() || -+ machine_is_nokia_n810() || -+ machine_is_nokia_n810_wimax()) { -+ /* Nokia N-series workaround: Don't reset any hwmod. Some drivers expect -+ * the NOLO bootloader initializations to be effective. */ -+ oh->flags |= HWMOD_INIT_NO_RESET; -+ printk_once(KERN_INFO "Nokia N-series HWMOD_INIT_NO_RESET workaround enabled\n"); -+ } -+ - /* - * In the case of hwmod with hardreset that should not be - * de-assert at boot time, we have to keep the module diff --git a/target/linux/omap24xx/patches-3.3/315-n800-touchscreen-and-keypad-drivers.patch b/target/linux/omap24xx/patches-3.3/315-n800-touchscreen-and-keypad-drivers.patch deleted file mode 100644 index 106a5d80c8..0000000000 --- a/target/linux/omap24xx/patches-3.3/315-n800-touchscreen-and-keypad-drivers.patch +++ /dev/null @@ -1,2791 +0,0 @@ -From 63e56392b9024aceb610d7b4e1979e2d2cebd217 Mon Sep 17 00:00:00 2001 -From: Marat Radchenko <marat@slonopotamus.org> -Date: Tue, 18 Oct 2011 21:48:23 +0400 -Subject: [PATCH 1/2] TSC2301 driver (touchscreen and keypad) - -This patch adds support for TSC2301 touchscreen/keypad/audio chip found on Nokia N800. -Touchscreen and keypad are fully functional, audio part only provides power management. ---- - drivers/input/keyboard/Kconfig | 6 + - drivers/input/keyboard/Makefile | 1 + - drivers/input/keyboard/tsc2301_kp.c | 475 +++++++++++++++ - drivers/input/touchscreen/Kconfig | 6 + - drivers/input/touchscreen/Makefile | 1 + - drivers/input/touchscreen/tsc2301_ts.c | 676 +++++++++++++++++++++ - drivers/spi/Kconfig | 22 + - drivers/spi/Makefile | 3 + - drivers/spi/tsc2301-core.c | 297 ++++++++++ - drivers/spi/tsc2301-mixer.c | 1003 ++++++++++++++++++++++++++++++++ - include/linux/spi/tsc2301.h | 208 +++++++ - 11 files changed, 2698 insertions(+), 0 deletions(-) - create mode 100644 drivers/input/keyboard/tsc2301_kp.c - create mode 100644 drivers/input/touchscreen/tsc2301_ts.c - create mode 100644 drivers/spi/tsc2301-core.c - create mode 100644 drivers/spi/tsc2301-mixer.c - create mode 100644 include/linux/spi/tsc2301.h - ---- a/drivers/input/keyboard/Kconfig -+++ b/drivers/input/keyboard/Kconfig -@@ -547,6 +547,12 @@ config KEYBOARD_TNETV107X - To compile this driver as a module, choose M here: the - module will be called tnetv107x-keypad. - -+config KEYBOARD_TSC2301 -+ tristate "TSC2301 keypad support" -+ depends on SPI_TSC2301 -+ help -+ Say Y here for if you are using the keypad features of TSC2301. -+ - config KEYBOARD_TWL4030 - tristate "TI TWL4030/TWL5030/TPS659x0 keypad support" - depends on TWL4030_CORE ---- a/drivers/input/keyboard/Makefile -+++ b/drivers/input/keyboard/Makefile -@@ -49,6 +49,7 @@ obj-$(CONFIG_KEYBOARD_SUNKBD) += sunkbd - obj-$(CONFIG_KEYBOARD_TC3589X) += tc3589x-keypad.o - obj-$(CONFIG_KEYBOARD_TEGRA) += tegra-kbc.o - obj-$(CONFIG_KEYBOARD_TNETV107X) += tnetv107x-keypad.o -+obj-$(CONFIG_KEYBOARD_TSC2301) += tsc2301_kp.o - obj-$(CONFIG_KEYBOARD_TWL4030) += twl4030_keypad.o - obj-$(CONFIG_KEYBOARD_XTKBD) += xtkbd.o - obj-$(CONFIG_KEYBOARD_W90P910) += w90p910_keypad.o ---- /dev/null -+++ b/drivers/input/keyboard/tsc2301_kp.c -@@ -0,0 +1,475 @@ -+/* -+ * TSC2301 keypad driver -+ * -+ * Copyright (C) 2005-2006 Nokia Corporation -+ * -+ * Written by Jarkko Oikarinen -+ * Rewritten by Juha Yrjola <juha.yrjola@nokia.com> -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ * -+ */ -+ -+#include <linux/kernel.h> -+#include <linux/module.h> -+#include <linux/input.h> -+#include <linux/interrupt.h> -+#include <linux/irq.h> -+#include <linux/delay.h> -+#include <linux/spi/spi.h> -+ -+#include <linux/spi/tsc2301.h> -+ -+#define TSC2301_KEYBOARD_PRODUCT_ID 0x0051 -+#define TSC2301_KEYBOARD_PRODUCT_VERSION 0x0001 -+#define TSC2301_DEBOUNCE_TIME_2MS 0x0000 -+#define TSC2301_DEBOUNCE_TIME_10MS 0x0800 -+#define TSC2301_DEBOUNCE_TIME_20MS 0x1000 -+#define TSC2301_DEBOUNCE_TIME_50MS 0x1800 -+#define TSC2301_DEBOUNCE_TIME_60MS 0x2000 -+#define TSC2301_DEBOUNCE_TIME_80MS 0x2800 -+#define TSC2301_DEBOUNCE_TIME_100MS 0x3000 -+#define TSC2301_DEBOUNCE_TIME_120MS 0x3800 -+ -+#define TSC2301_DEBOUNCE_TIME TSC2301_DEBOUNCE_TIME_20MS -+ -+#define TSC2301_RELEASE_TIMEOUT 50 -+ -+struct tsc2301_kp { -+ struct input_dev *idev; -+ char phys[32]; -+ spinlock_t lock; -+ struct mutex mutex; -+ struct timer_list timer; -+ u16 keys_pressed; -+ unsigned pending:1; -+ unsigned user_disabled:1; -+ unsigned disable_depth; -+ -+ struct spi_transfer read_xfer[4]; -+ struct spi_message read_msg; -+ -+ u16 data; -+ u16 mask; -+ -+ int irq; -+ s16 keymap[16]; -+}; -+ -+static inline int tsc2301_kp_disabled(struct tsc2301 *tsc) -+{ -+ return tsc->kp->disable_depth != 0; -+} -+ -+static void tsc2301_kp_send_key_events(struct tsc2301 *tsc, -+ u16 prev_state, -+ u16 new_state) -+{ -+ struct tsc2301_kp *kp = tsc->kp; -+ u16 common, released, pressed; -+ int i; -+ -+ common = prev_state & new_state; -+ released = common ^ prev_state; -+ pressed = common ^ new_state; -+ if (!released && !pressed) -+ return; -+ for (i = 0; i < 16 && (released || pressed); i++) { -+ if (released & 1) { -+ dev_dbg(&tsc->spi->dev, "key %d released\n", i); -+ input_report_key(kp->idev, kp->keymap[i], 0); -+ } -+ released >>= 1; -+ if (pressed & 1) { -+ dev_dbg(&tsc->spi->dev, "key %d pressed\n", i); -+ input_report_key(kp->idev, kp->keymap[i], 1); -+ } -+ pressed >>= 1; -+ } -+ input_sync(kp->idev); -+} -+ -+static inline void _filter_out(struct tsc2301 *tsc, u16 prev_state, -+ u16 *new_state, int row1, int row2, u8 rect_pat) -+{ -+ u16 mask; -+ -+ mask = (rect_pat << (row1 * 4)) | (rect_pat << (row2 * 4)); -+ mask &= ~prev_state; -+ *new_state &= ~mask; -+ dev_dbg(&tsc->spi->dev, "filtering ghost keys %02x\n", mask); -+} -+ -+static void tsc2301_filter_ghost_keys(struct tsc2301 *tsc, u16 prev_state, -+ u16 *new_state) -+{ -+ int row1, row2; -+ u16 key_map; -+ u16 row1_map; -+ static const u8 rect_pat[] = { -+ 0x3, 0x5, 0x9, 0x6, 0xa, 0xc, 0, -+ }; -+ -+ key_map = *new_state; -+ for (row1 = 0; row1 < 4; row1++) { -+ row1_map = (key_map >> (row1 * 4)) & 0xf; -+ if (!row1_map) -+ continue; -+ for (row2 = row1 + 1; row2 < 4; row2++) { -+ u16 rect_map = (key_map >> (row2 * 4)) & 0xf; -+ const u8 *rp; -+ -+ rect_map &= row1_map; -+ if (!rect_map) -+ continue; -+ for (rp = rect_pat; *rp; rp++) -+ if ((rect_map & *rp) == *rp) -+ _filter_out(tsc, prev_state, new_state, -+ row1, row2, *rp); -+ } -+ } -+} -+ -+static void tsc2301_kp_timer(unsigned long arg) -+{ -+ struct tsc2301 *tsc = (void *) arg; -+ struct tsc2301_kp *kp = tsc->kp; -+ unsigned long flags; -+ -+ tsc2301_kp_send_key_events(tsc, kp->keys_pressed, 0); -+ spin_lock_irqsave(&kp->lock, flags); -+ kp->keys_pressed = 0; -+ spin_unlock_irqrestore(&kp->lock, flags); -+} -+ -+static void tsc2301_kp_rx(void *arg) -+{ -+ struct tsc2301 *tsc = arg; -+ struct tsc2301_kp *kp = tsc->kp; -+ unsigned long flags; -+ u16 kp_data; -+ -+ kp_data = kp->data; -+ dev_dbg(&tsc->spi->dev, "KP data %04x\n", kp_data); -+ -+ tsc2301_filter_ghost_keys(tsc, kp->keys_pressed, &kp_data); -+ tsc2301_kp_send_key_events(tsc, kp->keys_pressed, kp_data); -+ spin_lock_irqsave(&kp->lock, flags); -+ kp->keys_pressed = kp_data; -+ kp->pending = 0; -+ spin_unlock_irqrestore(&kp->lock, flags); -+} -+ -+static irqreturn_t tsc2301_kp_irq_handler(int irq, void *dev_id) -+{ -+ struct tsc2301 *tsc = dev_id; -+ struct tsc2301_kp *kp = tsc->kp; -+ unsigned long flags; -+ int r; -+ -+ spin_lock_irqsave(&kp->lock, flags); -+ if (tsc2301_kp_disabled(tsc)) { -+ spin_unlock_irqrestore(&kp->lock, flags); -+ return IRQ_HANDLED; -+ } -+ kp->pending = 1; -+ spin_unlock_irqrestore(&kp->lock, flags); -+ mod_timer(&kp->timer, -+ jiffies + msecs_to_jiffies(TSC2301_RELEASE_TIMEOUT)); -+ r = spi_async(tsc->spi, &tsc->kp->read_msg); -+ if (r) -+ dev_err(&tsc->spi->dev, "kp: spi_async() failed"); -+ return IRQ_HANDLED; -+} -+ -+static void tsc2301_kp_start_scan(struct tsc2301 *tsc) -+{ -+ tsc2301_write_reg(tsc, TSC2301_REG_KPMASK, tsc->kp->mask); -+ tsc2301_write_reg(tsc, TSC2301_REG_KEY, TSC2301_DEBOUNCE_TIME); -+} -+ -+static void tsc2301_kp_stop_scan(struct tsc2301 *tsc) -+{ -+ tsc2301_write_reg(tsc, TSC2301_REG_KEY, 1 << 14); -+} -+ -+/* Must be called with the mutex held */ -+static void tsc2301_kp_enable(struct tsc2301 *tsc) -+{ -+ struct tsc2301_kp *kp = tsc->kp; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&kp->lock, flags); -+ BUG_ON(!tsc2301_kp_disabled(tsc)); -+ if (--kp->disable_depth != 0) { -+ spin_unlock_irqrestore(&kp->lock, flags); -+ return; -+ } -+ spin_unlock_irqrestore(&kp->lock, flags); -+ -+ irq_set_irq_type(kp->irq, IRQ_TYPE_EDGE_FALLING); -+ tsc2301_kp_start_scan(tsc); -+ enable_irq(kp->irq); -+} -+ -+/* Must be called with the mutex held */ -+static int tsc2301_kp_disable(struct tsc2301 *tsc, int release_keys) -+{ -+ struct tsc2301_kp *kp = tsc->kp; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&kp->lock, flags); -+ if (kp->disable_depth++ != 0) { -+ spin_unlock_irqrestore(&kp->lock, flags); -+ goto out; -+ } -+ disable_irq_nosync(kp->irq); -+ irq_set_irq_type(kp->irq, IRQ_TYPE_NONE); -+ spin_unlock_irqrestore(&kp->lock, flags); -+ -+ while (kp->pending) { -+ msleep(1); -+ } -+ -+ tsc2301_kp_stop_scan(tsc); -+out: -+ if (!release_keys) -+ del_timer(&kp->timer); /* let timeout release keys */ -+ -+ return 0; -+} -+ -+/* The following workaround is needed for a HW bug triggered by the -+ * following: -+ * 1. keep any key pressed -+ * 2. disable keypad -+ * 3. release all keys -+ * 4. reenable keypad -+ * 5. disable touch screen controller -+ * -+ * After this the keypad scanner will get stuck in busy state and won't -+ * report any interrupts for further keypresses. One way to recover is to -+ * restart the keypad scanner whenever we enable / disable the -+ * touchscreen controller. -+ */ -+void tsc2301_kp_restart(struct tsc2301 *tsc) -+{ -+ if (!tsc2301_kp_disabled(tsc)) { -+ tsc2301_kp_start_scan(tsc); -+ } -+} -+ -+static ssize_t tsc2301_kp_disable_show(struct device *dev, -+ struct device_attribute *attr, char *buf) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(dev); -+ -+ return sprintf(buf, "%u\n", tsc2301_kp_disabled(tsc) ? 1 : 0); -+} -+ -+static ssize_t tsc2301_kp_disable_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(dev); -+ struct tsc2301_kp *kp = tsc->kp; -+ char *endp; -+ int i; -+ -+ i = simple_strtoul(buf, &endp, 10); -+ i = i ? 1 : 0; -+ -+ mutex_lock(&kp->mutex); -+ if (i == kp->user_disabled) { -+ mutex_unlock(&kp->mutex); -+ return count; -+ } -+ kp->user_disabled = i; -+ -+ if (i) -+ tsc2301_kp_disable(tsc, 1); -+ else -+ tsc2301_kp_enable(tsc); -+ mutex_unlock(&kp->mutex); -+ -+ return count; -+} -+ -+static DEVICE_ATTR(disable_kp, 0664, tsc2301_kp_disable_show, -+ tsc2301_kp_disable_store); -+ -+static const u16 tsc2301_kp_read_data = 0x8000 | TSC2301_REG_KPDATA; -+ -+static void tsc2301_kp_setup_spi_xfer(struct tsc2301 *tsc) -+{ -+ struct tsc2301_kp *kp = tsc->kp; -+ struct spi_message *m = &kp->read_msg; -+ struct spi_transfer *x = &kp->read_xfer[0]; -+ -+ spi_message_init(&kp->read_msg); -+ -+ x->tx_buf = &tsc2301_kp_read_data; -+ x->len = 2; -+ spi_message_add_tail(x, m); -+ x++; -+ -+ x->rx_buf = &kp->data; -+ x->len = 2; -+ spi_message_add_tail(x, m); -+ -+ m->complete = tsc2301_kp_rx; -+ m->context = tsc; -+} -+ -+#ifdef CONFIG_PM -+int tsc2301_kp_suspend(struct tsc2301 *tsc) -+{ -+ struct tsc2301_kp *kp = tsc->kp; -+ -+ mutex_lock(&kp->mutex); -+ tsc2301_kp_disable(tsc, 1); -+ mutex_unlock(&kp->mutex); -+ return 0; -+} -+ -+void tsc2301_kp_resume(struct tsc2301 *tsc) -+{ -+ struct tsc2301_kp *kp = tsc->kp; -+ -+ mutex_lock(&kp->mutex); -+ tsc2301_kp_enable(tsc); -+ mutex_unlock(&kp->mutex); -+} -+#endif -+ -+int __devinit tsc2301_kp_init(struct tsc2301 *tsc, -+ struct tsc2301_platform_data *pdata) -+{ -+ struct input_dev *idev; -+ struct tsc2301_kp *kp; -+ int r, i; -+ u16 mask; -+ -+ if (pdata->keyb_int < 0) { -+ dev_err(&tsc->spi->dev, "need kbirq"); -+ return -EINVAL; -+ } -+ -+ kp = kzalloc(sizeof(*kp), GFP_KERNEL); -+ if (kp == NULL) -+ return -ENOMEM; -+ tsc->kp = kp; -+ -+ kp->irq = pdata->keyb_int; -+ spin_lock_init(&kp->lock); -+ mutex_init(&kp->mutex); -+ -+ init_timer(&kp->timer); -+ kp->timer.data = (unsigned long) tsc; -+ kp->timer.function = tsc2301_kp_timer; -+ -+ idev = input_allocate_device(); -+ if (idev == NULL) { -+ r = -ENOMEM; -+ goto err1; -+ } -+ if (pdata->keyb_name) -+ idev->name = pdata->keyb_name; -+ else -+ idev->name = "TSC2301 keypad"; -+ snprintf(kp->phys, sizeof(kp->phys), "%s/input-kp", dev_name(&tsc->spi->dev)); -+ idev->phys = kp->phys; -+ -+ mask = 0; -+ idev->evbit[0] = BIT(EV_KEY); -+ for (i = 0; i < 16; i++) { -+ if (pdata->keymap[i] > 0) { -+ set_bit(pdata->keymap[i], idev->keybit); -+ kp->keymap[i] = pdata->keymap[i]; -+ } else { -+ kp->keymap[i] = -1; -+ mask |= 1 << i; -+ } -+ } -+ -+ if (pdata->kp_rep) -+ set_bit(EV_REP, idev->evbit); -+ -+ kp->idev = idev; -+ -+ tsc2301_kp_setup_spi_xfer(tsc); -+ -+ r = device_create_file(&tsc->spi->dev, &dev_attr_disable_kp); -+ if (r < 0) -+ goto err2; -+ -+ tsc2301_kp_start_scan(tsc); -+ -+ /* IRQ mode 0 is faulty, it can cause the KBIRQ to get stuck. -+ * Mode 2 deasserts the IRQ at: -+ * - HW or SW reset -+ * - Setting SCS flag in REG_KEY register -+ * - Releasing all keys -+ * - Reading the REG_KPDATA -+ */ -+ tsc2301_write_kbc(tsc, 2); -+ -+ tsc2301_write_reg(tsc, TSC2301_REG_KPMASK, mask); -+ kp->mask = mask; -+ -+ irq_set_irq_type(kp->irq, IRQ_TYPE_EDGE_FALLING); -+ -+ r = request_irq(kp->irq, tsc2301_kp_irq_handler, 0, -+ "tsc2301-kp", tsc); -+ if (r < 0) { -+ dev_err(&tsc->spi->dev, "unable to get kbirq IRQ"); -+ goto err3; -+ } -+ irq_set_irq_wake(kp->irq, 1); -+ -+ /* We need to read the register once..? */ -+ tsc2301_read_reg(tsc, TSC2301_REG_KPDATA); -+ -+ r = input_register_device(idev); -+ if (r < 0) { -+ dev_err(&tsc->spi->dev, "can't register keypad device\n"); -+ goto err4; -+ } -+ -+ return 0; -+ -+err4: -+ free_irq(kp->irq, tsc); -+err3: -+ tsc2301_kp_stop_scan(tsc); -+ device_remove_file(&tsc->spi->dev, &dev_attr_disable_kp); -+err2: -+ input_free_device(kp->idev); -+err1: -+ kfree(kp); -+ return r; -+} -+ -+void __devexit tsc2301_kp_exit(struct tsc2301 *tsc) -+{ -+ struct tsc2301_kp *kp = tsc->kp; -+ -+ tsc2301_kp_disable(tsc, 1); -+ input_unregister_device(kp->idev); -+ free_irq(kp->irq, tsc); -+ device_remove_file(&tsc->spi->dev, &dev_attr_disable_kp); -+ -+ kfree(kp); -+} ---- a/drivers/input/touchscreen/Kconfig -+++ b/drivers/input/touchscreen/Kconfig -@@ -726,6 +726,12 @@ config TOUCHSCREEN_TSC2007 - To compile this driver as a module, choose M here: the - module will be called tsc2007. - -+config TOUCHSCREEN_TSC2301 -+ tristate "TSC2301 touchscreen support" -+ depends on SPI_TSC2301 -+ help -+ Say Y here for if you are using the touchscreen features of TSC2301. -+ - config TOUCHSCREEN_W90X900 - tristate "W90P910 touchscreen driver" - depends on HAVE_CLK ---- a/drivers/input/touchscreen/Makefile -+++ b/drivers/input/touchscreen/Makefile -@@ -52,6 +52,7 @@ obj-$(CONFIG_TOUCHSCREEN_TOUCHWIN) += to - obj-$(CONFIG_TOUCHSCREEN_TSC_SERIO) += tsc40.o - obj-$(CONFIG_TOUCHSCREEN_TSC2005) += tsc2005.o - obj-$(CONFIG_TOUCHSCREEN_TSC2007) += tsc2007.o -+obj-$(CONFIG_TOUCHSCREEN_TSC2301) += tsc2301_ts.o - obj-$(CONFIG_TOUCHSCREEN_UCB1400) += ucb1400_ts.o - obj-$(CONFIG_TOUCHSCREEN_WACOM_W8001) += wacom_w8001.o - obj-$(CONFIG_TOUCHSCREEN_WM831X) += wm831x-ts.o ---- /dev/null -+++ b/drivers/input/touchscreen/tsc2301_ts.c -@@ -0,0 +1,676 @@ -+/* -+ * TSC2301 touchscreen driver -+ * -+ * Copyright (C) 2005-2008 Nokia Corporation -+ * -+ * Written by Jarkko Oikarinen, Imre Deak and Juha Yrjola -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ * -+ */ -+ -+#include <linux/kernel.h> -+#include <linux/module.h> -+#include <linux/input.h> -+#include <linux/interrupt.h> -+#include <linux/delay.h> -+#include <linux/spi/spi.h> -+ -+#include <linux/spi/tsc2301.h> -+ -+/** -+ * The touchscreen interface operates as follows: -+ * -+ * Initialize: -+ * Request access to GPIO103 (DAV) -+ * tsc2301_ts_irq_handler will trigger when DAV line goes down -+ * -+ * 1) Pen is pressed against touchscreeen -+ * 2) TSC2301 performs AD conversion -+ * 3) After the conversion is done TSC2301 drives DAV line down -+ * 4) GPIO IRQ is received and tsc2301_ts_irq_handler is called -+ * 5) tsc2301_ts_irq_handler queues up an spi transfer to fetch -+ * the x, y, z1, z2 values -+ * 6) SPI framework calls tsc2301_ts_rx after the coordinates are read -+ * 7) When the penup_timer expires, there have not been DAV interrupts -+ * during the last 20ms which means the pen has been lifted. -+ */ -+ -+ -+#define TSC2301_TOUCHSCREEN_PRODUCT_ID 0x0052 -+#define TSC2301_TOUCHSCREEN_PRODUCT_VERSION 0x0001 -+ -+#define TSC2301_TS_PENUP_TIME 20 -+ -+#define TSC2301_ADCREG_CONVERSION_CTRL_BY_TSC2301 0x8000 -+#define TSC2301_ADCREG_CONVERSION_CTRL_BY_HOST 0x0000 -+ -+#define TSC2301_ADCREG_FUNCTION_NONE 0x0000 -+#define TSC2301_ADCREG_FUNCTION_XY 0x0400 -+#define TSC2301_ADCREG_FUNCTION_XYZ 0x0800 -+#define TSC2301_ADCREG_FUNCTION_X 0x0C00 -+#define TSC2301_ADCREG_FUNCTION_Y 0x1000 -+#define TSC2301_ADCREG_FUNCTION_Z 0x1400 -+#define TSC2301_ADCREG_FUNCTION_DAT1 0x1800 -+#define TSC2301_ADCREG_FUNCTION_DAT2 0x1C00 -+#define TSC2301_ADCREG_FUNCTION_AUX1 0x2000 -+#define TSC2301_ADCREG_FUNCTION_AUX2 0x2400 -+#define TSC2301_ADCREG_FUNCTION_TEMP 0x2800 -+ -+#define TSC2301_ADCREG_RESOLUTION_8BIT 0x0100 -+#define TSC2301_ADCREG_RESOLUTION_10BIT 0x0200 -+#define TSC2301_ADCREG_RESOLUTION_12BIT 0x0300 -+ -+#define TSC2301_ADCREG_AVERAGING_NONE 0x0000 -+#define TSC2301_ADCREG_AVERAGING_4AVG 0x0040 -+#define TSC2301_ADCREG_AVERAGING_8AVG 0x0080 -+#define TSC2301_ADCREG_AVERAGING_16AVG 0x00C0 -+ -+#define TSC2301_ADCREG_CLOCK_8MHZ 0x0000 -+#define TSC2301_ADCREG_CLOCK_4MHZ 0x0010 -+#define TSC2301_ADCREG_CLOCK_2MHZ 0x0020 -+#define TSC2301_ADCREG_CLOCK_1MHZ 0x0030 -+ -+#define TSC2301_ADCREG_VOLTAGE_STAB_0US 0x0000 -+#define TSC2301_ADCREG_VOLTAGE_STAB_100US 0x0002 -+#define TSC2301_ADCREG_VOLTAGE_STAB_500US 0x0004 -+#define TSC2301_ADCREG_VOLTAGE_STAB_1MS 0x0006 -+#define TSC2301_ADCREG_VOLTAGE_STAB_5MS 0x0008 -+#define TSC2301_ADCREG_VOLTAGE_STAB_10MS 0x000A -+#define TSC2301_ADCREG_VOLTAGE_STAB_50MS 0x000C -+#define TSC2301_ADCREG_VOLTAGE_STAB_100MS 0x000E -+ -+#define TSC2301_ADCREG_STOP_CONVERSION 0x4000 -+ -+#define MAX_12BIT ((1 << 12) - 1) -+ -+#define TS_RECT_SIZE 8 -+#define TSF_MIN_Z1 100 -+#define TSF_MAX_Z2 4000 -+ -+#define TSF_SAMPLES 4 -+ -+struct ts_filter { -+ int sample_cnt; -+ -+ int avg_x; -+ int avg_y; -+ int avg_z1; -+ int avg_z2; -+}; -+ -+struct ts_coords { -+ u16 x; -+ u16 y; -+ u16 z1; -+ u16 z2; -+}; -+ -+struct tsc2301_ts { -+ struct input_dev *idev; -+ char phys[32]; -+ struct timer_list penup_timer; -+ struct mutex mutex; -+ -+ struct spi_transfer read_xfer[2]; -+ struct spi_message read_msg; -+ struct ts_coords *coords; -+ -+ struct ts_filter filter; -+ -+ int hw_avg_max; -+ u16 x; -+ u16 y; -+ u16 p; -+ -+ u16 x_plate_ohm; -+ int stab_time; -+ int max_pressure; -+ int touch_pressure; -+ -+ u8 event_sent; -+ u8 pen_down; -+ u8 disabled; -+ u8 disable_depth; -+ -+ int hw_flags; -+ int irq; -+}; -+ -+ -+static const u16 tsc2301_ts_read_data = 0x8000 | TSC2301_REG_X; -+ -+static int tsc2301_ts_check_config(struct tsc2301_ts *ts, int *hw_flags) -+{ -+ int flags; -+ -+ flags = 0; -+ switch (ts->hw_avg_max) { -+ case 0: -+ flags |= TSC2301_ADCREG_AVERAGING_NONE; -+ break; -+ case 4: -+ flags |= TSC2301_ADCREG_AVERAGING_4AVG; -+ break; -+ case 8: -+ flags |= TSC2301_ADCREG_AVERAGING_8AVG; -+ break; -+ case 16: -+ flags |= TSC2301_ADCREG_AVERAGING_16AVG; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ switch (ts->stab_time) { -+ case 0: -+ flags |= TSC2301_ADCREG_VOLTAGE_STAB_0US; -+ break; -+ case 100: -+ flags |= TSC2301_ADCREG_VOLTAGE_STAB_100US; -+ break; -+ case 500: -+ flags |= TSC2301_ADCREG_VOLTAGE_STAB_500US; -+ break; -+ case 1000: -+ flags |= TSC2301_ADCREG_VOLTAGE_STAB_1MS; -+ break; -+ case 5000: -+ flags |= TSC2301_ADCREG_VOLTAGE_STAB_5MS; -+ break; -+ case 10000: -+ flags |= TSC2301_ADCREG_VOLTAGE_STAB_10MS; -+ break; -+ case 50000: -+ flags |= TSC2301_ADCREG_VOLTAGE_STAB_50MS; -+ break; -+ case 100000: -+ flags |= TSC2301_ADCREG_VOLTAGE_STAB_100MS; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ *hw_flags = flags; -+ return 0; -+} -+ -+/* -+ * This odd three-time initialization is to work around a bug in TSC2301. -+ * See TSC2301 errata for details. -+ */ -+static int tsc2301_ts_configure(struct tsc2301 *tsc, int flags) -+{ -+ struct spi_transfer xfer[5]; -+ struct spi_transfer *x; -+ struct spi_message m; -+ int i; -+ u16 val1, val2, val3; -+ u16 data[10]; -+ -+ val1 = TSC2301_ADCREG_CONVERSION_CTRL_BY_HOST | -+ TSC2301_ADCREG_STOP_CONVERSION | -+ TSC2301_ADCREG_FUNCTION_NONE | -+ TSC2301_ADCREG_RESOLUTION_12BIT | -+ TSC2301_ADCREG_AVERAGING_NONE | -+ TSC2301_ADCREG_CLOCK_2MHZ | -+ TSC2301_ADCREG_VOLTAGE_STAB_100MS; -+ -+ val2 = TSC2301_ADCREG_CONVERSION_CTRL_BY_HOST | -+ TSC2301_ADCREG_FUNCTION_XYZ | -+ TSC2301_ADCREG_RESOLUTION_12BIT | -+ TSC2301_ADCREG_AVERAGING_16AVG | -+ TSC2301_ADCREG_CLOCK_1MHZ | -+ TSC2301_ADCREG_VOLTAGE_STAB_100MS; -+ -+ /* Averaging and voltage stabilization settings in flags */ -+ val3 = TSC2301_ADCREG_CONVERSION_CTRL_BY_TSC2301 | -+ TSC2301_ADCREG_FUNCTION_XYZ | -+ TSC2301_ADCREG_RESOLUTION_12BIT | -+ TSC2301_ADCREG_CLOCK_2MHZ | -+ flags; -+ -+ /* Now we prepare the command for transferring */ -+ data[0] = TSC2301_REG_ADC; -+ data[1] = val1; -+ data[2] = TSC2301_REG_ADC; -+ data[3] = val2; -+ data[4] = TSC2301_REG_ADC; -+ data[5] = val3; -+ data[6] = TSC2301_REG_REF; -+ data[7] = 1 << 4 | 1 << 2 | 1; /* intref, 100uS settl, 2.5V ref */ -+ data[8] = TSC2301_REG_CONFIG; -+ data[9] = 3 << 3 | 2 << 0; /* 340uS pre-chrg, 544us delay */ -+ -+ spi_message_init(&m); -+ m.spi = tsc->spi; -+ -+ memset(xfer, 0, sizeof(xfer)); -+ x = &xfer[0]; -+ -+ for (i = 0; i < 10; i += 2) { -+ x->tx_buf = &data[i]; -+ x->len = 4; -+ if (i != 8) -+ x->cs_change = 1; -+ spi_message_add_tail(x, &m); -+ x++; -+ } -+ spi_sync(m.spi, &m); -+ -+ return 0; -+} -+ -+static void tsc2301_ts_start_scan(struct tsc2301 *tsc) -+{ -+ tsc2301_ts_configure(tsc, tsc->ts->hw_flags); -+ tsc2301_kp_restart(tsc); -+} -+ -+static void tsc2301_ts_stop_scan(struct tsc2301 *tsc) -+{ -+ tsc2301_write_reg(tsc, TSC2301_REG_ADC, TSC2301_ADCREG_STOP_CONVERSION); -+ tsc2301_kp_restart(tsc); -+} -+ -+static void update_pen_state(struct tsc2301_ts *ts, int x, int y, int pressure) -+{ -+ if (pressure) { -+ input_report_abs(ts->idev, ABS_X, x); -+ input_report_abs(ts->idev, ABS_Y, y); -+ input_report_abs(ts->idev, ABS_PRESSURE, pressure); -+ if (!ts->pen_down) -+ input_report_key(ts->idev, BTN_TOUCH, 1); -+ ts->pen_down = 1; -+ } else { -+ input_report_abs(ts->idev, ABS_PRESSURE, 0); -+ if (ts->pen_down) -+ input_report_key(ts->idev, BTN_TOUCH, 0); -+ ts->pen_down = 0; -+ } -+ -+ input_sync(ts->idev); -+ -+#ifdef VERBOSE -+ dev_dbg(&tsc->spi->dev, "x %4d y %4d p %4d\n", x, y, pressure); -+#endif -+} -+ -+static int filter(struct tsc2301_ts *ts, int x, int y, int z1, int z2) -+{ -+ int inside_rect, pressure_limit, Rt; -+ struct ts_filter *tsf = &ts->filter; -+ -+ /* validate pressure and position */ -+ if (x > MAX_12BIT || y > MAX_12BIT) -+ return 0; -+ -+ /* skip coords if the pressure-components are out of range */ -+ if (z1 < TSF_MIN_Z1 || z2 > TSF_MAX_Z2) -+ return 0; -+ -+ /* Use the x,y,z1,z2 directly on the first "pen down" event */ -+ if (ts->event_sent) { -+ tsf->avg_x += x; -+ tsf->avg_y += y; -+ tsf->avg_z1 += z1; -+ tsf->avg_z2 += z2; -+ -+ if (++tsf->sample_cnt < TSF_SAMPLES) -+ return 0; -+ x = tsf->avg_x / TSF_SAMPLES; -+ y = tsf->avg_y / TSF_SAMPLES; -+ z1 = tsf->avg_z1 / TSF_SAMPLES; -+ z2 = tsf->avg_z2 / TSF_SAMPLES; -+ } -+ tsf->sample_cnt = 0; -+ tsf->avg_x = 0; -+ tsf->avg_y = 0; -+ tsf->avg_z1 = 0; -+ tsf->avg_z2 = 0; -+ -+ pressure_limit = ts->event_sent? ts->max_pressure: ts->touch_pressure; -+ -+ /* z1 is always at least 100: */ -+ Rt = x * (z2 - z1) / z1; -+ Rt = Rt * ts->x_plate_ohm / 4096; -+ if (Rt > pressure_limit) -+ return 0; -+ -+ /* discard the event if it still is within the previous rect - unless -+ * if the pressure is harder, but then use previous x,y position */ -+ inside_rect = ( -+ x > (int)ts->x - TS_RECT_SIZE && x < (int)ts->x + TS_RECT_SIZE && -+ y > (int)ts->y - TS_RECT_SIZE && y < (int)ts->y + TS_RECT_SIZE); -+ -+ if (!ts->event_sent || !inside_rect) { -+ ts->x = x; -+ ts->y = y; -+ ts->p = Rt; -+ return 1; -+ } else if (Rt < ts->p) { -+ ts->p = Rt; -+ return 1; -+ } -+ return 0; -+} -+ -+/* -+ * This procedure is called by the SPI framework after the coordinates -+ * have been read from TSC2301 -+ */ -+static void tsc2301_ts_rx(void *arg) -+{ -+ struct tsc2301 *tsc = arg; -+ struct tsc2301_ts *ts = tsc->ts; -+ int send_event; -+ int x, y, z1, z2; -+ -+ x = ts->coords->x; -+ y = ts->coords->y; -+ z1 = ts->coords->z1; -+ z2 = ts->coords->z2; -+ -+ send_event = filter(ts, x, y, z1, z2); -+ if (send_event) { -+ update_pen_state(ts, ts->x, ts->y, ts->p); -+ ts->event_sent = 1; -+ } -+ -+ mod_timer(&ts->penup_timer, -+ jiffies + msecs_to_jiffies(TSC2301_TS_PENUP_TIME)); -+} -+ -+/* -+ * Timer is called TSC2301_TS_PENUP_TIME after pen is up -+ */ -+static void tsc2301_ts_timer_handler(unsigned long data) -+{ -+ struct tsc2301 *tsc = (struct tsc2301 *)data; -+ struct tsc2301_ts *ts = tsc->ts; -+ -+ if (ts->event_sent) { -+ ts->event_sent = 0; -+ update_pen_state(ts, 0, 0, 0); -+ } -+} -+ -+/* -+ * This interrupt is called when pen is down and coordinates are -+ * available. That is indicated by a falling edge on DEV line. -+ */ -+static irqreturn_t tsc2301_ts_irq_handler(int irq, void *dev_id) -+{ -+ struct tsc2301 *tsc = dev_id; -+ struct tsc2301_ts *ts = tsc->ts; -+ int r; -+ -+ r = spi_async(tsc->spi, &ts->read_msg); -+ if (r) -+ dev_err(&tsc->spi->dev, "ts: spi_async() failed"); -+ -+ mod_timer(&ts->penup_timer, -+ jiffies + msecs_to_jiffies(TSC2301_TS_PENUP_TIME)); -+ -+ return IRQ_HANDLED; -+} -+ -+static void tsc2301_ts_disable(struct tsc2301 *tsc) -+{ -+ struct tsc2301_ts *ts = tsc->ts; -+ -+ if (ts->disable_depth++ != 0) -+ return; -+ -+ disable_irq(ts->irq); -+ -+ /* wait until penup timer expire normally */ -+ do { -+ msleep(1); -+ } while (ts->event_sent); -+ -+ tsc2301_ts_stop_scan(tsc); -+} -+ -+static void tsc2301_ts_enable(struct tsc2301 *tsc) -+{ -+ struct tsc2301_ts *ts = tsc->ts; -+ -+ if (--ts->disable_depth != 0) -+ return; -+ -+ enable_irq(ts->irq); -+ -+ tsc2301_ts_start_scan(tsc); -+} -+ -+#ifdef CONFIG_PM -+int tsc2301_ts_suspend(struct tsc2301 *tsc) -+{ -+ struct tsc2301_ts *ts = tsc->ts; -+ -+ mutex_lock(&ts->mutex); -+ tsc2301_ts_disable(tsc); -+ mutex_unlock(&ts->mutex); -+ -+ return 0; -+} -+ -+void tsc2301_ts_resume(struct tsc2301 *tsc) -+{ -+ struct tsc2301_ts *ts = tsc->ts; -+ -+ mutex_lock(&ts->mutex); -+ tsc2301_ts_enable(tsc); -+ mutex_unlock(&ts->mutex); -+} -+#endif -+ -+static void tsc2301_ts_setup_spi_xfer(struct tsc2301 *tsc) -+{ -+ struct tsc2301_ts *ts = tsc->ts; -+ struct spi_message *m = &ts->read_msg; -+ struct spi_transfer *x = &ts->read_xfer[0]; -+ -+ spi_message_init(m); -+ -+ x->tx_buf = &tsc2301_ts_read_data; -+ x->len = 2; -+ spi_message_add_tail(x, m); -+ -+ x++; -+ x->rx_buf = ts->coords; -+ x->len = 8; -+ spi_message_add_tail(x, m); -+ -+ m->complete = tsc2301_ts_rx; -+ m->context = tsc; -+} -+ -+static ssize_t tsc2301_ts_pen_down_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(dev); -+ -+ return sprintf(buf, "%u\n", tsc->ts->pen_down); -+} -+ -+static DEVICE_ATTR(pen_down, S_IRUGO, tsc2301_ts_pen_down_show, NULL); -+ -+static ssize_t tsc2301_ts_disable_show(struct device *dev, -+ struct device_attribute *attr, char *buf) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(dev); -+ struct tsc2301_ts *ts = tsc->ts; -+ -+ return sprintf(buf, "%u\n", ts->disabled); -+} -+ -+static ssize_t tsc2301_ts_disable_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(dev); -+ struct tsc2301_ts *ts = tsc->ts; -+ char *endp; -+ int i; -+ -+ i = simple_strtoul(buf, &endp, 10); -+ i = i ? 1 : 0; -+ mutex_lock(&ts->mutex); -+ if (i == ts->disabled) goto out; -+ ts->disabled = i; -+ -+ if (i) -+ tsc2301_ts_disable(tsc); -+ else -+ tsc2301_ts_enable(tsc); -+out: -+ mutex_unlock(&ts->mutex); -+ return count; -+} -+ -+static DEVICE_ATTR(disable_ts, 0664, tsc2301_ts_disable_show, -+ tsc2301_ts_disable_store); -+ -+int __devinit tsc2301_ts_init(struct tsc2301 *tsc, -+ struct tsc2301_platform_data *pdata) -+{ -+ struct tsc2301_ts *ts; -+ struct input_dev *idev; -+ int r; -+ int x_max, y_max; -+ int x_fudge, y_fudge, p_fudge; -+ -+ if (pdata->dav_int <= 0) { -+ dev_err(&tsc->spi->dev, "need DAV IRQ"); -+ return -EINVAL; -+ } -+ -+ ts = kzalloc(sizeof(*ts), GFP_KERNEL); -+ if (ts == NULL) -+ return -ENOMEM; -+ tsc->ts = ts; -+ -+ ts->coords = kzalloc(sizeof(*ts->coords), GFP_KERNEL); -+ if (ts->coords == NULL) { -+ kfree(ts); -+ return -ENOMEM; -+ } -+ -+ ts->irq = pdata->dav_int; -+ -+ init_timer(&ts->penup_timer); -+ setup_timer(&ts->penup_timer, tsc2301_ts_timer_handler, -+ (unsigned long)tsc); -+ -+ mutex_init(&ts->mutex); -+ -+ ts->x_plate_ohm = pdata->ts_x_plate_ohm ? : 280; -+ ts->hw_avg_max = pdata->ts_hw_avg; -+ ts->max_pressure = pdata->ts_max_pressure ? : MAX_12BIT; -+ ts->touch_pressure = pdata->ts_touch_pressure ? : ts->max_pressure; -+ ts->stab_time = pdata->ts_stab_time; -+ -+ x_max = pdata->ts_x_max ? : 4096; -+ y_max = pdata->ts_y_max ? : 4096; -+ x_fudge = pdata->ts_x_fudge ? : 4; -+ y_fudge = pdata->ts_y_fudge ? : 8; -+ p_fudge = pdata->ts_pressure_fudge ? : 2; -+ -+ if ((r = tsc2301_ts_check_config(ts, &ts->hw_flags))) { -+ dev_err(&tsc->spi->dev, "invalid configuration\n"); -+ goto err2; -+ } -+ -+ idev = input_allocate_device(); -+ if (idev == NULL) { -+ r = -ENOMEM; -+ goto err2; -+ } -+ idev->name = "TSC2301 touchscreen"; -+ snprintf(ts->phys, sizeof(ts->phys), -+ "%s/input-ts", dev_name(&tsc->spi->dev)); -+ idev->phys = ts->phys; -+ idev->dev.parent = &tsc->spi->dev; -+ -+ idev->evbit[0] = BIT(EV_ABS) | BIT(EV_KEY); -+ idev->absbit[0] = BIT(ABS_X) | BIT(ABS_Y) | BIT(ABS_PRESSURE); -+ ts->idev = idev; -+ -+ tsc2301_ts_setup_spi_xfer(tsc); -+ -+ /* These parameters should perhaps be configurable? */ -+ input_set_abs_params(idev, ABS_X, 0, x_max, x_fudge, 0); -+ input_set_abs_params(idev, ABS_Y, 0, y_max, y_fudge, 0); -+ input_set_abs_params(idev, ABS_PRESSURE, 0, ts->max_pressure, -+ p_fudge, 0); -+ -+ tsc2301_ts_start_scan(tsc); -+ -+ r = request_irq(ts->irq, tsc2301_ts_irq_handler, -+ IRQF_TRIGGER_FALLING, -+ "tsc2301-ts", tsc); -+ if (r < 0) { -+ dev_err(&tsc->spi->dev, "unable to get DAV IRQ"); -+ goto err3; -+ } -+ irq_set_irq_wake(ts->irq, 1); -+ -+ if (device_create_file(&tsc->spi->dev, &dev_attr_pen_down) < 0) -+ goto err4; -+ if (device_create_file(&tsc->spi->dev, &dev_attr_disable_ts) < 0) -+ goto err5; -+ -+ r = input_register_device(idev); -+ if (r < 0) { -+ dev_err(&tsc->spi->dev, "can't register touchscreen device\n"); -+ goto err6; -+ } -+ -+ return 0; -+err6: -+ device_remove_file(&tsc->spi->dev, &dev_attr_disable_ts); -+err5: -+ device_remove_file(&tsc->spi->dev, &dev_attr_pen_down); -+err4: -+ free_irq(ts->irq, tsc); -+err3: -+ tsc2301_ts_stop_scan(tsc); -+ input_free_device(idev); -+err2: -+ kfree(ts->coords); -+ kfree(ts); -+ return r; -+} -+ -+void __devexit tsc2301_ts_exit(struct tsc2301 *tsc) -+{ -+ struct tsc2301_ts *ts = tsc->ts; -+ -+ tsc2301_ts_disable(tsc); -+ -+ device_remove_file(&tsc->spi->dev, &dev_attr_disable_ts); -+ device_remove_file(&tsc->spi->dev, &dev_attr_pen_down); -+ -+ free_irq(ts->irq, tsc); -+ input_unregister_device(ts->idev); -+ -+ kfree(ts->coords); -+ kfree(ts); -+} -+MODULE_AUTHOR("Jarkko Oikarinen <jarkko.oikarinen@nokia.com>"); -+MODULE_LICENSE("GPL"); ---- a/drivers/spi/Kconfig -+++ b/drivers/spi/Kconfig -@@ -433,6 +433,28 @@ config SPI_TLE62X0 - sysfs interface, with each line presented as a kind of GPIO - exposing both switch control and diagnostic feedback. - -+config SPI_TSC2301 -+ tristate "TSC2301 driver" -+ depends on SPI_MASTER -+ help -+ Say Y here if you have a TSC2301 chip connected to an SPI -+ bus on your board. -+ -+ The TSC2301 is a highly integrated PDA analog interface circuit. -+ It contains a complete 12-bit A/D resistive touch screen -+ converter (ADC) including drivers, touch pressure measurement -+ capability, keypad controller, and 8-bit D/A converter (DAC) output -+ for LCD contrast control. -+ -+ To compile this driver as a module, choose M here: the -+ module will be called tsc2301. -+ -+config SPI_TSC2301_AUDIO -+ boolean "TSC2301 audio support" -+ depends on SPI_TSC2301 && SND -+ help -+ Say Y here for if you are using the audio features of TSC2301. -+ - # - # Add new SPI protocol masters in alphabetical order above this line - # ---- a/drivers/spi/Makefile -+++ b/drivers/spi/Makefile -@@ -59,4 +59,6 @@ obj-$(CONFIG_SPI_TLE62X0) += spi-tle62x - obj-$(CONFIG_SPI_TOPCLIFF_PCH) += spi-topcliff-pch.o - obj-$(CONFIG_SPI_TXX9) += spi-txx9.o - obj-$(CONFIG_SPI_XILINX) += spi-xilinx.o -- -+obj-$(CONFIG_SPI_TSC2301) += tsc2301.o -+tsc2301-objs := tsc2301-core.o -+tsc2301-$(CONFIG_SPI_TSC2301_AUDIO) += tsc2301-mixer.o ---- /dev/null -+++ b/drivers/spi/tsc2301-core.c -@@ -0,0 +1,297 @@ -+/* -+ * TSC2301 driver -+ * -+ * Copyright (C) 2005, 2006 Nokia Corporation -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ * -+ */ -+ -+#include <linux/module.h> -+#include <linux/device.h> -+#include <linux/delay.h> -+#include <linux/gpio.h> -+#include <linux/spi/spi.h> -+#include <linux/spi/tsc2301.h> -+ -+u16 tsc2301_read_reg(struct tsc2301 *tsc, int reg) -+{ -+ struct spi_transfer t[2]; -+ struct spi_message m; -+ u16 data = 0, cmd; -+ -+ cmd = reg; -+ cmd |= 0x8000; -+ -+ memset(t, 0, sizeof(t)); -+ spi_message_init(&m); -+ m.spi = tsc->spi; -+ -+ t[0].tx_buf = &cmd; -+ t[0].rx_buf = NULL; -+ t[0].len = 2; -+ spi_message_add_tail(&t[0], &m); -+ -+ t[1].tx_buf = NULL; -+ t[1].rx_buf = &data; -+ t[1].len = 2; -+ spi_message_add_tail(&t[1], &m); -+ -+ spi_sync(m.spi, &m); -+ -+ return data; -+} -+ -+void tsc2301_write_reg(struct tsc2301 *tsc, int reg, u16 val) -+{ -+ struct spi_transfer t; -+ struct spi_message m; -+ u16 data[2]; -+ -+ /* Now we prepare the command for transferring */ -+ data[0] = reg; -+ data[1] = val; -+ -+ spi_message_init(&m); -+ m.spi = tsc->spi; -+ -+ memset(&t, 0, sizeof(t)); -+ t.tx_buf = data; -+ t.rx_buf = NULL; -+ t.len = 4; -+ spi_message_add_tail(&t, &m); -+ -+ spi_sync(m.spi, &m); -+} -+ -+void tsc2301_write_kbc(struct tsc2301 *tsc, int val) -+{ -+ u16 w; -+ -+ w = tsc->config2_shadow; -+ w &= ~(0x03 << 14); -+ w |= (val & 0x03) << 14; -+ tsc2301_write_reg(tsc, TSC2301_REG_CONFIG2, w); -+ tsc->config2_shadow = w; -+} -+ -+void tsc2301_write_pll(struct tsc2301 *tsc, -+ int pll_n, int pll_a, int pll_pdc, int pct_e, int pll_o) -+{ -+ u16 w; -+ -+ w = tsc->config2_shadow; -+ w &= ~0x3fff; -+ w |= (pll_n & 0x0f) | ((pll_a & 0x0f) << 4) | ((pll_pdc & 0x0f) << 8); -+ w |= pct_e ? (1 << 12) : 0; -+ w |= pll_o ? (1 << 13) : 0; -+ tsc2301_write_reg(tsc, TSC2301_REG_CONFIG2, w); -+ tsc->config2_shadow = w; -+} -+ -+void tsc2301_read_buf(struct tsc2301 *tsc, int reg, u16 *rx_buf, int len) -+{ -+ struct spi_transfer t[2]; -+ struct spi_message m; -+ u16 cmd, i; -+ -+ cmd = reg; -+ cmd |= 0x8000; -+ -+ spi_message_init(&m); -+ m.spi = tsc->spi; -+ -+ memset(t, 0, sizeof(t)); -+ t[0].tx_buf = &cmd; -+ t[0].rx_buf = NULL; -+ t[0].len = 2; -+ spi_message_add_tail(&t[0], &m); -+ -+ t[1].tx_buf = NULL; -+ t[1].rx_buf = rx_buf; -+ t[1].len = 2 * len; -+ spi_message_add_tail(&t[1], &m); -+ -+ spi_sync(m.spi, &m); -+ -+ for (i = 0; i < len; i++) -+ printk(KERN_DEBUG "rx_buf[%d]: %04x\n", i, rx_buf[i]); -+} -+ -+static int __devinit tsc2301_probe(struct spi_device *spi) -+{ -+ struct tsc2301 *tsc; -+ struct tsc2301_platform_data *pdata = spi->dev.platform_data; -+ int r; -+ u16 w; -+ -+ if (!pdata) { -+ dev_dbg(&spi->dev, "no platform data?\n"); -+ return -ENODEV; -+ } -+ -+ tsc = kzalloc(sizeof(*tsc), GFP_KERNEL); -+ if (tsc == NULL) -+ return -ENOMEM; -+ -+ dev_set_drvdata(&spi->dev, tsc); -+ tsc->spi = spi; -+ -+ tsc->enable_clock = pdata->enable_clock; -+ tsc->disable_clock = pdata->disable_clock; -+ -+ if (pdata->reset_gpio >= 0) { -+ tsc->reset_gpio = pdata->reset_gpio; -+ r = gpio_request(tsc->reset_gpio, "TSC2301 reset"); -+ if (r < 0) -+ goto err1; -+ gpio_direction_output(tsc->reset_gpio, 1); -+ mdelay(1); -+ gpio_set_value(tsc->reset_gpio, 0); -+ } else -+ tsc->reset_gpio = -1; -+ -+ spi->mode = SPI_MODE_1; -+ spi->bits_per_word = 16; -+ /* The max speed might've been defined by the board-specific -+ * struct */ -+ if (!spi->max_speed_hz) -+ spi->max_speed_hz = TSC2301_HZ; -+ spi_setup(spi); -+ -+ /* Soft reset */ -+ tsc2301_write_reg(tsc, TSC2301_REG_RESET, 0xbb00); -+ msleep(1); -+ -+ w = tsc2301_read_reg(tsc, TSC2301_REG_ADC); -+ if (!(w & (1 << 14))) { -+ dev_err(&spi->dev, "invalid ADC reg value: %04x\n", w); -+ r = -ENODEV; -+ goto err1; -+ } -+ -+ w = tsc2301_read_reg(tsc, TSC2301_REG_DAC); -+ if (!(w & (1 << 15))) { -+ dev_err(&spi->dev, "invalid DAC reg value: %04x\n", w); -+ r = -ENODEV; -+ goto err1; -+ } -+ -+ /* Stop keypad scanning */ -+ tsc2301_write_reg(tsc, TSC2301_REG_KEY, 0x4000); -+ -+ /* We have to cache this for read-modify-write, since we can't -+ * read back BIT15 */ -+ w = tsc2301_read_reg(tsc, TSC2301_REG_CONFIG2); -+ /* By default BIT15 is set */ -+ w |= 1 << 15; -+ tsc->config2_shadow = w; -+ -+ r = tsc2301_kp_init(tsc, pdata); -+ if (r) -+ goto err1; -+ r = tsc2301_ts_init(tsc, pdata); -+ if (r) -+ goto err2; -+ r = tsc2301_mixer_init(tsc, pdata); -+ if (r) -+ goto err3; -+ return 0; -+ -+err3: -+ tsc2301_ts_exit(tsc); -+err2: -+ tsc2301_kp_exit(tsc); -+err1: -+ kfree(tsc); -+ return r; -+} -+ -+static int __devexit tsc2301_remove(struct spi_device *spi) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(&spi->dev); -+ -+ tsc2301_mixer_exit(tsc); -+ tsc2301_ts_exit(tsc); -+ tsc2301_kp_exit(tsc); -+ if (tsc->reset_gpio >= 0) -+ gpio_free(tsc->reset_gpio); -+ kfree(tsc); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM -+static int tsc2301_suspend(struct spi_device *spi, pm_message_t mesg) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(&spi->dev); -+ int r; -+ -+ if ((r = tsc2301_mixer_suspend(tsc)) < 0) -+ return r; -+ if ((r = tsc2301_kp_suspend(tsc)) < 0) -+ goto err1; -+ if ((r = tsc2301_ts_suspend(tsc)) < 0) -+ goto err2; -+ -+ return 0; -+err2: -+ tsc2301_kp_resume(tsc); -+err1: -+ tsc2301_mixer_resume(tsc); -+ return r; -+} -+ -+static int tsc2301_resume(struct spi_device *spi) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(&spi->dev); -+ -+ tsc2301_ts_resume(tsc); -+ tsc2301_kp_resume(tsc); -+ tsc2301_mixer_resume(tsc); -+ return 0; -+} -+#endif -+ -+static struct spi_driver tsc2301_driver = { -+ .driver = { -+ .name = "tsc2301", -+ .bus = &spi_bus_type, -+ .owner = THIS_MODULE, -+ }, -+#ifdef CONFIG_PM -+ .suspend = tsc2301_suspend, -+ .resume = tsc2301_resume, -+#endif -+ .probe = tsc2301_probe, -+ .remove = __devexit_p(tsc2301_remove), -+}; -+ -+static int __init tsc2301_init(void) -+{ -+ printk("TSC2301 driver initializing\n"); -+ -+ return spi_register_driver(&tsc2301_driver); -+} -+module_init(tsc2301_init); -+ -+static void __exit tsc2301_exit(void) -+{ -+ spi_unregister_driver(&tsc2301_driver); -+} -+module_exit(tsc2301_exit); -+ -+MODULE_AUTHOR("Juha Yrjölä <juha.yrjola@nokia.com>"); -+MODULE_LICENSE("GPL"); ---- /dev/null -+++ b/drivers/spi/tsc2301-mixer.c -@@ -0,0 +1,1003 @@ -+/* -+ * ALSA Mixer implementation for TSC2301 -+ * -+ * Copyright (C) 2006 Nokia Corporation. -+ * -+ * Contact: Jarkko Nikula <jarkko.nikula@nokia.com> -+ * Juha Yrjola -+ * -+ * Some notes about TSC2301: -+ * - PLL will stop when DAC and ADC's are powered down. -+ * - Touchscreen will stop working when audio part is powered up and if audio -+ * MCLK is stopped. Problem is avoided if audio is powered down before -+ * stopping MCLK. -+ * - Audio DAC or audio outputs will activate only after 100 msec from the -+ * chip power-up. Reason seems to be VCM since there is no this delay if the -+ * chip and VCM (bit AVPD on PD/MISC) were not powered down. The chip will -+ * consume about 1 mA if all other audio blocks are powered down except the -+ * chip itself and VCM. Full power down consumes only about few uA. -+ * - Power-down transition could happen earliest about 100 msec after the chip -+ * power-up. Otherwise power-down will fail if there is no that 100 msec -+ * on time before it. It's not obvious why is that since chip reports -+ * power-up to be completed and also PLL output on GPIO_0 is active in few -+ * milliseconds. -+ * -+ * 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. -+ * -+ * This program is distributed in the hope that it will be useful, but -+ * WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA -+ * 02110-1301 USA -+ * -+ */ -+ -+#include <linux/module.h> -+#include <linux/device.h> -+#include <linux/errno.h> -+#include <linux/delay.h> -+#include <linux/slab.h> -+#include <linux/spi/spi.h> -+#include <linux/spi/tsc2301.h> -+ -+#include <sound/core.h> -+#include <sound/control.h> -+ -+/* shadow register indexes */ -+enum { -+ /* audio control and volume registers */ -+ AUDCNTL_INDEX, -+ ADCVOL_INDEX, -+ DACVOL_INDEX, -+ BPVOL_INDEX, -+ /* keyclick control register (not needed here) */ -+ /* audio power control register */ -+ PD_MISC_INDEX, -+ /* TSC2301 GPIO control register */ -+ GPIO_INDEX, -+ -+ SHADOW_REG_COUNT, -+}; -+ -+/* structure for driver private data */ -+struct tsc2301_mixer { -+ struct tsc2301 *tsc; -+ struct mutex mutex; -+ -+ /* shadow registers holding TSC2301 audio registers. Used to hold -+ * their states during the sleep and also to reduce communication with -+ * the chip since get callback functions could get register values -+ * directly from these shadow registers without needing to read them -+ * from the chip */ -+ u16 shadow_regs[SHADOW_REG_COUNT]; -+ -+ /* audio controller driver usage of the ADC and DAC */ -+ unsigned adc_enabled:1, dac_enabled:1; -+ unsigned pll_output:1; -+ unsigned mclk_enabled; -+ -+ /* latest audio power-up timestamp */ -+ unsigned long pu_jiffies; -+ -+ /* these are used when upper layer(s) are going to power-down TSC2301 -+ * before 100 msec is passed from power-up */ -+ struct delayed_work delayed_power_down; -+ unsigned delayed_pd_active:1; -+ -+ int (* platform_init)(struct device *); -+ void (* platform_cleanup)(struct device *); -+ -+ struct tsc2301_mixer_gpio *mixer_gpios; -+ int n_mixer_gpios; -+}; -+ -+#define TSC2301_DAC_DELAY msecs_to_jiffies(100) -+#define TSC2301_MIN_PU_PERIOD msecs_to_jiffies(100) -+ -+#define TSC2301_REG_TO_PVAL(reg) \ -+ (TSC2301_REG_TO_PAGE(reg) << 6 | TSC2301_REG_TO_ADDR(reg)) -+#define TSC2301_PVAL_TO_REG(v) \ -+ (TSC2301_REG((((v) >> 6) & 3),((v) & 0x1f))) -+ -+#define TSC2301_VOLUME_MASK 0x7f -+#define TSC2301_MIN_ADCVOL 6 -+#define TSC2301_MIN_DACVOL 0 -+#define TSC2301_MIN_BPVOL 31 -+#define TSC2301_MUTE_LEFT_SHIFT 15 -+#define TSC2301_VOL_LEFT_SHIFT 8 -+#define TSC2301_MUTE_RIGHT_SHIFT 7 -+#define TSC2301_VOL_RIGHT_SHIFT 0 -+ -+#define TSC2301_INM_MASK 3 -+#define TSC2301_INML_SHIFT 12 -+#define TSC2301_INMR_SHIFT 10 -+ -+#define TSC2301_MICG_MASK 3 -+#define TSC2301_MICG_MIN 1 /* values 0 & 1 both mean 0 dB */ -+#define TSC2301_MICG_SHIFT 8 -+ -+#define TSC2301_REG_AUDCNTL_MCLK(v) (((v) & 3) << 6) -+#define TSC2301_REG_AUDCNTL_I2SFS(v) (((v) & 0xf) << 2) -+#define TSC2301_REG_AUDCNTL_I2SFM(v) (((v) & 3) << 0) -+ -+#define TSC2301_SINGLE(xname, xindex, reg, shadow_index, shift, mask, min) \ -+{\ -+ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, \ -+ .name = xname, \ -+ .index = xindex, \ -+ .info = snd_tsc2301_info_single, \ -+ .get = snd_tsc2301_get_single, \ -+ .put = snd_tsc2301_put_single, \ -+ .private_value = TSC2301_REG_TO_PVAL(reg) | \ -+ (shadow_index << 8) | (shift << 16) | (mask << 24) | \ -+ (min << 28) \ -+} -+#define TSC2301_SINGLE_MINVAL(v) (((v) >> 28) & 15) -+#define TSC2301_SINGLE_SHIFT(v) (((v) >> 16) & 15) -+#define TSC2301_SINGLE_MASK(v) (((v) >> 24) & 15) -+ -+#define TSC2301_DOUBLE(xname, xindex, reg, shadow_index, ls, rs, mask, min) \ -+{\ -+ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, \ -+ .name = xname, \ -+ .index = xindex, \ -+ .info = snd_tsc2301_info_double, \ -+ .get = snd_tsc2301_get_double, \ -+ .put = snd_tsc2301_put_double, \ -+ .private_value = TSC2301_REG_TO_PVAL(reg) | \ -+ (shadow_index << 8) | (min << 11) | \ -+ (ls << 16) | (rs << 20) | (mask << 24) \ -+} -+#define TSC2301_DOUBLE_MINVAL(v) (((v) >> 11) & 0x1f) -+#define TSC2301_DOUBLE_LEFT_SHIFT(v) (((v) >> 16) & 15) -+#define TSC2301_DOUBLE_RIGHT_SHIFT(v) (((v) >> 20) & 15) -+#define TSC2301_DOUBLE_MASK(v) (((v) >> 24) & TSC2301_VOLUME_MASK) -+ -+#define TSC2301_MUX(xname, xindex, reg, shadow_index, ls, rs, mask) \ -+{\ -+ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, \ -+ .name = xname, \ -+ .index = xindex, \ -+ .info = snd_tsc2301_info_mux, \ -+ .get = snd_tsc2301_get_mux, \ -+ .put = snd_tsc2301_put_mux, \ -+ .private_value = TSC2301_REG_TO_PVAL(reg) | \ -+ (shadow_index << 8) | (ls << 16) | (rs << 20) | (mask << 24) \ -+} -+#define TSC2301_MUX_LEFT_SHIFT(v) (((v) >> 16) & 15) -+#define TSC2301_MUX_RIGHT_SHIFT(v) (((v) >> 20) & 15) -+#define TSC2301_MUX_MASK(v) (((v) >> 24) & TSC2301_VOLUME_MASK) -+ -+#define TSC2301_BOOL(xname, xindex, reg, shadow_index, shift, invert, state) \ -+{ \ -+ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, \ -+ .name = xname, \ -+ .index = xindex, \ -+ .info = snd_tsc2301_info_bool, \ -+ .get = snd_tsc2301_get_bool, \ -+ .put = snd_tsc2301_put_bool, \ -+ .private_value = TSC2301_REG_TO_PVAL(reg) | \ -+ (shadow_index << 8) | (shift << 16) | \ -+ (invert << 24) | (state << 25) \ -+} -+#define TSC2301_BOOL_SHIFT(v) (((v) >> 16) & 7) -+#define TSC2301_BOOL_INVERT(v) (((v) >> 24) & 1) -+#define TSC2301_BOOL_STATE(v) (((v) >> 25) & 1) -+ -+#define TSC2301_SHADOW_INDEX(v) (((v) >> 8) & 7) -+ -+/* -+ * Power-down handler for additional GPIO mixer controls. GPIO state of GPIO -+ * controls whose power-down flag is enabled are set to their false/deactivate -+ * state -+ * -+ * Must be called tsc->mixer->mutex locked -+ */ -+static void tsc2301_gpio_power_down(struct tsc2301 *tsc) -+{ -+ struct tsc2301_mixer *mix = tsc->mixer; -+ u16 temp; -+ int i; -+ -+ temp = mix->shadow_regs[GPIO_INDEX]; -+ for (i = 0; i < mix->n_mixer_gpios; i++) { -+ const struct tsc2301_mixer_gpio *mg; -+ -+ mg = mix->mixer_gpios + i; -+ if (mg->deactivate_on_pd) { -+ int gpio = mg->gpio; -+ -+ temp &= ~(1 << gpio); -+ temp |= mg->inverted << gpio; -+ } -+ } -+ tsc2301_write_reg(tsc, TSC2301_REG_GPIO, temp); -+} -+ -+/* -+ * Powers down/up audio blocks which are muted or become unused. -+ * shadow_index >= 0, changes power state of single audio block -+ * shadow_index < 0, changes power state of all blocks -+ * -+ * Must be called tsc->mixer->mutex locked -+ */ -+#define TSC2301_MUTE_MASK \ -+ ((1 << TSC2301_MUTE_LEFT_SHIFT) | (1 << TSC2301_MUTE_RIGHT_SHIFT)) -+static void tsc2301_power_ctrl(struct tsc2301 *tsc, int shadow_index, -+ int poll_pdsts) -+{ -+ struct tsc2301_mixer *mix = tsc->mixer; -+ u16 pd_ctrl, pd_ctrl_old, w; -+ unsigned long timeout; -+ int power_up = 0; -+ -+ if (mix->delayed_pd_active) { -+ mix->delayed_pd_active = 0; -+ mix->mclk_enabled--; -+ cancel_delayed_work(&mix->delayed_power_down); -+ } -+ -+ pd_ctrl = pd_ctrl_old = mix->shadow_regs[PD_MISC_INDEX]; -+ /* power control helper based on used space mixer selections. See -+ * actual power control decisions below */ -+ if (shadow_index < 0 || shadow_index == ADCVOL_INDEX) { -+ /* ADC left and right power down control */ -+ if (mix->shadow_regs[ADCVOL_INDEX] & -+ (1 << TSC2301_MUTE_LEFT_SHIFT)) -+ /* left ADC muted. Power down the left ADC */ -+ pd_ctrl |= TSC2301_REG_PD_MISC_ADPDL; -+ else -+ pd_ctrl &= ~TSC2301_REG_PD_MISC_ADPDL; -+ if (mix->shadow_regs[ADCVOL_INDEX] & -+ (1 << TSC2301_MUTE_LEFT_SHIFT)) -+ /* right ADC muted. Power down the right ADC */ -+ pd_ctrl |= TSC2301_REG_PD_MISC_ADPDR; -+ else -+ pd_ctrl &= ~TSC2301_REG_PD_MISC_ADPDR; -+ } -+ if (shadow_index < 0 || shadow_index == DACVOL_INDEX) { -+ /* DAC power down control */ -+ if ((mix->shadow_regs[DACVOL_INDEX] & -+ TSC2301_MUTE_MASK) == TSC2301_MUTE_MASK) -+ /* both DACs muted. Power down the DAC */ -+ pd_ctrl |= TSC2301_REG_PD_MISC_DAPD; -+ else -+ pd_ctrl &= ~TSC2301_REG_PD_MISC_DAPD; -+ } -+ if (shadow_index < 0 || shadow_index == BPVOL_INDEX) { -+ /* line bypass power down control */ -+ if ((mix->shadow_regs[BPVOL_INDEX] & -+ TSC2301_MUTE_MASK) == TSC2301_MUTE_MASK) -+ /* both line bypasses muted. Power down the bypass -+ * path */ -+ pd_ctrl |= TSC2301_REG_PD_MISC_ABPD; -+ else -+ pd_ctrl &= ~TSC2301_REG_PD_MISC_ABPD; -+ } -+ if (shadow_index < 0 || shadow_index == AUDCNTL_INDEX) { -+ /* mic bias power down control */ -+ if ((mix->shadow_regs[AUDCNTL_INDEX] & -+ (3 << TSC2301_INML_SHIFT)) && -+ (mix->shadow_regs[AUDCNTL_INDEX] & -+ (3 << TSC2301_INMR_SHIFT))) -+ /* both ADC channels use other than mic input. Power -+ * down the mic bias output */ -+ pd_ctrl |= TSC2301_REG_PD_MISC_MIBPD; -+ else -+ pd_ctrl &= ~TSC2301_REG_PD_MISC_MIBPD; -+ } -+ -+ /* power control decisions based on codec usage and user space mixer -+ * selections detected above */ -+ pd_ctrl &= ~TSC2301_REG_PD_MISC_APD; /* audio not powered down */ -+ if (mix->mclk_enabled) { -+ if (!mix->adc_enabled) { -+ /* ADC not used, power down both ADC's and mic bias -+ * output independently of user space mixer -+ * selections */ -+ pd_ctrl |= TSC2301_REG_PD_MISC_ADPDL; -+ pd_ctrl |= TSC2301_REG_PD_MISC_ADPDR; -+ pd_ctrl |= TSC2301_REG_PD_MISC_MIBPD; -+ } -+ if (!mix->dac_enabled) { -+ /* DAC not used, power down DAC independently of user -+ * space mixer selections */ -+ pd_ctrl |= TSC2301_REG_PD_MISC_DAPD; -+ } -+ -+ if (mix->pll_output) { -+ /* GPIO_0 is configured as PLL output so audio -+ * controller is expecting clock from TSC2301. Either -+ * ADC or DAC must be active in order to keep PLL on */ -+ if ((pd_ctrl & TSC2301_REG_PD_MISC_ADPDL) && -+ (pd_ctrl & TSC2301_REG_PD_MISC_ADPDR) && -+ (pd_ctrl & TSC2301_REG_PD_MISC_DAPD)) { -+ /* neither ADC or DAC used. Force ADC on in -+ * order to keep PLL active */ -+ pd_ctrl &= ~(TSC2301_REG_PD_MISC_ADPDL | -+ TSC2301_REG_PD_MISC_ADPDR); -+ } -+ } -+ } else { -+ /* audio input clock is not enabled so power down DAC and ADC -+ * in order to shutdown PLL and to keep touchscreen and keypad -+ * parts working. Touchscreen and keypad use audio clock when -+ * PLL is on and internal clock otherwise */ -+ pd_ctrl |= TSC2301_REG_PD_MISC_DAPD | -+ TSC2301_REG_PD_MISC_ADPDL | -+ TSC2301_REG_PD_MISC_ADPDR; -+ } -+ -+ if ((pd_ctrl & TSC2301_REG_PD_MISC_ADPDL) && -+ (pd_ctrl & TSC2301_REG_PD_MISC_ADPDR) && -+ (pd_ctrl & TSC2301_REG_PD_MISC_DAPD) && -+ (pd_ctrl & TSC2301_REG_PD_MISC_ABPD)) { -+ /* all ADC, DAC and line bypass path unused. Power down the -+ * whole audio part of the TSC2301 */ -+ pd_ctrl |= TSC2301_REG_PD_MISC_APD; -+ } -+ -+ if (pd_ctrl == pd_ctrl_old) -+ return; -+ -+ /* power down control changed. Update into TSC2301 */ -+ if ((pd_ctrl ^ pd_ctrl_old) & TSC2301_REG_PD_MISC_APD) { -+ /* whole audio power state changed. Update GPIO states */ -+ if (pd_ctrl & TSC2301_REG_PD_MISC_APD) { -+ /* power down GPIO controls before powering down -+ * the codec */ -+ tsc2301_gpio_power_down(tsc); -+ /* we must really ensure that codec has been on no less -+ * than 100 msec before doing power-down */ -+ timeout = mix->pu_jiffies + TSC2301_MIN_PU_PERIOD - -+ jiffies; -+ if (timeout <= TSC2301_MIN_PU_PERIOD) { -+ mix->delayed_pd_active = 1; -+ mix->mclk_enabled++; -+ schedule_delayed_work(&mix->delayed_power_down, -+ timeout + 1); -+ return; -+ } -+ } else -+ /* restore GPIOs after codec is powered up */ -+ power_up = 1; -+ } -+ mix->shadow_regs[PD_MISC_INDEX] = pd_ctrl; -+ tsc2301_write_reg(tsc, TSC2301_REG_PD_MISC, pd_ctrl); -+ if (power_up) -+ mix->pu_jiffies = jiffies; -+ if (!poll_pdsts) { -+ if (power_up) -+ tsc2301_write_reg(tsc, TSC2301_REG_GPIO, -+ mix->shadow_regs[GPIO_INDEX]); -+ return; -+ } -+ -+ /* wait until power-up/-down is completed */ -+ timeout = jiffies + msecs_to_jiffies(100); -+ w = 0; -+ do { -+ if (time_after(jiffies, timeout)) { -+ /* Print a warning only if the I2S clock is not -+ * present / out of sync. This can happen during -+ * init time, when that clock will be turned on -+ * by another driver like in the OMAP EAC with -+ * external clock case. -+ */ -+ if (w & TSC2301_REG_PD_MISC_OTSYN) { -+ dev_warn(&tsc->spi->dev, -+ "I2S clock not in sync or off.\n"); -+ } else { -+ dev_err(&tsc->spi->dev, -+ "power-up/-down timed out " -+ "(0x%04x, 0x%04x -> 0x%04x)\n", -+ w, pd_ctrl_old, pd_ctrl); -+ } -+ goto out; -+ } -+ w = tsc2301_read_reg(tsc, TSC2301_REG_PD_MISC); -+ } while (!(w & TSC2301_REG_PD_MISC_PDSTS)); -+ -+out: -+ if (((pd_ctrl ^ pd_ctrl_old) & TSC2301_REG_PD_MISC_DAPD) && -+ !(pd_ctrl & TSC2301_REG_PD_MISC_DAPD)) { -+ /* DAC powered up now. Ensure that DAC and audio outputs are -+ * activated. They are up 100 msec after the chip power-up -+ * command */ -+ timeout = mix->pu_jiffies + TSC2301_DAC_DELAY - jiffies; -+ if (timeout <= TSC2301_DAC_DELAY) -+ schedule_timeout_interruptible(timeout); -+ /* FIXME: This is lazy. We restore GPIOs only after activating -+ * the DAC. It would be better to do some kind of delayed GPIO -+ * restore. That ensures that we restore them also if only ADC -+ * path is activated. But this is required only if there is -+ * some input amplifier, bias control, etc. and their power -+ * state is under TSC GPIO control */ -+ tsc2301_write_reg(tsc, TSC2301_REG_GPIO, -+ mix->shadow_regs[GPIO_INDEX]); -+ } -+} -+ -+static int snd_tsc2301_info_single(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_info *uinfo) -+{ -+ int mask = TSC2301_SINGLE_MASK(kcontrol->private_value); -+ int minval = TSC2301_SINGLE_MINVAL(kcontrol->private_value); -+ -+ uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; -+ uinfo->count = 1; -+ uinfo->value.integer.min = minval; -+ uinfo->value.integer.max = mask; -+ -+ return 0; -+} -+ -+static int snd_tsc2301_get_single(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct tsc2301 *tsc = kcontrol->private_data; -+ unsigned long priv = kcontrol->private_value; -+ int mask = TSC2301_SINGLE_MASK(priv); -+ int shift = TSC2301_SINGLE_SHIFT(priv); -+ int shadow_index = TSC2301_SHADOW_INDEX(priv); -+ u16 shadow_reg; -+ -+ shadow_reg = tsc->mixer->shadow_regs[shadow_index]; -+ -+ ucontrol->value.integer.value[0] = (shadow_reg >> shift) & mask; -+ -+ return 0; -+} -+ -+static int snd_tsc2301_put_single(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct tsc2301 *tsc = kcontrol->private_data; -+ unsigned long priv = kcontrol->private_value; -+ int mask = TSC2301_SINGLE_MASK(priv); -+ int shadow_index = TSC2301_SHADOW_INDEX(priv); -+ u16 shadow_reg, shadow_reg_old; -+ int shift = TSC2301_SINGLE_SHIFT(priv); -+ int reg = TSC2301_PVAL_TO_REG(priv); -+ int changed; -+ -+ mutex_lock(&tsc->mixer->mutex); -+ shadow_reg = shadow_reg_old = tsc->mixer->shadow_regs[shadow_index]; -+ -+ /* zero bits to be modified */ -+ shadow_reg &= ~(mask << shift); -+ /* modify with new value */ -+ shadow_reg |= ((ucontrol->value.integer.value[0] & mask) << shift); -+ -+ changed = (shadow_reg != shadow_reg_old); -+ tsc->mixer->shadow_regs[shadow_index] = shadow_reg; -+ -+ /* update into TSC2301 if necessary */ -+ if (changed) -+ tsc2301_write_reg(tsc, reg, shadow_reg); -+ mutex_unlock(&tsc->mixer->mutex); -+ -+ return changed; -+} -+ -+static int snd_tsc2301_info_double(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_info *uinfo) -+{ -+ /* mask == 1 : Switch -+ * mask > 1 : Max volume */ -+ int mask = TSC2301_DOUBLE_MASK(kcontrol->private_value); -+ int minval = TSC2301_DOUBLE_MINVAL(kcontrol->private_value); -+ -+ uinfo->type = mask == 1 ? SNDRV_CTL_ELEM_TYPE_BOOLEAN : -+ SNDRV_CTL_ELEM_TYPE_INTEGER; -+ uinfo->count = 2; -+ uinfo->value.integer.min = minval; -+ uinfo->value.integer.max = mask; -+ -+ return 0; -+} -+ -+static int snd_tsc2301_get_double(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct tsc2301 *tsc = kcontrol->private_data; -+ unsigned long priv = kcontrol->private_value; -+ /* mask == 1 : Switch -+ * mask > 1 : Volume */ -+ int mask = TSC2301_DOUBLE_MASK(priv); -+ int ls = TSC2301_DOUBLE_LEFT_SHIFT(priv); -+ int rs = TSC2301_DOUBLE_RIGHT_SHIFT(priv); -+ int shadow_index = TSC2301_SHADOW_INDEX(priv); -+ u16 shadow_reg; -+ -+ shadow_reg = tsc->mixer->shadow_regs[shadow_index]; -+ -+ /* invert mute bits for the switches */ -+ if (mask == 1) -+ shadow_reg = ~shadow_reg; -+ -+ ucontrol->value.integer.value[0] = (shadow_reg >> ls) & mask; -+ ucontrol->value.integer.value[1] = (shadow_reg >> rs) & mask; -+ -+ return 0; -+} -+ -+static int snd_tsc2301_put_double(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct tsc2301 *tsc = kcontrol->private_data; -+ unsigned long priv = kcontrol->private_value; -+ /* mask == 1 : Switch -+ * mask > 1 : Volume */ -+ int mask = TSC2301_DOUBLE_MASK(priv); -+ int shadow_index = TSC2301_SHADOW_INDEX(priv); -+ u16 shadow_reg, shadow_reg_old; -+ int ls = TSC2301_DOUBLE_LEFT_SHIFT(priv); -+ int rs = TSC2301_DOUBLE_RIGHT_SHIFT(priv); -+ int reg = TSC2301_PVAL_TO_REG(priv); -+ int changed; -+ -+ mutex_lock(&tsc->mixer->mutex); -+ shadow_reg = shadow_reg_old = tsc->mixer->shadow_regs[shadow_index]; -+ -+ /* zero bits to be modified */ -+ shadow_reg &= ~((mask << ls) | (mask << rs)); -+ /* modify with new value */ -+ if (mask == 1) { -+ /* switch. Invert switch values for the mute bits */ -+ shadow_reg |= -+ ((~ucontrol->value.integer.value[0] & mask) << ls) | -+ ((~ucontrol->value.integer.value[1] & mask) << rs); -+ } else { -+ /* volume */ -+ shadow_reg |= -+ (ucontrol->value.integer.value[0] << ls) | -+ (ucontrol->value.integer.value[1] << rs); -+ } -+ -+ changed = (shadow_reg != shadow_reg_old); -+ tsc->mixer->shadow_regs[shadow_index] = shadow_reg; -+ -+ /* update into TSC2301 if necessary */ -+ if (changed) -+ tsc2301_write_reg(tsc, reg, shadow_reg); -+ -+ if (mask == 1) -+ /* check is need to power down/up audio blocks in case of -+ * muted state change */ -+ tsc2301_power_ctrl(tsc, shadow_index, 0); -+ mutex_unlock(&tsc->mixer->mutex); -+ -+ return changed; -+} -+ -+static int snd_tsc2301_info_mux(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_info *uinfo) -+{ -+ static char *texts[4] = {"Mic", "Line", "Line swapped", "Line mono"}; -+ -+ uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; -+ uinfo->count = 2; -+ uinfo->value.enumerated.items = 4; -+ if (uinfo->value.enumerated.item > 3) -+ uinfo->value.enumerated.item = 3; -+ strcpy(uinfo->value.enumerated.name, -+ texts[uinfo->value.enumerated.item]); -+ -+ return 0; -+} -+ -+static int snd_tsc2301_get_mux(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct tsc2301 *tsc = kcontrol->private_data; -+ unsigned long priv = kcontrol->private_value; -+ int mask = TSC2301_MUX_MASK(priv); -+ int ls = TSC2301_MUX_LEFT_SHIFT(priv); -+ int rs = TSC2301_MUX_RIGHT_SHIFT(priv); -+ int shadow_index = TSC2301_SHADOW_INDEX(priv); -+ u16 shadow_reg; -+ -+ shadow_reg = tsc->mixer->shadow_regs[shadow_index]; -+ ucontrol->value.enumerated.item[0] = (shadow_reg >> ls) & mask; -+ ucontrol->value.enumerated.item[1] = (shadow_reg >> rs) & mask; -+ -+ return 0; -+} -+ -+static int snd_tsc2301_put_mux(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct tsc2301 *tsc = kcontrol->private_data; -+ unsigned long priv = kcontrol->private_value; -+ int mask = TSC2301_MUX_MASK(priv); -+ int shadow_index = TSC2301_SHADOW_INDEX(priv); -+ u16 shadow_reg, shadow_reg_old; -+ int ls = TSC2301_MUX_LEFT_SHIFT(priv); -+ int rs = TSC2301_MUX_RIGHT_SHIFT(priv); -+ int reg = TSC2301_PVAL_TO_REG(priv); -+ int changed; -+ -+ mutex_lock(&tsc->mixer->mutex); -+ shadow_reg = shadow_reg_old = tsc->mixer->shadow_regs[shadow_index]; -+ -+ /* zero bits to be modified */ -+ shadow_reg &= ~((mask << ls) | (mask << rs)); -+ /* modify with new value */ -+ shadow_reg |= (ucontrol->value.enumerated.item[0] << ls); -+ shadow_reg |= (ucontrol->value.enumerated.item[1] << rs); -+ -+ changed = (shadow_reg != shadow_reg_old); -+ -+ /* update into TSC2301 if necessary */ -+ if (changed) { -+ tsc->mixer->shadow_regs[shadow_index] = shadow_reg; -+ tsc2301_write_reg(tsc, reg, shadow_reg); -+ } -+ -+ /* check is need to power up/down audio blocks in case of ADC input -+ * change */ -+ tsc2301_power_ctrl(tsc, shadow_index, 0); -+ mutex_unlock(&tsc->mixer->mutex); -+ -+ return changed; -+} -+ -+static int snd_tsc2301_info_bool(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_info *uinfo) -+{ -+ uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; -+ uinfo->count = 1; -+ uinfo->value.integer.min = 0; -+ uinfo->value.integer.max = 1; -+ -+ return 0; -+} -+ -+static int snd_tsc2301_get_bool(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct tsc2301 *tsc = kcontrol->private_data; -+ unsigned long priv = kcontrol->private_value; -+ int shadow_index = TSC2301_SHADOW_INDEX(priv); -+ int shift = TSC2301_BOOL_SHIFT(priv); -+ int invert = TSC2301_BOOL_INVERT(priv); -+ u16 shadow_reg; -+ -+ shadow_reg = tsc->mixer->shadow_regs[shadow_index]; -+ ucontrol->value.integer.value[0] = -+ invert ^ ((shadow_reg >> shift) & 1); -+ -+ return 0; -+} -+ -+static int snd_tsc2301_put_bool(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct tsc2301 *tsc = kcontrol->private_data; -+ unsigned long priv = kcontrol->private_value; -+ int shadow_index = TSC2301_SHADOW_INDEX(priv); -+ int shift = TSC2301_BOOL_SHIFT(priv); -+ int invert = TSC2301_BOOL_INVERT(priv); -+ int reg = TSC2301_PVAL_TO_REG(priv); -+ u16 shadow_reg, shadow_reg_old; -+ int changed; -+ -+ mutex_lock(&tsc->mixer->mutex); -+ shadow_reg = shadow_reg_old = tsc->mixer->shadow_regs[shadow_index]; -+ -+ /* zero bit to be modified */ -+ shadow_reg &= ~(1 << shift); -+ /* modify with new value */ -+ shadow_reg |= -+ (invert ^ (ucontrol->value.integer.value[0] & 1)) << shift; -+ -+ changed = (shadow_reg != shadow_reg_old); -+ -+ /* update into TSC2301 if necessary */ -+ if (changed) { -+ tsc->mixer->shadow_regs[shadow_index] = shadow_reg; -+ if ((shadow_index == GPIO_INDEX) && -+ (tsc->mixer->shadow_regs[PD_MISC_INDEX] & -+ TSC2301_REG_PD_MISC_APD)) { -+ /* changing GPIO control and audio is powered down. -+ * Update GPIO states according to their power-down -+ * flag */ -+ tsc2301_gpio_power_down(tsc); -+ } else -+ tsc2301_write_reg(tsc, reg, shadow_reg); -+ } -+ mutex_unlock(&tsc->mixer->mutex); -+ -+ return changed; -+} -+ -+/* TSC2301 internal mixer controls */ -+static struct snd_kcontrol_new snd_tsc2301_controls[] = { -+ /* stereo ADC input switches and volumes */ -+ TSC2301_DOUBLE("Capture Switch", 0, -+ TSC2301_REG_ADCVOL, ADCVOL_INDEX, -+ TSC2301_MUTE_LEFT_SHIFT, TSC2301_MUTE_RIGHT_SHIFT, -+ 1, 0), -+ TSC2301_DOUBLE("Capture Volume", 0, -+ TSC2301_REG_ADCVOL, ADCVOL_INDEX, -+ TSC2301_VOL_LEFT_SHIFT, TSC2301_VOL_RIGHT_SHIFT, -+ TSC2301_VOLUME_MASK, TSC2301_MIN_ADCVOL), -+ -+ /* stereo DAC output switches and volumes */ -+ TSC2301_DOUBLE("PCM Playback Switch", 0, -+ TSC2301_REG_DACVOL, DACVOL_INDEX, -+ TSC2301_MUTE_LEFT_SHIFT, TSC2301_MUTE_RIGHT_SHIFT, -+ 1, 0), -+ TSC2301_DOUBLE("PCM Playback Volume", 0, -+ TSC2301_REG_DACVOL, DACVOL_INDEX, -+ TSC2301_VOL_LEFT_SHIFT, TSC2301_VOL_RIGHT_SHIFT, -+ TSC2301_VOLUME_MASK, TSC2301_MIN_DACVOL), -+ -+ /* stereo line input bypass switches and volumes */ -+ TSC2301_DOUBLE("Line Playback Switch", 0, -+ TSC2301_REG_BPVOL, BPVOL_INDEX, -+ TSC2301_MUTE_LEFT_SHIFT, TSC2301_MUTE_RIGHT_SHIFT, -+ 1, 0), -+ TSC2301_DOUBLE("Line Playback Volume", 0, -+ TSC2301_REG_BPVOL, BPVOL_INDEX, -+ TSC2301_VOL_LEFT_SHIFT, TSC2301_VOL_RIGHT_SHIFT, -+ TSC2301_VOLUME_MASK, TSC2301_MIN_BPVOL), -+ -+ /* mono microphone input gain */ -+ TSC2301_SINGLE("Mic Boost", 0, -+ TSC2301_REG_AUDCNTL, AUDCNTL_INDEX, -+ TSC2301_MICG_SHIFT, -+ TSC2301_MICG_MASK, TSC2301_MICG_MIN), -+ -+ /* ADC input sources. Both channels could be selected separately */ -+ TSC2301_MUX("Capture Source", 0, -+ TSC2301_REG_AUDCNTL, AUDCNTL_INDEX, -+ TSC2301_INML_SHIFT, TSC2301_INMR_SHIFT, -+ TSC2301_INM_MASK), -+}; -+ -+/* must be called tsc->mixer->mutex locked */ -+static void tsc2301_flush_shadow_regs(struct tsc2301 *tsc) -+{ -+ int i, page, addr; -+ u16 temp; -+ -+ page = TSC2301_REG_TO_PAGE(TSC2301_REG_AUDCNTL); -+ addr = TSC2301_REG_TO_ADDR(TSC2301_REG_AUDCNTL); -+ -+ for (i = 0; i < 4; i++) { -+ temp = tsc->mixer->shadow_regs[i]; -+ tsc2301_write_reg(tsc, TSC2301_REG(page, addr + i), temp); -+ } -+ temp = tsc->mixer->shadow_regs[GPIO_INDEX]; -+ tsc2301_write_reg(tsc, TSC2301_REG_GPIO, temp); -+ -+ /* Update power state of all audio blocks depending are they -+ * muted or unused. */ -+ tsc2301_power_ctrl(tsc, -1, 0); -+} -+ -+#ifdef CONFIG_PM -+int tsc2301_mixer_suspend(struct tsc2301 *tsc) -+{ -+ /* power down entire audio section inside TSC2301 in case the -+ * chip is still powered during the system sleep. However this driver -+ * doesn't require that chip is powered because registers are restored -+ * in function tsc2301_mixer_resume */ -+ mutex_lock(&tsc->mixer->mutex); -+ tsc2301_gpio_power_down(tsc); -+ tsc->mixer->shadow_regs[PD_MISC_INDEX] |= TSC2301_REG_PD_MISC_APD; -+ tsc2301_write_reg(tsc, TSC2301_REG_PD_MISC, -+ tsc->mixer->shadow_regs[PD_MISC_INDEX]); -+ mutex_unlock(&tsc->mixer->mutex); -+ return 0; -+} -+ -+void tsc2301_mixer_resume(struct tsc2301 *tsc) -+{ -+ /* power up the TSC2301 audio section and restore registers */ -+ mutex_lock(&tsc->mixer->mutex); -+ tsc->mixer->shadow_regs[PD_MISC_INDEX] &= ~TSC2301_REG_PD_MISC_APD; -+ tsc2301_flush_shadow_regs(tsc); -+ mutex_unlock(&tsc->mixer->mutex); -+} -+#endif -+ -+void tsc2301_mixer_enable_mclk(struct device *dev) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(dev); -+ struct tsc2301_mixer *mix = tsc->mixer; -+ -+ mutex_lock(&mix->mutex); -+ if (!mix->mclk_enabled++ && tsc->enable_clock != NULL) { -+ tsc->enable_clock(dev); -+ } -+ tsc2301_power_ctrl(tsc, -1, 1); -+ mutex_unlock(&mix->mutex); -+} -+ -+void tsc2301_mixer_disable_mclk(struct device *dev) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(dev); -+ struct tsc2301_mixer *mix = tsc->mixer; -+ -+ mutex_lock(&mix->mutex); -+ mix->mclk_enabled--; -+ tsc2301_power_ctrl(tsc, -1, 1); -+ if (!mix->mclk_enabled && tsc->disable_clock != NULL) { -+ tsc->disable_clock(dev); -+ } -+ mutex_unlock(&mix->mutex); -+} -+ -+static void tsc2301_mixer_delayed_power_down(struct work_struct *work) -+{ -+ struct tsc2301_mixer *mix = container_of(work, struct tsc2301_mixer, -+ delayed_power_down.work); -+ struct tsc2301 *tsc = mix->tsc; -+ -+ mutex_lock(&mix->mutex); -+ if (!mix->delayed_pd_active) { -+ mutex_unlock(&mix->mutex); -+ return; -+ } -+ mix->delayed_pd_active = 0; -+ mutex_unlock(&mix->mutex); -+ tsc2301_mixer_disable_mclk(&tsc->spi->dev); -+} -+ -+/* -+ * Allows audio controller driver to notify its usage of ADC and DAC -+ */ -+void tsc2301_mixer_set_power(struct device *dev, int dac, int adc) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(dev); -+ -+ mutex_lock(&tsc->mixer->mutex); -+ tsc->mixer->adc_enabled = adc; -+ tsc->mixer->dac_enabled = dac; -+ -+ /* update power state of all audio blocks */ -+ tsc2301_power_ctrl(tsc, -1, 1); -+ mutex_unlock(&tsc->mixer->mutex); -+} -+ -+/* -+ * Registers TSC2301 ALSA Mixer controls for the given sound card -+ */ -+int tsc2301_mixer_register_controls(struct device *dev, struct snd_card *card) -+{ -+ struct tsc2301 *tsc = dev_get_drvdata(dev); -+ struct tsc2301_mixer *mix = tsc->mixer; -+ int i, err; -+ -+ /* Register ALSA mixer controls */ -+ for (i = 0; i < ARRAY_SIZE(snd_tsc2301_controls); i++) { -+ err = snd_ctl_add(card, -+ snd_ctl_new1(&snd_tsc2301_controls[i], tsc)); -+ if (err < 0) -+ return err; -+ } -+ -+ if (!mix->n_mixer_gpios) -+ return 0; -+ -+ /* Register additional GPIO controls if defined */ -+ for (i = 0; i < mix->n_mixer_gpios; i++) { -+ const struct tsc2301_mixer_gpio *mg = mix->mixer_gpios + i; -+ struct snd_kcontrol *ctrlp; -+ struct snd_kcontrol_new ctrl = -+ TSC2301_BOOL((char *)mg->name, 0, -+ TSC2301_REG_GPIO, GPIO_INDEX, -+ mg->gpio, mg->inverted, mg->def_enable); -+ -+ ctrlp = snd_ctl_new1(&ctrl, tsc); -+ err = snd_ctl_add(card, ctrlp); -+ if (err < 0) -+ return err; -+ } -+ -+ return 0; -+} -+ -+int tsc2301_mixer_init(struct tsc2301 *tsc, -+ struct tsc2301_platform_data *pdata) -+{ -+ struct tsc2301_mixer *mix; -+ int err = 0; -+ u16 w; -+ -+ mix = kzalloc(sizeof(*mix), GFP_KERNEL); -+ if (mix == NULL) -+ return -ENOMEM; -+ tsc->mixer = mix; -+ -+ mix->tsc = tsc; -+ mutex_init(&mix->mutex); -+ mix->platform_init = pdata->codec_init; -+ mix->platform_cleanup = pdata->codec_cleanup; -+ mix->pll_output = pdata->pll_output; -+ -+ INIT_DELAYED_WORK(&mix->delayed_power_down, -+ tsc2301_mixer_delayed_power_down); -+ -+ /* initialize shadow register default values */ -+ w = 0xc000; -+ w |= (pdata->mclk_ratio << 6) | (pdata->i2s_sample_rate << 2); -+ w |= pdata->i2s_format; -+ mix->shadow_regs[AUDCNTL_INDEX] = w; -+ mix->shadow_regs[ADCVOL_INDEX] = 0xd7d7; -+ mix->shadow_regs[DACVOL_INDEX] = 0xffff; -+ mix->shadow_regs[BPVOL_INDEX] = 0xe7e7; -+ mix->shadow_regs[PD_MISC_INDEX] = pdata->power_down_blocks; -+ -+ /* if extra mixer controls configured, then configure associated -+ * GPIOs as output and drive their default state */ -+ if (pdata->n_mixer_gpios) { -+ int i; -+ -+ w = 0; -+ for (i = 0; i < pdata->n_mixer_gpios; i++) { -+ const struct tsc2301_mixer_gpio *mg; -+ int gpio; -+ -+ mg = pdata->mixer_gpios + i; -+ gpio = mg->gpio; -+ w |= (1 << gpio) << 8; -+ w |= (mg->inverted ^ mg->def_enable) << gpio; -+ } -+ mix->shadow_regs[GPIO_INDEX] = w; -+ -+ mix->mixer_gpios = kmalloc(sizeof(*pdata->mixer_gpios) * -+ pdata->n_mixer_gpios, -+ GFP_KERNEL); -+ if (mix->mixer_gpios == NULL) { -+ err = -ENOMEM; -+ goto err1; -+ } -+ memcpy(mix->mixer_gpios, pdata->mixer_gpios, -+ sizeof(*pdata->mixer_gpios) * pdata->n_mixer_gpios); -+ mix->n_mixer_gpios = pdata->n_mixer_gpios; -+ } -+ -+ /* PLL control */ -+ tsc2301_write_pll(tsc, pdata->pll_n, pdata->pll_a, pdata->pll_pdc, -+ 0, mix->pll_output ? 0 : 1); -+ -+ tsc2301_flush_shadow_regs(tsc); -+ -+ if (mix->platform_init != NULL) { -+ err = mix->platform_init(&tsc->spi->dev); -+ if (err < 0) -+ goto err2; -+ } -+ -+ return 0; -+err2: -+ if (mix->mixer_gpios != NULL) -+ kfree(mix->mixer_gpios); -+err1: -+ kfree(mix); -+ return err; -+} -+ -+void tsc2301_mixer_exit(struct tsc2301 *tsc) -+{ -+ struct tsc2301_mixer *mixer = tsc->mixer; -+ -+ if (mixer->platform_cleanup != NULL) -+ mixer->platform_cleanup(&tsc->spi->dev); -+ -+ if (mixer->mixer_gpios != NULL) -+ kfree(mixer->mixer_gpios); -+} -+ -+MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@nokia.com>"); -+MODULE_LICENSE("GPL"); ---- /dev/null -+++ b/include/linux/spi/tsc2301.h -@@ -0,0 +1,208 @@ -+#ifndef _LINUX_SPI_TSC2301_H -+#define _LINUX_SPI_TSC2301_H -+ -+#include <linux/types.h> -+#include <linux/timer.h> -+ -+struct tsc2301_platform_data { -+ /* -+ * Keypad -+ */ -+ s16 reset_gpio; -+ s16 keyb_int; -+ s16 keymap[16]; /* Set a key to a negative value if not used */ -+ unsigned kp_rep:1; /* Enable keypad repeating */ -+ char *keyb_name; /* Keyboard device name */ -+ -+ /* -+ * Touchscreen -+ */ -+ s16 dav_int; -+ u16 ts_x_plate_ohm; -+ u32 ts_stab_time; /* voltage settling time */ -+ u8 ts_hw_avg; /* HW assiseted averaging. Can be -+ 0, 4, 8, 16 samples per reading */ -+ u32 ts_max_pressure;/* Samples with bigger pressure value will -+ be ignored, since the corresponding X, Y -+ values are unreliable */ -+ u32 ts_touch_pressure; /* Pressure limit until we report a -+ touch event. After that we switch -+ to ts_max_pressure. */ -+ u32 ts_pressure_fudge; -+ u32 ts_x_max; -+ u32 ts_x_fudge; -+ u32 ts_y_max; -+ u32 ts_y_fudge; -+ -+ /* -+ * Audio -+ */ -+ unsigned pll_pdc:4; -+ unsigned pll_a:4; -+ unsigned pll_n:4; -+ unsigned pll_output:1; /* Output PLL on GPIO_0 */ -+ -+ unsigned mclk_ratio:2; -+ unsigned i2s_sample_rate:4; -+ unsigned i2s_format:2; -+ /* Mask for audio blocks to be powered down */ -+ u16 power_down_blocks; -+ -+ /* Called after codec has been initialized, can be NULL */ -+ int (* codec_init)(struct device *tsc2301_dev); -+ /* Called when codec is being removed, can be NULL */ -+ void (* codec_cleanup)(struct device *tsc2301_dev); -+ int (*enable_clock)(struct device *dev); -+ void (*disable_clock)(struct device *dev); -+ -+ const struct tsc2301_mixer_gpio { -+ const char *name; -+ unsigned gpio:4; -+ unsigned inverted:1; -+ unsigned def_enable:1; /* enable by default */ -+ unsigned deactivate_on_pd:1; /* power-down flag */ -+ } *mixer_gpios; -+ int n_mixer_gpios; -+}; -+ -+struct tsc2301_kp; -+struct tsc2301_ts; -+struct tsc2301_mixer; -+ -+struct tsc2301 { -+ struct spi_device *spi; -+ -+ s16 reset_gpio; -+ u16 config2_shadow; -+ -+ struct tsc2301_kp *kp; -+ struct tsc2301_ts *ts; -+ struct tsc2301_mixer *mixer; -+ -+ int (*enable_clock)(struct device *dev); -+ void (*disable_clock)(struct device *dev); -+}; -+ -+ -+#define TSC2301_HZ 33000000 -+ -+#define TSC2301_REG(page, addr) (((page) << 11) | ((addr) << 5)) -+#define TSC2301_REG_TO_PAGE(reg) (((reg) >> 11) & 0x03) -+#define TSC2301_REG_TO_ADDR(reg) (((reg) >> 5) & 0x1f) -+ -+#define TSC2301_REG_X TSC2301_REG(0, 0) -+#define TSC2301_REG_Y TSC2301_REG(0, 1) -+#define TSC2301_REG_Z1 TSC2301_REG(0, 2) -+#define TSC2301_REG_Z2 TSC2301_REG(0, 3) -+#define TSC2301_REG_KPDATA TSC2301_REG(0, 4) -+#define TSC2301_REG_ADC TSC2301_REG(1, 0) -+#define TSC2301_REG_KEY TSC2301_REG(1, 1) -+#define TSC2301_REG_DAC TSC2301_REG(1, 2) -+#define TSC2301_REG_REF TSC2301_REG(1, 3) -+#define TSC2301_REG_RESET TSC2301_REG(1, 4) -+#define TSC2301_REG_CONFIG TSC2301_REG(1, 5) -+#define TSC2301_REG_CONFIG2 TSC2301_REG(1, 6) -+#define TSC2301_REG_KPMASK TSC2301_REG(1, 16) -+#define TSC2301_REG_AUDCNTL TSC2301_REG(2, 0) -+#define TSC2301_REG_ADCVOL TSC2301_REG(2, 1) -+#define TSC2301_REG_DACVOL TSC2301_REG(2, 2) -+#define TSC2301_REG_BPVOL TSC2301_REG(2, 3) -+#define TSC2301_REG_KEYCTL TSC2301_REG(2, 4) -+#define TSC2301_REG_PD_MISC TSC2301_REG(2, 5) -+#define TSC2301_REG_GPIO TSC2301_REG(2, 6) -+#define TSC2301_REG_ADCLKCFG TSC2301_REG(2, 27) -+ -+#define TSC2301_REG_PD_MISC_APD (1 << 15) -+#define TSC2301_REG_PD_MISC_AVPD (1 << 14) -+#define TSC2301_REG_PD_MISC_ABPD (1 << 13) -+#define TSC2301_REG_PD_MISC_HAPD (1 << 12) -+#define TSC2301_REG_PD_MISC_MOPD (1 << 11) -+#define TSC2301_REG_PD_MISC_DAPD (1 << 10) -+#define TSC2301_REG_PD_MISC_ADPDL (1 << 9) -+#define TSC2301_REG_PD_MISC_ADPDR (1 << 8) -+#define TSC2301_REG_PD_MISC_PDSTS (1 << 7) -+#define TSC2301_REG_PD_MISC_MIBPD (1 << 6) -+#define TSC2301_REG_PD_MISC_OTSYN (1 << 2) -+ -+/* I2S sample rate */ -+#define TSC2301_I2S_SR_48000 0x00 -+#define TSC2301_I2S_SR_44100 0x01 -+#define TSC2301_I2S_SR_32000 0x02 -+#define TSC2301_I2S_SR_24000 0x03 -+#define TSC2301_I2S_SR_22050 0x04 -+#define TSC2301_I2S_SR_16000 0x05 -+#define TSC2301_I2S_SR_12000 0x06 -+#define TSC2301_I2S_SR_11050 0x07 -+#define TSC2301_I2S_SR_8000 0x08 -+ -+/* 16-bit, MSB-first. DAC Right-Justified, ADC Left-Justified */ -+#define TSC2301_I2S_FORMAT0 0x00 -+/* 20-bit, MSB-first. DAC Right-Justified, ADC Left-Justified */ -+#define TSC2301_I2S_FORMAT1 0x01 -+/* 20-bit, MSB-first. DAC Left-Justified, ADC Left-Justified */ -+#define TSC2301_I2S_FORMAT2 0x02 -+/* 20-bit, MSB-first */ -+#define TSC2301_I2S_FORMAT3 0x03 -+ -+/* Master Clock Ratio */ -+#define TSC2301_MCLK_256xFS 0x00 /* default */ -+#define TSC2301_MCLK_384xFS 0x01 -+#define TSC2301_MCLK_512xFS 0x02 -+ -+ -+extern u16 tsc2301_read_reg(struct tsc2301 *tsc, int reg); -+extern void tsc2301_write_reg(struct tsc2301 *tsc, int reg, u16 val); -+extern void tsc2301_write_kbc(struct tsc2301 *tsc, int val); -+extern void tsc2301_write_pll(struct tsc2301 *tsc, int pll_n, int pll_a, -+ int pll_pdc, int pct_e, int pll_o); -+extern void tsc2301_read_buf(struct tsc2301 *tsc, int reg, u16 *buf, int len); -+ -+#define TSC2301_DECL_MOD(module) \ -+extern int tsc2301_##module##_init(struct tsc2301 *tsc, \ -+ struct tsc2301_platform_data *pdata); \ -+extern void tsc2301_##module##_exit(struct tsc2301 *tsc); \ -+extern int tsc2301_##module##_suspend(struct tsc2301 *tsc); \ -+extern void tsc2301_##module##_resume(struct tsc2301 *tsc); -+ -+#define TSC2301_DECL_EMPTY_MOD(module) \ -+static inline int tsc2301_##module##_init(struct tsc2301 *tsc, \ -+ struct tsc2301_platform_data *pdata) \ -+{ \ -+ return 0; \ -+} \ -+static inline void tsc2301_##module##_exit(struct tsc2301 *tsc) {} \ -+static inline int tsc2301_##module##_suspend(struct tsc2301 *tsc) \ -+{ \ -+ return 0; \ -+} \ -+static inline void tsc2301_##module##_resume(struct tsc2301 *tsc) {} -+ -+#ifdef CONFIG_KEYBOARD_TSC2301 -+TSC2301_DECL_MOD(kp) -+void tsc2301_kp_restart(struct tsc2301 *tsc); -+#else -+TSC2301_DECL_EMPTY_MOD(kp) -+static inline void tsc2301_kp_restart(struct tsc2301 *tsc) {} -+#endif -+ -+#ifdef CONFIG_TOUCHSCREEN_TSC2301 -+TSC2301_DECL_MOD(ts) -+#else -+TSC2301_DECL_EMPTY_MOD(ts) -+#endif -+ -+#ifdef CONFIG_SPI_TSC2301_AUDIO -+TSC2301_DECL_MOD(mixer) -+extern void tsc2301_mixer_set_power(struct device *tsc_dev, int dac, int adc); -+ -+struct snd_card; -+extern int tsc2301_mixer_register_controls(struct device *tsc_dev, -+ struct snd_card *card); -+#else -+TSC2301_DECL_EMPTY_MOD(mixer) -+#endif -+ -+extern void tsc2301_mixer_enable_mclk(struct device *tsc_dev); -+extern void tsc2301_mixer_disable_mclk(struct device *tsc_dev); -+ -+#endif diff --git a/target/linux/omap24xx/patches-3.3/320-nokia-various.patch b/target/linux/omap24xx/patches-3.3/320-nokia-various.patch deleted file mode 100644 index 5d89b8f12b..0000000000 --- a/target/linux/omap24xx/patches-3.3/320-nokia-various.patch +++ /dev/null @@ -1,194 +0,0 @@ ---- a/arch/arm/mach-omap2/board-n8x0.c -+++ b/arch/arm/mach-omap2/board-n8x0.c -@@ -25,6 +25,8 @@ - #include <linux/usb/musb.h> - #include <sound/tlv320aic3x.h> - #include <linux/spi/tsc2005.h> -+#include <linux/input.h> -+#include <linux/i2c/lm8323.h> - - #include <asm/mach/arch.h> - #include <asm/mach-types.h> -@@ -37,6 +39,7 @@ - #include <plat/onenand.h> - #include <plat/mmc.h> - #include <plat/serial.h> -+#include <plat/gpio-switch.h> - - #include "mux.h" - -@@ -104,6 +107,152 @@ extern struct mipid_platform_data n8x0_m - extern void n8x0_mipid_init(void); - extern void n8x0_blizzard_init(void); - -+/* We map the FN key as LALT to workaround an X keycode problem. -+ * The XKB map needs to be adjusted to support this. */ -+#define MAP_FN_AS_LEFTALT -+ -+static s16 rx44_keymap[LM8323_KEYMAP_SIZE] = { -+ [0x01] = KEY_Q, -+ [0x02] = KEY_K, -+ [0x03] = KEY_O, -+ [0x04] = KEY_P, -+ [0x05] = KEY_BACKSPACE, -+ [0x06] = KEY_A, -+ [0x07] = KEY_S, -+ [0x08] = KEY_D, -+ [0x09] = KEY_F, -+ [0x0a] = KEY_G, -+ [0x0b] = KEY_H, -+ [0x0c] = KEY_J, -+ -+ [0x11] = KEY_W, -+ [0x12] = KEY_F4, -+ [0x13] = KEY_L, -+ [0x14] = KEY_APOSTROPHE, -+ [0x16] = KEY_Z, -+ [0x17] = KEY_X, -+ [0x18] = KEY_C, -+ [0x19] = KEY_V, -+ [0x1a] = KEY_B, -+ [0x1b] = KEY_N, -+ [0x1c] = KEY_LEFTSHIFT, /* Actually, this is both shift keys */ -+ [0x1f] = KEY_F7, -+ -+ [0x21] = KEY_E, -+ [0x22] = KEY_SEMICOLON, -+ [0x23] = KEY_MINUS, -+ [0x24] = KEY_EQUAL, -+#ifdef MAP_FN_AS_LEFTALT -+ [0x2b] = KEY_LEFTALT, -+#else -+ [0x2b] = KEY_FN, -+#endif -+ [0x2c] = KEY_M, -+ [0x2f] = KEY_F8, -+ -+ [0x31] = KEY_R, -+ [0x32] = KEY_RIGHTCTRL, -+ [0x34] = KEY_SPACE, -+ [0x35] = KEY_COMMA, -+ [0x37] = KEY_UP, -+ [0x3c] = KEY_COMPOSE, -+ [0x3f] = KEY_F6, -+ -+ [0x41] = KEY_T, -+ [0x44] = KEY_DOT, -+ [0x46] = KEY_RIGHT, -+ [0x4f] = KEY_F5, -+ [0x51] = KEY_Y, -+ [0x53] = KEY_DOWN, -+ [0x55] = KEY_ENTER, -+ [0x5f] = KEY_ESC, -+ -+ [0x61] = KEY_U, -+ [0x64] = KEY_LEFT, -+ -+ [0x71] = KEY_I, -+ [0x75] = KEY_KPENTER, -+}; -+ -+static struct lm8323_platform_data lm8323_pdata = { -+ .repeat = 0, /* Repeat is handled in userspace for now. */ -+ .keymap = rx44_keymap, -+ .size_x = 8, -+ .size_y = 12, -+ .debounce_time = 12, -+ .active_time = 500, -+ -+ .name = "Internal keyboard", -+ .pwm_names[0] = "n810::keyboard", -+ .pwm_names[1] = "n810::cover", -+}; -+ -+#define OMAP_TAG_NOKIA_BT 0x4e01 -+ -+struct omap_bluetooth_config { -+ u8 chip_type; -+ u8 bt_wakeup_gpio; -+ u8 host_wakeup_gpio; -+ u8 reset_gpio; -+ u8 bt_uart; -+ u8 bd_addr[6]; -+ u8 bt_sysclk; -+}; -+ -+static struct platform_device n8x0_bt_device = { -+ .name = "hci_h4p", -+ .id = -1, -+ .num_resources = 0, -+}; -+ -+void __init n8x0_bt_init(void) -+{ -+ const struct omap_bluetooth_config *bt_config; -+ -+ bt_config = (void *) omap_get_config(OMAP_TAG_NOKIA_BT, -+ struct omap_bluetooth_config); -+ n8x0_bt_device.dev.platform_data = (void *) bt_config; -+ if (platform_device_register(&n8x0_bt_device) < 0) -+ BUG(); -+} -+ -+static struct omap_gpio_switch n8x0_gpio_switches[] __initdata = { -+ { -+ .name = "headphone", -+ .gpio = -1, -+ .debounce_rising = 200, -+ .debounce_falling = 200, -+ }, { -+ .name = "cam_act", -+ .gpio = -1, -+ .debounce_rising = 200, -+ .debounce_falling = 200, -+ }, { -+ .name = "cam_turn", -+ .gpio = -1, -+ .debounce_rising = 100, -+ .debounce_falling = 100, -+ }, { -+ .name = "slide", -+ .gpio = -1, -+ .debounce_rising = 200, -+ .debounce_falling = 200, -+ }, { -+ .name = "kb_lock", -+ .gpio = -1, -+ .debounce_rising = 200, -+ .debounce_falling = 200, -+ }, -+}; -+ -+static void __init n8x0_gpio_switches_init(void) -+{ -+ /* The switches are actually registered through ATAG mechanism. -+ * This just updates the parameters (thus .gpio is -1) */ -+ omap_register_gpio_switches(n8x0_gpio_switches, -+ ARRAY_SIZE(n8x0_gpio_switches)); -+} -+ - #define TUSB6010_ASYNC_CS 1 - #define TUSB6010_SYNC_CS 4 - #define TUSB6010_GPIO_INT 58 -@@ -799,6 +948,11 @@ static struct aic3x_pdata n810_aic33_dat - }; - - static struct i2c_board_info n810_i2c_board_info_2[] __initdata = { -+ { -+ I2C_BOARD_INFO("lm8323", 0x45), -+ .irq = OMAP_GPIO_IRQ(109), -+ .platform_data = &lm8323_pdata, -+ }, - { - I2C_BOARD_INFO("tlv320aic3x", 0x18), - .platform_data = &n810_aic33_data, -@@ -856,7 +1010,9 @@ static inline void board_serial_init(voi - static void __init n8x0_init_machine(void) - { - omap2420_mux_init(board_mux, OMAP_PACKAGE_ZAC); -+ n8x0_gpio_switches_init(); - n8x0_cbus_init(); -+ n8x0_bt_init(); - - /* FIXME: add n810 spi devices */ - tsc2005_set_config(); diff --git a/target/linux/omap24xx/patches-3.3/330-n800-tsc2301-platform.patch b/target/linux/omap24xx/patches-3.3/330-n800-tsc2301-platform.patch deleted file mode 100644 index 4ceada952e..0000000000 --- a/target/linux/omap24xx/patches-3.3/330-n800-tsc2301-platform.patch +++ /dev/null @@ -1,212 +0,0 @@ -From f0bb9e67f0f13021e5033fed3dfe8ef78fe6a538 Mon Sep 17 00:00:00 2001 -From: Marat Radchenko <marat@slonopotamus.org> -Date: Tue, 18 Oct 2011 21:52:56 +0400 -Subject: [PATCH 2/2] N800: add TSC2301 board info - -This patch adds TSC2301 init logic to N800 board file ---- - arch/arm/mach-omap2/board-n8x0.c | 141 ++++++++++++++++++++++++++++++++++++-- - 1 files changed, 135 insertions(+), 6 deletions(-) - ---- a/arch/arm/mach-omap2/board-n8x0.c -+++ b/arch/arm/mach-omap2/board-n8x0.c -@@ -27,6 +27,7 @@ - #include <linux/spi/tsc2005.h> - #include <linux/input.h> - #include <linux/i2c/lm8323.h> -+#include <linux/spi/tsc2301.h> - - #include <asm/mach/arch.h> - #include <asm/mach-types.h> -@@ -63,7 +64,75 @@ static struct omap2_mcspi_device_config - }; - #endif - --static void __init tsc2005_set_config(void) -+#ifdef CONFIG_TOUCHSCREEN_TSC2301 -+ -+#define N800_KEYB_IRQ_GPIO 109 -+ -+static struct tsc2301_platform_data tsc2301_config = { -+ .reset_gpio = 118, -+ .keymap = { -+ -1, /* Event for bit 0 */ -+ KEY_UP, /* Event for bit 1 (up) */ -+ KEY_F5, /* Event for bit 2 (home) */ -+ -1, /* Event for bit 3 */ -+ KEY_LEFT, /* Event for bit 4 (left) */ -+ KEY_ENTER, /* Event for bit 5 (enter) */ -+ KEY_RIGHT, /* Event for bit 6 (right) */ -+ -1, /* Event for bit 7 */ -+ KEY_ESC, /* Event for bit 8 (cycle) */ -+ KEY_DOWN, /* Event for bit 9 (down) */ -+ KEY_F4, /* Event for bit 10 (menu) */ -+ -1, /* Event for bit 11 */ -+ KEY_F8, /* Event for bit 12 (Zoom-) */ -+ KEY_F6, /* Event for bit 13 (FS) */ -+ KEY_F7, /* Event for bit 14 (Zoom+) */ -+ -1, /* Event for bit 15 */ -+ }, -+ .kp_rep = 0, -+ .keyb_name = "Internal keypad", -+}; -+ -+static struct omap2_mcspi_device_config tsc2301_mcspi_config = { -+ .turbo_mode = 0, -+ .single_channel = 1, -+}; -+ -+/* -+ TODO(Marat Radchenko): better pass GPIO to tsc2301 driver and let it -+ allocate irq itself (as it is already done for touchscreen) -+ */ -+static void tsc2301_dev_init(void) -+{ -+ int r; -+ int gpio = N800_KEYB_IRQ_GPIO; -+ -+ r = gpio_request(gpio, "tsc2301 KBD IRQ"); -+ if (r >= 0) { -+ gpio_direction_input(gpio); -+ tsc2301_config.keyb_int = gpio_to_irq(gpio); -+ } else { -+ printk(KERN_ERR "unable to get KBD GPIO"); -+ } -+ -+ gpio = 103; -+ r = gpio_request(gpio, "tsc2301 DAV IRQ"); -+ if (r >= 0) { -+ gpio_direction_input(gpio); -+ tsc2301_config.dav_int = gpio_to_irq(gpio); -+ } else { -+ printk(KERN_ERR "unable to get DAV GPIO"); -+ } -+} -+ -+#else -+ -+static void __init tsc2301_dev_init(void) -+{ -+} -+ -+#endif -+ -+static void __init n8x0_ts_set_config(void) - { - const struct omap_lcd_config *conf; - -@@ -94,6 +163,37 @@ static void __init tsc2005_set_config(vo - tsc2005_config.ts_x_plate_ohm = 200; - } - #endif -+ -+#ifdef CONFIG_TOUCHSCREEN_TSC2301 -+ if (strcmp(conf->panel_name, "lph8923") == 0) { -+ tsc2301_config.ts_x_plate_ohm = 180; -+ tsc2301_config.ts_hw_avg = 8; -+ tsc2301_config.ts_max_pressure = 2048; -+ tsc2301_config.ts_touch_pressure = 400; -+ tsc2301_config.ts_stab_time = 100; -+ tsc2301_config.ts_pressure_fudge = 2; -+ tsc2301_config.ts_x_max = 4096; -+ tsc2301_config.ts_x_fudge = 4; -+ tsc2301_config.ts_y_max = 4096; -+ tsc2301_config.ts_y_fudge = 7; -+ } else if (strcmp(conf->panel_name, "ls041y3") == 0) { -+ tsc2301_config.ts_x_plate_ohm = 280; -+ tsc2301_config.ts_hw_avg = 8; -+ tsc2301_config.ts_touch_pressure = 400; -+ tsc2301_config.ts_max_pressure = 2048; -+ tsc2301_config.ts_stab_time = 1000; -+ tsc2301_config.ts_pressure_fudge = 2; -+ tsc2301_config.ts_x_max = 4096; -+ tsc2301_config.ts_x_fudge = 4; -+ tsc2301_config.ts_y_max = 4096; -+ tsc2301_config.ts_y_fudge = 7; -+ } else { -+ printk(KERN_ERR "Unknown panel type, set default " -+ "touchscreen configuration\n"); -+ tsc2301_config.ts_x_plate_ohm = 200; -+ tsc2301_config.ts_stab_time = 100; -+ } -+#endif - } - } - -@@ -347,13 +447,12 @@ static void __init n8x0_usb_init(void) { - - #endif /*CONFIG_USB_MUSB_TUSB6010 */ - -- - static struct omap2_mcspi_device_config p54spi_mcspi_config = { - .turbo_mode = 0, - .single_channel = 1, - }; - --static struct spi_board_info n800_spi_board_info[] __initdata = { -+static struct spi_board_info n8x0_common_spi_board_info[] __initdata = { - { - .modalias = "lcd_mipid", - .bus_num = 1, -@@ -369,6 +468,10 @@ static struct spi_board_info n800_spi_bo - .max_speed_hz = 48000000, - .controller_data = &p54spi_mcspi_config, - }, -+}; -+ -+static struct spi_board_info n810_spi_board_info[] __initdata = { -+#ifdef CONFIG_TOUCHSCREEN_TSC2005 - { - .modalias = "tsc2005", - .bus_num = 1, -@@ -378,6 +481,20 @@ static struct spi_board_info n800_spi_bo - .controller_data = &tsc2005_mcspi_config, - .platform_data = &tsc2005_config, - }, -+#endif -+}; -+ -+static struct spi_board_info n800_spi_board_info[] __initdata = { -+#if defined(CONFIG_TOUCHSCREEN_TSC2301) -+ { -+ .modalias = "tsc2301", -+ .bus_num = 1, -+ .chip_select = 0, -+ .max_speed_hz = 6000000, -+ .controller_data = &tsc2301_mcspi_config, -+ .platform_data = &tsc2301_config, -+ }, -+#endif - }; - - #if defined(CONFIG_MTD_ONENAND_OMAP2) || \ -@@ -1015,9 +1132,17 @@ static void __init n8x0_init_machine(voi - n8x0_bt_init(); - - /* FIXME: add n810 spi devices */ -- tsc2005_set_config(); -- spi_register_board_info(n800_spi_board_info, -- ARRAY_SIZE(n800_spi_board_info)); -+ n8x0_ts_set_config(); -+ -+ spi_register_board_info(n8x0_common_spi_board_info, -+ ARRAY_SIZE(n8x0_common_spi_board_info)); -+ if (machine_is_nokia_n800()) -+ spi_register_board_info(n800_spi_board_info, -+ ARRAY_SIZE(n800_spi_board_info)); -+ else -+ spi_register_board_info(n810_spi_board_info, -+ ARRAY_SIZE(n810_spi_board_info)); -+ - omap_register_i2c_bus(1, 400, n8x0_i2c_board_info_1, - ARRAY_SIZE(n8x0_i2c_board_info_1)); - omap_register_i2c_bus(2, 400, NULL, 0); -@@ -1027,6 +1152,8 @@ static void __init n8x0_init_machine(voi - board_serial_init(); - n8x0_mipid_init(); - n8x0_blizzard_init(); -+ if (machine_is_nokia_n800()) -+ tsc2301_dev_init(); - omap_sdrc_init(NULL, NULL); - gpmc_onenand_init(board_onenand_data); - n8x0_mmc_init(); diff --git a/target/linux/omap24xx/patches-3.3/350-n8x0-gpioswitch-input.patch b/target/linux/omap24xx/patches-3.3/350-n8x0-gpioswitch-input.patch deleted file mode 100644 index 1a6c2812e4..0000000000 --- a/target/linux/omap24xx/patches-3.3/350-n8x0-gpioswitch-input.patch +++ /dev/null @@ -1,98 +0,0 @@ ---- - arch/arm/mach-omap2/board-n8x0.c | 73 +++++++++++++++++++++++++++++++++++++++ - 1 file changed, 73 insertions(+) - ---- a/arch/arm/mach-omap2/board-n8x0.c -+++ b/arch/arm/mach-omap2/board-n8x0.c -@@ -316,6 +316,77 @@ void __init n8x0_bt_init(void) - BUG(); - } - -+struct gpio_switch_input_dev { -+ struct input_dev *idev; -+ unsigned int swcode; -+}; -+ -+static struct gpio_switch_input_dev *slide_input; -+static struct gpio_switch_input_dev *kblock_input; -+ -+static void n8x0_gpio_switch_input_notify(struct gpio_switch_input_dev *gdev, -+ int state) -+{ -+ if (gdev) { -+ input_report_switch(gdev->idev, gdev->swcode, state); -+ input_sync(gdev->idev); -+ } -+} -+ -+static void n8x0_slide_notify(void *data, int state) -+{ -+ n8x0_gpio_switch_input_notify(slide_input, state); -+} -+ -+static void n8x0_kb_lock_notify(void *data, int state) -+{ -+ n8x0_gpio_switch_input_notify(kblock_input, state); -+} -+ -+static struct gpio_switch_input_dev * __init gpioswitch_input_init( -+ const char *name, -+ unsigned int swcode) -+{ -+ struct gpio_switch_input_dev *gdev; -+ int err; -+ -+ gdev = kzalloc(sizeof(*gdev), GFP_KERNEL); -+ if (!gdev) -+ goto error; -+ gdev->swcode = swcode; -+ -+ gdev->idev = input_allocate_device(); -+ if (!gdev->idev) -+ goto err_free; -+ -+ gdev->idev->evbit[0] = BIT_MASK(EV_SW); -+ gdev->idev->swbit[BIT_WORD(swcode)] = BIT_MASK(swcode); -+ gdev->idev->name = name; -+ -+ err = input_register_device(gdev->idev); -+ if (err) -+ goto err_free_idev; -+ -+ return gdev; -+ -+err_free_idev: -+ input_free_device(gdev->idev); -+err_free: -+ kfree(gdev); -+error: -+ return NULL; -+} -+ -+static int __init n8x0_gpio_switches_input_init(void) -+{ -+ slide_input = gpioswitch_input_init("slide", SW_KEYPAD_SLIDE); -+ kblock_input = gpioswitch_input_init("kb_lock", SW_LID); -+ if (WARN_ON(!slide_input || !kblock_input)) -+ return -ENODEV; -+ return 0; -+} -+late_initcall(n8x0_gpio_switches_input_init); -+ - static struct omap_gpio_switch n8x0_gpio_switches[] __initdata = { - { - .name = "headphone", -@@ -337,11 +408,13 @@ static struct omap_gpio_switch n8x0_gpio - .gpio = -1, - .debounce_rising = 200, - .debounce_falling = 200, -+ .notify = n8x0_slide_notify, - }, { - .name = "kb_lock", - .gpio = -1, - .debounce_rising = 200, - .debounce_falling = 200, -+ .notify = n8x0_kb_lock_notify, - }, - }; - diff --git a/target/linux/omap24xx/patches-3.3/400-bluetooth-hci_h4p.patch b/target/linux/omap24xx/patches-3.3/400-bluetooth-hci_h4p.patch deleted file mode 100644 index 408da4a3a0..0000000000 --- a/target/linux/omap24xx/patches-3.3/400-bluetooth-hci_h4p.patch +++ /dev/null @@ -1,1946 +0,0 @@ ---- - drivers/bluetooth/Kconfig | 10 - drivers/bluetooth/Makefile | 1 - drivers/bluetooth/hci_h4p/Makefile | 7 - drivers/bluetooth/hci_h4p/core.c | 1043 ++++++++++++++++++++++++++++++++++++ - drivers/bluetooth/hci_h4p/fw-csr.c | 149 +++++ - drivers/bluetooth/hci_h4p/fw-ti.c | 90 +++ - drivers/bluetooth/hci_h4p/fw.c | 155 +++++ - drivers/bluetooth/hci_h4p/hci_h4p.h | 183 ++++++ - drivers/bluetooth/hci_h4p/sysfs.c | 84 ++ - drivers/bluetooth/hci_h4p/uart.c | 169 +++++ - 10 files changed, 1891 insertions(+) - ---- /dev/null -+++ b/drivers/bluetooth/hci_h4p/core.c -@@ -0,0 +1,1043 @@ -+/* -+ * This file is part of hci_h4p bluetooth driver -+ * -+ * Copyright (C) 2005, 2006 Nokia Corporation. -+ * -+ * Contact: Ville Tervo <ville.tervo@nokia.com> -+ * -+ * 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. -+ * -+ * This program is distributed in the hope that it will be useful, but -+ * WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA -+ * 02110-1301 USA -+ * -+ */ -+ -+#include <linux/module.h> -+ -+#include <linux/kernel.h> -+#include <linux/init.h> -+#include <linux/errno.h> -+#include <linux/delay.h> -+#include <linux/spinlock.h> -+#include <linux/serial_reg.h> -+#include <linux/skbuff.h> -+#include <linux/timer.h> -+#include <linux/device.h> -+#include <linux/platform_device.h> -+#include <linux/clk.h> -+#include <linux/gpio.h> -+ -+#include <mach/hardware.h> -+#include <mach/board.h> -+#include <mach/irqs.h> -+#include <plat/serial.h> -+ -+#include <net/bluetooth/bluetooth.h> -+#include <net/bluetooth/hci_core.h> -+#include <net/bluetooth/hci.h> -+ -+#include "hci_h4p.h" -+ -+#define PM_TIMEOUT 200 -+ -+struct omap_bluetooth_config { -+ u8 chip_type; -+ u8 bt_wakeup_gpio; -+ u8 host_wakeup_gpio; -+ u8 reset_gpio; -+ u8 bt_uart; -+ u8 bd_addr[6]; -+ u8 bt_sysclk; -+}; -+ -+/* This should be used in function that cannot release clocks */ -+static void hci_h4p_set_clk(struct hci_h4p_info *info, int *clock, int enable) -+{ -+ unsigned long flags; -+ -+ spin_lock_irqsave(&info->clocks_lock, flags); -+ if (enable && !*clock) { -+ NBT_DBG_POWER("Enabling %p\n", clock); -+ clk_enable(info->uart_fclk); -+#ifdef CONFIG_ARCH_OMAP2 -+ if (cpu_is_omap24xx()) { -+ clk_enable(info->uart_iclk); -+ //omap2_block_sleep(); -+ } -+#endif -+ } -+ if (!enable && *clock) { -+ NBT_DBG_POWER("Disabling %p\n", clock); -+ clk_disable(info->uart_fclk); -+#ifdef CONFIG_ARCH_OMAP2 -+ if (cpu_is_omap24xx()) { -+ clk_disable(info->uart_iclk); -+ //omap2_allow_sleep(); -+ } -+#endif -+ } -+ -+ *clock = enable; -+ spin_unlock_irqrestore(&info->clocks_lock, flags); -+} -+ -+/* Power management functions */ -+static void hci_h4p_disable_tx(struct hci_h4p_info *info) -+{ -+ NBT_DBG_POWER("\n"); -+ -+ if (!info->pm_enabled) -+ return; -+ -+ mod_timer(&info->tx_pm_timer, jiffies + msecs_to_jiffies(PM_TIMEOUT)); -+} -+ -+static void hci_h4p_enable_tx(struct hci_h4p_info *info) -+{ -+ NBT_DBG_POWER("\n"); -+ -+ if (!info->pm_enabled) -+ return; -+ -+ del_timer_sync(&info->tx_pm_timer); -+ if (info->tx_pm_enabled) { -+ info->tx_pm_enabled = 0; -+ hci_h4p_set_clk(info, &info->tx_clocks_en, 1); -+ gpio_set_value(info->bt_wakeup_gpio, 1); -+ } -+} -+ -+static void hci_h4p_tx_pm_timer(unsigned long data) -+{ -+ struct hci_h4p_info *info; -+ -+ NBT_DBG_POWER("\n"); -+ -+ info = (struct hci_h4p_info *)data; -+ -+ if (hci_h4p_inb(info, UART_LSR) & UART_LSR_TEMT) { -+ gpio_set_value(info->bt_wakeup_gpio, 0); -+ hci_h4p_set_clk(info, &info->tx_clocks_en, 0); -+ info->tx_pm_enabled = 1; -+ } -+ else { -+ mod_timer(&info->tx_pm_timer, jiffies + msecs_to_jiffies(PM_TIMEOUT)); -+ } -+} -+ -+static void hci_h4p_disable_rx(struct hci_h4p_info *info) -+{ -+ if (!info->pm_enabled) -+ return; -+ -+ mod_timer(&info->rx_pm_timer, jiffies + msecs_to_jiffies(PM_TIMEOUT)); -+} -+ -+static void hci_h4p_enable_rx(struct hci_h4p_info *info) -+{ -+ unsigned long flags; -+ -+ if (!info->pm_enabled) -+ return; -+ -+ del_timer_sync(&info->rx_pm_timer); -+ spin_lock_irqsave(&info->lock, flags); -+ if (info->rx_pm_enabled) { -+ hci_h4p_set_clk(info, &info->rx_clocks_en, 1); -+ hci_h4p_outb(info, UART_IER, hci_h4p_inb(info, UART_IER) | UART_IER_RDI); -+ __hci_h4p_set_auto_ctsrts(info, 1, UART_EFR_RTS); -+ info->rx_pm_enabled = 0; -+ } -+ spin_unlock_irqrestore(&info->lock, flags); -+} -+ -+static void hci_h4p_rx_pm_timer(unsigned long data) -+{ -+ unsigned long flags; -+ struct hci_h4p_info *info = (struct hci_h4p_info *)data; -+ -+ spin_lock_irqsave(&info->lock, flags); -+ if (!(hci_h4p_inb(info, UART_LSR) & UART_LSR_DR)) { -+ __hci_h4p_set_auto_ctsrts(info, 0, UART_EFR_RTS); -+ hci_h4p_set_rts(info, 0); -+ hci_h4p_outb(info, UART_IER, hci_h4p_inb(info, UART_IER) & ~UART_IER_RDI); -+ hci_h4p_set_clk(info, &info->rx_clocks_en, 0); -+ info->rx_pm_enabled = 1; -+ } -+ else { -+ mod_timer(&info->rx_pm_timer, jiffies + msecs_to_jiffies(PM_TIMEOUT)); -+ } -+ spin_unlock_irqrestore(&info->lock, flags); -+} -+ -+/* Negotiation functions */ -+int hci_h4p_send_alive_packet(struct hci_h4p_info *info) -+{ -+ NBT_DBG("Sending alive packet\n"); -+ -+ if (!info->alive_cmd_skb) -+ return -EINVAL; -+ -+ /* Keep reference to buffer so we can reuse it */ -+ info->alive_cmd_skb = skb_get(info->alive_cmd_skb); -+ -+ skb_queue_tail(&info->txq, info->alive_cmd_skb); -+ tasklet_schedule(&info->tx_task); -+ -+ NBT_DBG("Alive packet sent\n"); -+ -+ return 0; -+} -+ -+static void hci_h4p_alive_packet(struct hci_h4p_info *info, struct sk_buff *skb) -+{ -+ NBT_DBG("Received alive packet\n"); -+ if (skb->data[1] == 0xCC) { -+ complete(&info->init_completion); -+ } -+ -+ kfree_skb(skb); -+} -+ -+static int hci_h4p_send_negotiation(struct hci_h4p_info *info, struct sk_buff *skb) -+{ -+ NBT_DBG("Sending negotiation..\n"); -+ -+ hci_h4p_change_speed(info, INIT_SPEED); -+ -+ info->init_error = 0; -+ init_completion(&info->init_completion); -+ skb_queue_tail(&info->txq, skb); -+ tasklet_schedule(&info->tx_task); -+ -+ if (!wait_for_completion_interruptible_timeout(&info->init_completion, -+ msecs_to_jiffies(1000))) -+ return -ETIMEDOUT; -+ -+ NBT_DBG("Negotiation sent\n"); -+ return info->init_error; -+} -+ -+static void hci_h4p_negotiation_packet(struct hci_h4p_info *info, -+ struct sk_buff *skb) -+{ -+ int err = 0; -+ -+ if (skb->data[1] == 0x20) { -+ /* Change to operational settings */ -+ hci_h4p_set_rts(info, 0); -+ -+ err = hci_h4p_wait_for_cts(info, 0, 100); -+ if (err < 0) -+ goto neg_ret; -+ -+ hci_h4p_change_speed(info, MAX_BAUD_RATE); -+ -+ err = hci_h4p_wait_for_cts(info, 1, 100); -+ if (err < 0) -+ goto neg_ret; -+ -+ hci_h4p_set_auto_ctsrts(info, 1, UART_EFR_CTS | UART_EFR_RTS); -+ -+ err = hci_h4p_send_alive_packet(info); -+ if (err < 0) -+ goto neg_ret; -+ } else { -+ dev_err(info->dev, "Could not negotiate hci_h4p settings\n"); -+ err = -EINVAL; -+ goto neg_ret; -+ } -+ -+ kfree_skb(skb); -+ return; -+ -+neg_ret: -+ info->init_error = err; -+ complete(&info->init_completion); -+ kfree_skb(skb); -+} -+ -+/* H4 packet handling functions */ -+static int hci_h4p_get_hdr_len(struct hci_h4p_info *info, u8 pkt_type) -+{ -+ long retval; -+ -+ switch (pkt_type) { -+ case H4_EVT_PKT: -+ retval = HCI_EVENT_HDR_SIZE; -+ break; -+ case H4_ACL_PKT: -+ retval = HCI_ACL_HDR_SIZE; -+ break; -+ case H4_SCO_PKT: -+ retval = HCI_SCO_HDR_SIZE; -+ break; -+ case H4_NEG_PKT: -+ retval = 11; -+ break; -+ case H4_ALIVE_PKT: -+ retval = 3; -+ break; -+ default: -+ dev_err(info->dev, "Unknown H4 packet type 0x%.2x\n", pkt_type); -+ retval = -1; -+ break; -+ } -+ -+ return retval; -+} -+ -+static unsigned int hci_h4p_get_data_len(struct hci_h4p_info *info, -+ struct sk_buff *skb) -+{ -+ long retval = -1; -+ struct hci_event_hdr *evt_hdr; -+ struct hci_acl_hdr *acl_hdr; -+ struct hci_sco_hdr *sco_hdr; -+ -+ switch (bt_cb(skb)->pkt_type) { -+ case H4_EVT_PKT: -+ evt_hdr = (struct hci_event_hdr *)skb->data; -+ retval = evt_hdr->plen; -+ break; -+ case H4_ACL_PKT: -+ acl_hdr = (struct hci_acl_hdr *)skb->data; -+ retval = le16_to_cpu(acl_hdr->dlen); -+ break; -+ case H4_SCO_PKT: -+ sco_hdr = (struct hci_sco_hdr *)skb->data; -+ retval = sco_hdr->dlen; -+ break; -+ case H4_NEG_PKT: -+ retval = 0; -+ break; -+ case H4_ALIVE_PKT: -+ retval = 0; -+ break; -+ } -+ -+ return retval; -+} -+ -+static inline void hci_h4p_recv_frame(struct hci_h4p_info *info, -+ struct sk_buff *skb) -+{ -+ -+ if (unlikely(!test_bit(HCI_RUNNING, &info->hdev->flags))) { -+ NBT_DBG("fw_event\n"); -+ hci_h4p_parse_fw_event(info, skb); -+ } else { -+ hci_recv_frame(skb); -+ NBT_DBG("Frame sent to upper layer\n"); -+ } -+} -+ -+static void hci_h4p_rx_tasklet(unsigned long data) -+{ -+ u8 byte; -+ unsigned long flags; -+ struct hci_h4p_info *info = (struct hci_h4p_info *)data; -+ -+ NBT_DBG("tasklet woke up\n"); -+ NBT_DBG_TRANSFER("rx_tasklet woke up\ndata "); -+ -+ while (hci_h4p_inb(info, UART_LSR) & UART_LSR_DR) { -+ byte = hci_h4p_inb(info, UART_RX); -+ if (info->garbage_bytes) { -+ info->garbage_bytes--; -+ continue; -+ } -+ if (info->rx_skb == NULL) { -+ info->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC | GFP_DMA); -+ if (!info->rx_skb) { -+ dev_err(info->dev, "Can't allocate memory for new packet\n"); -+ goto finish_task; -+ } -+ info->rx_state = WAIT_FOR_PKT_TYPE; -+ info->rx_skb->dev = (void *)info->hdev; -+ } -+ info->hdev->stat.byte_rx++; -+ NBT_DBG_TRANSFER_NF("0x%.2x ", byte); -+ switch (info->rx_state) { -+ case WAIT_FOR_PKT_TYPE: -+ bt_cb(info->rx_skb)->pkt_type = byte; -+ info->rx_count = hci_h4p_get_hdr_len(info, byte); -+ if (info->rx_count < 0) { -+ info->hdev->stat.err_rx++; -+ kfree_skb(info->rx_skb); -+ info->rx_skb = NULL; -+ } else { -+ info->rx_state = WAIT_FOR_HEADER; -+ } -+ break; -+ case WAIT_FOR_HEADER: -+ info->rx_count--; -+ *skb_put(info->rx_skb, 1) = byte; -+ if (info->rx_count == 0) { -+ info->rx_count = hci_h4p_get_data_len(info, info->rx_skb); -+ if (info->rx_count > skb_tailroom(info->rx_skb)) { -+ dev_err(info->dev, "Frame is %ld bytes too long.\n", -+ info->rx_count - skb_tailroom(info->rx_skb)); -+ kfree_skb(info->rx_skb); -+ info->rx_skb = NULL; -+ info->garbage_bytes = info->rx_count - skb_tailroom(info->rx_skb); -+ break; -+ } -+ info->rx_state = WAIT_FOR_DATA; -+ -+ if (bt_cb(info->rx_skb)->pkt_type == H4_NEG_PKT) { -+ hci_h4p_negotiation_packet(info, info->rx_skb); -+ info->rx_skb = NULL; -+ info->rx_state = WAIT_FOR_PKT_TYPE; -+ goto finish_task; -+ } -+ if (bt_cb(info->rx_skb)->pkt_type == H4_ALIVE_PKT) { -+ hci_h4p_alive_packet(info, info->rx_skb); -+ info->rx_skb = NULL; -+ info->rx_state = WAIT_FOR_PKT_TYPE; -+ goto finish_task; -+ } -+ } -+ break; -+ case WAIT_FOR_DATA: -+ info->rx_count--; -+ *skb_put(info->rx_skb, 1) = byte; -+ if (info->rx_count == 0) { -+ /* H4+ devices should allways send word aligned packets */ -+ if (!(info->rx_skb->len % 2)) { -+ info->garbage_bytes++; -+ } -+ hci_h4p_recv_frame(info, info->rx_skb); -+ info->rx_skb = NULL; -+ } -+ break; -+ default: -+ WARN_ON(1); -+ break; -+ } -+ } -+ -+finish_task: -+ spin_lock_irqsave(&info->lock, flags); -+ hci_h4p_outb(info, UART_IER, hci_h4p_inb(info, UART_IER) | UART_IER_RDI); -+ spin_unlock_irqrestore(&info->lock, flags); -+ -+ NBT_DBG_TRANSFER_NF("\n"); -+ NBT_DBG("rx_ended\n"); -+} -+ -+static void hci_h4p_tx_tasklet(unsigned long data) -+{ -+ unsigned int sent = 0; -+ unsigned long flags; -+ struct sk_buff *skb; -+ struct hci_h4p_info *info = (struct hci_h4p_info *)data; -+ -+ NBT_DBG("tasklet woke up\n"); -+ NBT_DBG_TRANSFER("tx_tasklet woke up\n data "); -+ -+ skb = skb_dequeue(&info->txq); -+ if (!skb) { -+ /* No data in buffer */ -+ NBT_DBG("skb ready\n"); -+ hci_h4p_disable_tx(info); -+ return; -+ } -+ -+ /* Copy data to tx fifo */ -+ while (!(hci_h4p_inb(info, UART_OMAP_SSR) & UART_OMAP_SSR_TXFULL) && -+ (sent < skb->len)) { -+ NBT_DBG_TRANSFER_NF("0x%.2x ", skb->data[sent]); -+ hci_h4p_outb(info, UART_TX, skb->data[sent]); -+ sent++; -+ } -+ -+ info->hdev->stat.byte_tx += sent; -+ NBT_DBG_TRANSFER_NF("\n"); -+ if (skb->len == sent) { -+ kfree_skb(skb); -+ } else { -+ skb_pull(skb, sent); -+ skb_queue_head(&info->txq, skb); -+ } -+ -+ spin_lock_irqsave(&info->lock, flags); -+ hci_h4p_outb(info, UART_IER, hci_h4p_inb(info, UART_IER) | UART_IER_THRI); -+ spin_unlock_irqrestore(&info->lock, flags); -+} -+ -+static irqreturn_t hci_h4p_interrupt(int irq, void *data) -+{ -+ struct hci_h4p_info *info = (struct hci_h4p_info *)data; -+ u8 iir, msr; -+ int ret; -+ unsigned long flags; -+ -+ ret = IRQ_NONE; -+ -+ iir = hci_h4p_inb(info, UART_IIR); -+ if (iir & UART_IIR_NO_INT) { -+ dev_err(info->dev, "Interrupt but no reason irq 0x%.2x\n", iir); -+ return IRQ_HANDLED; -+ } -+ -+ NBT_DBG("In interrupt handler iir 0x%.2x\n", iir); -+ -+ iir &= UART_IIR_ID; -+ -+ if (iir == UART_IIR_MSI) { -+ msr = hci_h4p_inb(info, UART_MSR); -+ ret = IRQ_HANDLED; -+ } -+ if (iir == UART_IIR_RLSI) { -+ hci_h4p_inb(info, UART_RX); -+ hci_h4p_inb(info, UART_LSR); -+ ret = IRQ_HANDLED; -+ } -+ -+ if (iir == UART_IIR_RDI) { -+ spin_lock_irqsave(&info->lock, flags); -+ hci_h4p_outb(info, UART_IER, hci_h4p_inb(info, UART_IER) & ~UART_IER_RDI); -+ spin_unlock_irqrestore(&info->lock, flags); -+ tasklet_schedule(&info->rx_task); -+ ret = IRQ_HANDLED; -+ } -+ -+ if (iir == UART_IIR_THRI) { -+ spin_lock_irqsave(&info->lock, flags); -+ hci_h4p_outb(info, UART_IER, hci_h4p_inb(info, UART_IER) & ~UART_IER_THRI); -+ spin_unlock_irqrestore(&info->lock, flags); -+ tasklet_schedule(&info->tx_task); -+ ret = IRQ_HANDLED; -+ } -+ -+ return ret; -+} -+ -+static irqreturn_t hci_h4p_wakeup_interrupt(int irq, void *dev_inst) -+{ -+ struct hci_h4p_info *info = dev_inst; -+ int should_wakeup; -+ struct hci_dev *hdev; -+ -+ if (!info->hdev) -+ return IRQ_HANDLED; -+ -+ hdev = info->hdev; -+ -+ if (!test_bit(HCI_RUNNING, &hdev->flags)) -+ return IRQ_HANDLED; -+ -+ should_wakeup = gpio_get_value(info->host_wakeup_gpio); -+ NBT_DBG_POWER("gpio interrupt %d\n", should_wakeup); -+ if (should_wakeup) { -+ hci_h4p_enable_rx(info); -+ } else { -+ hci_h4p_disable_rx(info); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static int hci_h4p_reset(struct hci_h4p_info *info) -+{ -+ int err; -+ -+ hci_h4p_init_uart(info); -+ hci_h4p_set_rts(info, 0); -+ -+ gpio_set_value(info->reset_gpio, 0); -+ msleep(100); -+ gpio_set_value(info->bt_wakeup_gpio, 1); -+ gpio_set_value(info->reset_gpio, 1); -+ msleep(100); -+ -+ err = hci_h4p_wait_for_cts(info, 1, 10); -+ if (err < 0) { -+ dev_err(info->dev, "No cts from bt chip\n"); -+ return err; -+ } -+ -+ hci_h4p_set_rts(info, 1); -+ -+ return 0; -+} -+ -+/* hci callback functions */ -+static int hci_h4p_hci_flush(struct hci_dev *hdev) -+{ -+ struct hci_h4p_info *info; -+ info = hdev->driver_data; -+ -+ skb_queue_purge(&info->txq); -+ -+ return 0; -+} -+ -+static int hci_h4p_hci_open(struct hci_dev *hdev) -+{ -+ struct hci_h4p_info *info; -+ int err; -+ struct sk_buff *neg_cmd_skb; -+ struct sk_buff_head fw_queue; -+ -+ info = hdev->driver_data; -+ -+ if (test_bit(HCI_RUNNING, &hdev->flags)) -+ return 0; -+ -+ skb_queue_head_init(&fw_queue); -+ err = hci_h4p_read_fw(info, &fw_queue); -+ if (err < 0) { -+ dev_err(info->dev, "Cannot read firmware\n"); -+ return err; -+ } -+ neg_cmd_skb = skb_dequeue(&fw_queue); -+ if (!neg_cmd_skb) { -+ err = -EPROTO; -+ goto err_clean; -+ } -+ info->alive_cmd_skb = skb_dequeue(&fw_queue); -+ if (!info->alive_cmd_skb) { -+ err = -EPROTO; -+ goto err_clean; -+ } -+ -+ hci_h4p_set_clk(info, &info->tx_clocks_en, 1); -+ hci_h4p_set_clk(info, &info->rx_clocks_en, 1); -+ -+ tasklet_enable(&info->tx_task); -+ tasklet_enable(&info->rx_task); -+ info->rx_state = WAIT_FOR_PKT_TYPE; -+ info->rx_count = 0; -+ info->garbage_bytes = 0; -+ info->rx_skb = NULL; -+ info->pm_enabled = 0; -+ init_completion(&info->fw_completion); -+ -+ err = hci_h4p_reset(info); -+ if (err < 0) -+ goto err_clean; -+ -+ err = hci_h4p_send_negotiation(info, neg_cmd_skb); -+ neg_cmd_skb = NULL; -+ if (err < 0) -+ goto err_clean; -+ -+ err = hci_h4p_send_fw(info, &fw_queue); -+ if (err < 0) { -+ dev_err(info->dev, "Sending firmware failed.\n"); -+ goto err_clean; -+ } -+ -+ kfree_skb(info->alive_cmd_skb); -+ info->alive_cmd_skb = NULL; -+ info->pm_enabled = 1; -+ info->tx_pm_enabled = 1; -+ info->rx_pm_enabled = 0; -+ set_bit(HCI_RUNNING, &hdev->flags); -+ -+ NBT_DBG("hci up and running\n"); -+ return 0; -+ -+err_clean: -+ hci_h4p_hci_flush(hdev); -+ tasklet_disable(&info->tx_task); -+ tasklet_disable(&info->rx_task); -+ hci_h4p_reset_uart(info); -+ hci_h4p_set_clk(info, &info->tx_clocks_en, 0); -+ hci_h4p_set_clk(info, &info->rx_clocks_en, 0); -+ gpio_set_value(info->reset_gpio, 0); -+ gpio_set_value(info->bt_wakeup_gpio, 0); -+ skb_queue_purge(&fw_queue); -+ kfree_skb(neg_cmd_skb); -+ neg_cmd_skb = NULL; -+ kfree_skb(info->alive_cmd_skb); -+ info->alive_cmd_skb = NULL; -+ kfree_skb(info->rx_skb); -+ -+ return err; -+} -+ -+static int hci_h4p_hci_close(struct hci_dev *hdev) -+{ -+ struct hci_h4p_info *info = hdev->driver_data; -+ -+ if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags)) -+ return 0; -+ -+ hci_h4p_hci_flush(hdev); -+ del_timer_sync(&info->tx_pm_timer); -+ del_timer_sync(&info->rx_pm_timer); -+ tasklet_disable(&info->tx_task); -+ tasklet_disable(&info->rx_task); -+ hci_h4p_set_clk(info, &info->tx_clocks_en, 1); -+ hci_h4p_set_clk(info, &info->rx_clocks_en, 1); -+ hci_h4p_reset_uart(info); -+ hci_h4p_set_clk(info, &info->tx_clocks_en, 0); -+ hci_h4p_set_clk(info, &info->rx_clocks_en, 0); -+ gpio_set_value(info->reset_gpio, 0); -+ gpio_set_value(info->bt_wakeup_gpio, 0); -+ kfree_skb(info->rx_skb); -+ -+ return 0; -+} -+ -+static void hci_h4p_hci_destruct(struct hci_dev *hdev) -+{ -+} -+ -+static int hci_h4p_hci_send_frame(struct sk_buff *skb) -+{ -+ struct hci_h4p_info *info; -+ struct hci_dev *hdev = (struct hci_dev *)skb->dev; -+ int err = 0; -+ -+ if (!hdev) { -+ printk(KERN_WARNING "hci_h4p: Frame for unknown device\n"); -+ return -ENODEV; -+ } -+ -+ NBT_DBG("dev %p, skb %p\n", hdev, skb); -+ -+ info = hdev->driver_data; -+ -+ if (!test_bit(HCI_RUNNING, &hdev->flags)) { -+ dev_warn(info->dev, "Frame for non-running device\n"); -+ return -EIO; -+ } -+ -+ switch (bt_cb(skb)->pkt_type) { -+ case HCI_COMMAND_PKT: -+ hdev->stat.cmd_tx++; -+ break; -+ case HCI_ACLDATA_PKT: -+ hdev->stat.acl_tx++; -+ break; -+ case HCI_SCODATA_PKT: -+ hdev->stat.sco_tx++; -+ break; -+ } -+ -+ /* Push frame type to skb */ -+ *skb_push(skb, 1) = (bt_cb(skb)->pkt_type); -+ /* We should allways send word aligned data to h4+ devices */ -+ if (skb->len % 2) { -+ err = skb_pad(skb, 1); -+ } -+ if (err) -+ return err; -+ -+ hci_h4p_enable_tx(info); -+ skb_queue_tail(&info->txq, skb); -+ tasklet_schedule(&info->tx_task); -+ -+ return 0; -+} -+ -+static int hci_h4p_hci_ioctl(struct hci_dev *hdev, unsigned int cmd, unsigned long arg) -+{ -+ return -ENOIOCTLCMD; -+} -+ -+static int hci_h4p_register_hdev(struct hci_h4p_info *info) -+{ -+ struct hci_dev *hdev; -+ -+ /* Initialize and register HCI device */ -+ -+ hdev = hci_alloc_dev(); -+ if (!hdev) { -+ dev_err(info->dev, "Can't allocate memory for device\n"); -+ return -ENOMEM; -+ } -+ info->hdev = hdev; -+ -+ hdev->dev_type = HCI_UART; -+ hdev->driver_data = info; -+ -+ hdev->open = hci_h4p_hci_open; -+ hdev->close = hci_h4p_hci_close; -+ hdev->flush = hci_h4p_hci_flush; -+ hdev->send = hci_h4p_hci_send_frame; -+ hdev->destruct = hci_h4p_hci_destruct; -+ hdev->ioctl = hci_h4p_hci_ioctl; -+ -+ hdev->owner = THIS_MODULE; -+ -+ if (hci_register_dev(hdev) < 0) { -+ dev_err(info->dev, "hci_h4p: Can't register HCI device %s.\n", hdev->name); -+ return -ENODEV; -+ } -+ -+ return 0; -+} -+ -+static int hci_h4p_probe(struct platform_device *pdev) -+{ -+ struct omap_bluetooth_config *bt_config; -+ struct hci_h4p_info *info; -+ int irq, err; -+ -+ dev_info(&pdev->dev, "Registering HCI H4P device\n"); -+ info = kzalloc(sizeof(struct hci_h4p_info), GFP_KERNEL); -+ if (!info) -+ return -ENOMEM; -+ -+ info->dev = &pdev->dev; -+ info->pm_enabled = 0; -+ info->tx_pm_enabled = 0; -+ info->rx_pm_enabled = 0; -+ info->garbage_bytes = 0; -+ info->tx_clocks_en = 0; -+ info->rx_clocks_en = 0; -+ tasklet_init(&info->tx_task, hci_h4p_tx_tasklet, (unsigned long)info); -+ tasklet_init(&info->rx_task, hci_h4p_rx_tasklet, (unsigned long)info); -+ /* hci_h4p_hci_open assumes that tasklet is disabled in startup */ -+ tasklet_disable(&info->tx_task); -+ tasklet_disable(&info->rx_task); -+ spin_lock_init(&info->lock); -+ spin_lock_init(&info->clocks_lock); -+ skb_queue_head_init(&info->txq); -+ init_timer(&info->tx_pm_timer); -+ info->tx_pm_timer.function = hci_h4p_tx_pm_timer; -+ info->tx_pm_timer.data = (unsigned long)info; -+ init_timer(&info->rx_pm_timer); -+ info->rx_pm_timer.function = hci_h4p_rx_pm_timer; -+ info->rx_pm_timer.data = (unsigned long)info; -+ -+ if (pdev->dev.platform_data == NULL) { -+ dev_err(&pdev->dev, "Could not get Bluetooth config data\n"); -+ return -ENODATA; -+ } -+ -+ bt_config = pdev->dev.platform_data; -+ info->chip_type = bt_config->chip_type; -+ info->bt_wakeup_gpio = bt_config->bt_wakeup_gpio; -+ info->host_wakeup_gpio = bt_config->host_wakeup_gpio; -+ info->reset_gpio = bt_config->reset_gpio; -+ info->bt_sysclk = bt_config->bt_sysclk; -+ -+ NBT_DBG("RESET gpio: %d\n", info->reset_gpio); -+ NBT_DBG("BTWU gpio: %d\n", info->bt_wakeup_gpio); -+ NBT_DBG("HOSTWU gpio: %d\n", info->host_wakeup_gpio); -+ NBT_DBG("Uart: %d\n", bt_config->bt_uart); -+ NBT_DBG("sysclk: %d\n", info->bt_sysclk); -+ -+ err = gpio_request(info->reset_gpio, "BT reset"); -+ if (err < 0) { -+ dev_err(&pdev->dev, "Cannot get GPIO line %d\n", -+ info->reset_gpio); -+ kfree(info); -+ goto cleanup; -+ } -+ -+ err = gpio_request(info->bt_wakeup_gpio, "BT wakeup"); -+ if (err < 0) -+ { -+ dev_err(info->dev, "Cannot get GPIO line 0x%d", -+ info->bt_wakeup_gpio); -+ gpio_free(info->reset_gpio); -+ kfree(info); -+ goto cleanup; -+ } -+ -+ err = gpio_request(info->host_wakeup_gpio, "BT host wakeup"); -+ if (err < 0) -+ { -+ dev_err(info->dev, "Cannot get GPIO line %d", -+ info->host_wakeup_gpio); -+ gpio_free(info->reset_gpio); -+ gpio_free(info->bt_wakeup_gpio); -+ kfree(info); -+ goto cleanup; -+ } -+ -+ gpio_direction_output(info->reset_gpio, 0); -+ gpio_direction_output(info->bt_wakeup_gpio, 0); -+ gpio_direction_input(info->host_wakeup_gpio); -+ -+//FIXME -+#if defined(CONFIG_ARCH_OMAP1) -+# define OMAP_UART1_BASE OMAP1_UART1_BASE -+# define OMAP_UART2_BASE OMAP1_UART2_BASE -+# define OMAP_UART3_BASE OMAP1_UART3_BASE -+#elif defined(CONFIG_ARCH_OMAP2) -+# define OMAP_UART1_BASE OMAP2_UART1_BASE -+# define OMAP_UART2_BASE OMAP2_UART2_BASE -+# define OMAP_UART3_BASE OMAP2_UART3_BASE -+#elif defined(CONFIG_ARCH_OMAP3) -+# define OMAP_UART1_BASE OMAP3_UART1_BASE -+# define OMAP_UART2_BASE OMAP3_UART2_BASE -+# define OMAP_UART3_BASE OMAP3_UART3_BASE -+#elif defined(CONFIG_ARCH_OMAP4) -+# define OMAP_UART1_BASE OMAP4_UART1_BASE -+# define OMAP_UART2_BASE OMAP4_UART2_BASE -+# define OMAP_UART3_BASE OMAP4_UART3_BASE -+#else -+# error -+#endif -+ switch (bt_config->bt_uart) { -+ case 1: -+ if (cpu_is_omap16xx()) { -+ irq = INT_UART1; -+ info->uart_fclk = clk_get(NULL, "uart1_ck"); -+ } else if (cpu_is_omap24xx()) { -+ irq = INT_24XX_UART1_IRQ; -+ info->uart_iclk = clk_get(NULL, "uart1_ick"); -+ info->uart_fclk = clk_get(NULL, "uart1_fck"); -+ } -+ /* FIXME: Use platform_get_resource for the port */ -+ info->uart_base = ioremap(OMAP_UART1_BASE, 0x16); -+ if (!info->uart_base) -+ goto cleanup; -+ break; -+ case 2: -+ if (cpu_is_omap16xx()) { -+ irq = INT_UART2; -+ info->uart_fclk = clk_get(NULL, "uart2_ck"); -+ } else { -+ irq = INT_24XX_UART2_IRQ; -+ info->uart_iclk = clk_get(NULL, "uart2_ick"); -+ info->uart_fclk = clk_get(NULL, "uart2_fck"); -+ } -+ /* FIXME: Use platform_get_resource for the port */ -+ info->uart_base = ioremap(OMAP_UART2_BASE, 0x16); -+ if (!info->uart_base) -+ goto cleanup; -+ break; -+ case 3: -+ if (cpu_is_omap16xx()) { -+ irq = INT_UART3; -+ info->uart_fclk = clk_get(NULL, "uart3_ck"); -+ } else { -+ irq = INT_24XX_UART3_IRQ; -+ info->uart_iclk = clk_get(NULL, "uart3_ick"); -+ info->uart_fclk = clk_get(NULL, "uart3_fck"); -+ } -+ /* FIXME: Use platform_get_resource for the port */ -+ info->uart_base = ioremap(OMAP_UART3_BASE, 0x16); -+ if (!info->uart_base) -+ goto cleanup; -+ break; -+ default: -+ dev_err(info->dev, "No uart defined\n"); -+ goto cleanup; -+ } -+ -+ info->irq = irq; -+ err = request_irq(irq, hci_h4p_interrupt, 0, "hci_h4p", (void *)info); -+ if (err < 0) { -+ dev_err(info->dev, "hci_h4p: unable to get IRQ %d\n", irq); -+ goto cleanup; -+ } -+ -+ err = request_irq(gpio_to_irq(info->host_wakeup_gpio), -+ hci_h4p_wakeup_interrupt, -+ IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING, -+ "hci_h4p_wkup", (void *)info); -+ if (err < 0) { -+ dev_err(info->dev, "hci_h4p: unable to get wakeup IRQ %d\n", -+ gpio_to_irq(info->host_wakeup_gpio)); -+ free_irq(irq, (void *)info); -+ goto cleanup; -+ } -+ -+ hci_h4p_set_clk(info, &info->tx_clocks_en, 1); -+ hci_h4p_set_auto_ctsrts(info, 0, UART_EFR_CTS | UART_EFR_RTS); -+ err = hci_h4p_init_uart(info); -+ if (err < 0) -+ goto cleanup_irq; -+ err = hci_h4p_reset(info); -+ if (err < 0) -+ goto cleanup_irq; -+ err = hci_h4p_wait_for_cts(info, 1, 10); -+ if (err < 0) -+ goto cleanup_irq; -+ hci_h4p_set_clk(info, &info->tx_clocks_en, 0); -+ -+ platform_set_drvdata(pdev, info); -+ err = hci_h4p_sysfs_create_files(info->dev); -+ if (err < 0) -+ goto cleanup_irq; -+ -+ if (hci_h4p_register_hdev(info) < 0) { -+ dev_err(info->dev, "failed to register hci_h4p hci device\n"); -+ goto cleanup_irq; -+ } -+ gpio_set_value(info->reset_gpio, 0); -+ -+ return 0; -+ -+cleanup_irq: -+ free_irq(irq, (void *)info); -+ free_irq(gpio_to_irq(info->host_wakeup_gpio), (void *)info); -+cleanup: -+ gpio_set_value(info->reset_gpio, 0); -+ gpio_free(info->reset_gpio); -+ gpio_free(info->bt_wakeup_gpio); -+ gpio_free(info->host_wakeup_gpio); -+ kfree(info); -+ -+ return err; -+ -+} -+ -+static int hci_h4p_remove(struct platform_device *dev) -+{ -+ struct hci_h4p_info *info; -+ -+ info = platform_get_drvdata(dev); -+ -+ hci_h4p_hci_close(info->hdev); -+ free_irq(gpio_to_irq(info->host_wakeup_gpio), (void *) info); -+ hci_free_dev(info->hdev); -+ gpio_free(info->reset_gpio); -+ gpio_free(info->bt_wakeup_gpio); -+ gpio_free(info->host_wakeup_gpio); -+ free_irq(info->irq, (void *) info); -+ kfree(info); -+ -+ return 0; -+} -+ -+static struct platform_driver hci_h4p_driver = { -+ .probe = hci_h4p_probe, -+ .remove = hci_h4p_remove, -+ .driver = { -+ .name = "hci_h4p", -+ }, -+}; -+ -+static int __init hci_h4p_init(void) -+{ -+ int err = 0; -+ -+ /* Register the driver with LDM */ -+ err = platform_driver_register(&hci_h4p_driver); -+ if (err < 0) -+ printk(KERN_WARNING "failed to register hci_h4p driver\n"); -+ -+ return err; -+} -+ -+static void __exit hci_h4p_exit(void) -+{ -+ platform_driver_unregister(&hci_h4p_driver); -+} -+ -+module_init(hci_h4p_init); -+module_exit(hci_h4p_exit); -+ -+MODULE_DESCRIPTION("h4 driver with nokia extensions"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Ville Tervo"); ---- /dev/null -+++ b/drivers/bluetooth/hci_h4p/fw.c -@@ -0,0 +1,155 @@ -+/* -+ * This file is part of hci_h4p bluetooth driver -+ * -+ * Copyright (C) 2005, 2006 Nokia Corporation. -+ * -+ * Contact: Ville Tervo <ville.tervo@nokia.com> -+ * -+ * 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. -+ * -+ * This program is distributed in the hope that it will be useful, but -+ * WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA -+ * 02110-1301 USA -+ * -+ */ -+ -+#include <linux/skbuff.h> -+#include <linux/firmware.h> -+#include <linux/clk.h> -+ -+#include <net/bluetooth/bluetooth.h> -+ -+#include "hci_h4p.h" -+ -+#define BT_CHIP_TI 2 -+#define BT_CHIP_CSR 1 -+ -+static int fw_pos; -+ -+/* Firmware handling */ -+static int hci_h4p_open_firmware(struct hci_h4p_info *info, -+ const struct firmware **fw_entry) -+{ -+ int err; -+ -+ fw_pos = 0; -+ NBT_DBG_FW("Opening %d firmware\n", info->chip_type); -+ switch (info->chip_type) { -+ case BT_CHIP_TI: -+ err = request_firmware(fw_entry, "brf6150fw.bin", info->dev); -+ break; -+ case BT_CHIP_CSR: -+ err = request_firmware(fw_entry, "bc4fw.bin", info->dev); -+ break; -+ default: -+ dev_err(info->dev, "Invalid chip type\n"); -+ *fw_entry = NULL; -+ err = -EINVAL; -+ } -+ -+ return err; -+} -+ -+static void hci_h4p_close_firmware(const struct firmware *fw_entry) -+{ -+ release_firmware(fw_entry); -+} -+ -+/* Read fw. Return length of the command. If no more commands in -+ * fw 0 is returned. In error case return value is negative. -+ */ -+static int hci_h4p_read_fw_cmd(struct hci_h4p_info *info, struct sk_buff **skb, -+ const struct firmware *fw_entry, int how) -+{ -+ unsigned int cmd_len; -+ -+ if (fw_pos >= fw_entry->size) { -+ return 0; -+ } -+ -+ cmd_len = fw_entry->data[fw_pos++]; -+ if (!cmd_len) -+ return 0; -+ -+ if (fw_pos + cmd_len > fw_entry->size) { -+ dev_err(info->dev, "Corrupted firmware image\n"); -+ return -EMSGSIZE; -+ } -+ -+ *skb = bt_skb_alloc(cmd_len, how); -+ if (!*skb) { -+ dev_err(info->dev, "Cannot reserve memory for buffer\n"); -+ return -ENOMEM; -+ } -+ memcpy(skb_put(*skb, cmd_len), &fw_entry->data[fw_pos], cmd_len); -+ -+ fw_pos += cmd_len; -+ -+ return (*skb)->len; -+} -+ -+int hci_h4p_read_fw(struct hci_h4p_info *info, struct sk_buff_head *fw_queue) -+{ -+ const struct firmware *fw_entry = NULL; -+ struct sk_buff *skb = NULL; -+ int err; -+ -+ err = hci_h4p_open_firmware(info, &fw_entry); -+ if (err < 0 || !fw_entry) -+ goto err_clean; -+ -+ while ((err = hci_h4p_read_fw_cmd(info, &skb, fw_entry, GFP_KERNEL))) { -+ if (err < 0 || !skb) -+ goto err_clean; -+ -+ skb_queue_tail(fw_queue, skb); -+ } -+ -+err_clean: -+ hci_h4p_close_firmware(fw_entry); -+ return err; -+} -+ -+int hci_h4p_send_fw(struct hci_h4p_info *info, struct sk_buff_head *fw_queue) -+{ -+ int err; -+ -+ switch(info->chip_type) { -+ case BT_CHIP_CSR: -+ err = hci_h4p_bc4_send_fw(info, fw_queue); -+ break; -+ case BT_CHIP_TI: -+ err = hci_h4p_brf6150_send_fw(info, fw_queue); -+ break; -+ default: -+ dev_err(info->dev, "Don't know how to send firmware\n"); -+ err = -EINVAL; -+ } -+ -+ return err; -+} -+ -+void hci_h4p_parse_fw_event(struct hci_h4p_info *info, struct sk_buff *skb) -+{ -+ switch (info->chip_type) { -+ case BT_CHIP_CSR: -+ hci_h4p_bc4_parse_fw_event(info, skb); -+ break; -+ case BT_CHIP_TI: -+ hci_h4p_brf6150_parse_fw_event(info, skb); -+ break; -+ default: -+ dev_err(info->dev, "Don't know how to parse fw event\n"); -+ info->fw_error = -EINVAL; -+ } -+ -+ return; -+} ---- /dev/null -+++ b/drivers/bluetooth/hci_h4p/fw-csr.c -@@ -0,0 +1,149 @@ -+/* -+ * This file is part of hci_h4p bluetooth driver -+ * -+ * Copyright (C) 2005, 2006 Nokia Corporation. -+ * -+ * Contact: Ville Tervo <ville.tervo@nokia.com> -+ * -+ * 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. -+ * -+ * This program is distributed in the hope that it will be useful, but -+ * WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA -+ * 02110-1301 USA -+ * -+ */ -+ -+#include <linux/skbuff.h> -+#include <linux/delay.h> -+#include <linux/serial_reg.h> -+ -+#include "hci_h4p.h" -+ -+void hci_h4p_bc4_parse_fw_event(struct hci_h4p_info *info, struct sk_buff *skb) -+{ -+ /* Check if this is fw packet */ -+ if (skb->data[0] != 0xff) { -+ hci_recv_frame(skb); -+ return; -+ } -+ -+ if (skb->data[11] || skb->data[12]) { -+ dev_err(info->dev, "Firmware sending command failed\n"); -+ info->fw_error = -EPROTO; -+ } -+ -+ kfree_skb(skb); -+ complete(&info->fw_completion); -+} -+ -+int hci_h4p_bc4_send_fw(struct hci_h4p_info *info, -+ struct sk_buff_head *fw_queue) -+{ -+ struct sk_buff *skb; -+ unsigned int offset; -+ int retries, count, i; -+ -+ info->fw_error = 0; -+ -+ NBT_DBG_FW("Sending firmware\n"); -+ skb = skb_dequeue(fw_queue); -+ -+ if (!skb) -+ return -ENOMSG; -+ -+ info->bdaddr[0] = 0x00; -+ info->bdaddr[1] = 0x1D; -+ info->bdaddr[2] = 0x6E; -+ info->bdaddr[3] = 0xD4; -+ info->bdaddr[4] = 0xF0; -+ info->bdaddr[5] = 0x37; -+ -+ /* Check if this is bd_address packet */ -+ if (skb->data[15] == 0x01 && skb->data[16] == 0x00) { -+ dev_info(info->dev, "bd_address packet found\n"); -+ offset = 21; -+ skb->data[offset + 1] = 0x00; -+ skb->data[offset + 5] = 0x00; -+ skb->data[offset + 7] = info->bdaddr[0]; -+ skb->data[offset + 6] = info->bdaddr[1]; -+ skb->data[offset + 4] = info->bdaddr[2]; -+ skb->data[offset + 0] = info->bdaddr[3]; -+ skb->data[offset + 3] = info->bdaddr[4]; -+ skb->data[offset + 2] = info->bdaddr[5]; -+ } -+ -+ for (i = 0; i < 6; i++) { -+ if (info->bdaddr[i] != 0x00) -+ break; -+ } -+ -+ /* if (i > 5) { -+ dev_info(info->dev, "Valid bluetooth address not found.\n"); -+ kfree_skb(skb); -+ return -ENODEV; -+ } */ -+ -+ for (count = 1; ; count++) { -+ NBT_DBG_FW("Sending firmware command %d\n", count); -+ init_completion(&info->fw_completion); -+ skb_queue_tail(&info->txq, skb); -+ tasklet_schedule(&info->tx_task); -+ -+ skb = skb_dequeue(fw_queue); -+ if (!skb) -+ break; -+ -+ if (!wait_for_completion_timeout(&info->fw_completion, -+ msecs_to_jiffies(1000))) { -+ dev_err(info->dev, "No reply to fw command\n"); -+ return -ETIMEDOUT; -+ } -+ -+ if (info->fw_error) { -+ dev_err(info->dev, "FW error\n"); -+ return -EPROTO; -+ } -+ }; -+ -+ /* Wait for chip warm reset */ -+ retries = 100; -+ while ((!skb_queue_empty(&info->txq) || -+ !(hci_h4p_inb(info, UART_LSR) & UART_LSR_TEMT)) && -+ retries--) { -+ msleep(10); -+ } -+ if (!retries) { -+ dev_err(info->dev, "Transmitter not empty\n"); -+ return -ETIMEDOUT; -+ } -+ -+ hci_h4p_change_speed(info, BC4_MAX_BAUD_RATE); -+ -+ if (hci_h4p_wait_for_cts(info, 1, 100)) { -+ dev_err(info->dev, "cts didn't go down after final speed change\n"); -+ return -ETIMEDOUT; -+ } -+ -+ retries = 100; -+ do { -+ init_completion(&info->init_completion); -+ hci_h4p_send_alive_packet(info); -+ retries--; -+ } while (!wait_for_completion_timeout(&info->init_completion, 100) && -+ retries > 0); -+ -+ if (!retries) { -+ dev_err(info->dev, "No alive reply after speed change\n"); -+ return -ETIMEDOUT; -+ } -+ -+ return 0; -+} ---- /dev/null -+++ b/drivers/bluetooth/hci_h4p/fw-ti.c -@@ -0,0 +1,90 @@ -+/* -+ * This file is part of hci_h4p bluetooth driver -+ * -+ * Copyright (C) 2005, 2006 Nokia Corporation. -+ * -+ * Contact: Ville Tervo <ville.tervo@nokia.com> -+ * -+ * 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. -+ * -+ * This program is distributed in the hope that it will be useful, but -+ * WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA -+ * 02110-1301 USA -+ * -+ */ -+ -+#include <linux/skbuff.h> -+ -+#include "hci_h4p.h" -+ -+void hci_h4p_brf6150_parse_fw_event(struct hci_h4p_info *info, -+ struct sk_buff *skb) -+{ -+ struct hci_fw_event *ev; -+ int err = 0; -+ -+ if (bt_cb(skb)->pkt_type != H4_EVT_PKT) { -+ dev_err(info->dev, "Got non event fw packet.\n"); -+ err = -EPROTO; -+ goto ret; -+ } -+ -+ ev = (struct hci_fw_event *)skb->data; -+ if (ev->hev.evt != HCI_EV_CMD_COMPLETE) { -+ dev_err(info->dev, "Got non cmd complete fw event\n"); -+ err = -EPROTO; -+ goto ret; -+ } -+ -+ if (ev->status != 0) { -+ dev_err(info->dev, "Got error status from fw command\n"); -+ err = -EPROTO; -+ goto ret; -+ } -+ -+ret: -+ info->fw_error = err; -+ complete(&info->fw_completion); -+} -+ -+int hci_h4p_brf6150_send_fw(struct hci_h4p_info *info, struct sk_buff_head *fw_queue) -+{ -+ struct sk_buff *skb; -+ int err = 0; -+ -+ info->fw_error = 0; -+ -+ while ((skb = skb_dequeue(fw_queue)) != NULL) { -+ /* We should allways send word aligned data to h4+ devices */ -+ if (skb->len % 2) { -+ err = skb_pad(skb, 1); -+ } -+ if (err) -+ return err; -+ -+ init_completion(&info->fw_completion); -+ skb_queue_tail(&info->txq, skb); -+ tasklet_schedule(&info->tx_task); -+ -+ if (!wait_for_completion_timeout(&info->fw_completion, HZ)) { -+ dev_err(info->dev, "Timeout while sending brf6150 fw\n"); -+ return -ETIMEDOUT; -+ } -+ -+ if (info->fw_error) { -+ dev_err(info->dev, "There was fw_error while sending bfr6150 fw\n"); -+ return -EPROTO; -+ } -+ } -+ NBT_DBG_FW("Firmware sent\n"); -+ -+ return 0; -+} ---- /dev/null -+++ b/drivers/bluetooth/hci_h4p/hci_h4p.h -@@ -0,0 +1,183 @@ -+/* -+ * This file is part of hci_h4p bluetooth driver -+ * -+ * Copyright (C) 2005, 2006 Nokia Corporation. -+ * -+ * Contact: Ville Tervo <ville.tervo@nokia.com> -+ * -+ * 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. -+ * -+ * This program is distributed in the hope that it will be useful, but -+ * WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA -+ * 02110-1301 USA -+ * -+ */ -+ -+#include <mach/board.h> -+ -+#include <net/bluetooth/bluetooth.h> -+#include <net/bluetooth/hci_core.h> -+#include <net/bluetooth/hci.h> -+ -+#ifndef __DRIVERS_BLUETOOTH_HCI_H4P_H -+#define __DRIVERS_BLUETOOTH_HCI_H4P_H -+ -+#define UART_SYSC_OMAP_RESET 0x03 -+#define UART_SYSS_RESETDONE 0x01 -+#define UART_OMAP_SCR_EMPTY_THR 0x08 -+#define UART_OMAP_SCR_WAKEUP 0x10 -+#define UART_OMAP_SSR_WAKEUP 0x02 -+#define UART_OMAP_SSR_TXFULL 0x01 -+ -+#if 0 -+#define NBT_DBG(fmt, arg...) printk("%s: " fmt "" , __FUNCTION__ , ## arg) -+#else -+#define NBT_DBG(...) -+#endif -+ -+#if 0 -+#define NBT_DBG_FW(fmt, arg...) printk("%s: " fmt "" , __FUNCTION__ , ## arg) -+#else -+#define NBT_DBG_FW(...) -+#endif -+ -+#if 0 -+#define NBT_DBG_POWER(fmt, arg...) printk("%s: " fmt "" , __FUNCTION__ , ## arg) -+#else -+#define NBT_DBG_POWER(...) -+#endif -+ -+#if 0 -+#define NBT_DBG_TRANSFER(fmt, arg...) printk("%s: " fmt "" , __FUNCTION__ , ## arg) -+#else -+#define NBT_DBG_TRANSFER(...) -+#endif -+ -+#if 0 -+#define NBT_DBG_TRANSFER_NF(fmt, arg...) printk(fmt "" , ## arg) -+#else -+#define NBT_DBG_TRANSFER_NF(...) -+#endif -+ -+#if 0 -+#define NBT_DBG_DMA(fmt, arg...) printk("%s: " fmt "" , __FUNCTION__ , ## arg) -+#else -+#define NBT_DBG_DMA(...) -+#endif -+ -+struct hci_h4p_info { -+ struct hci_dev *hdev; -+ spinlock_t lock; -+ -+ void __iomem *uart_base; -+ unsigned long uart_phys_base; -+ int irq; -+ struct device *dev; -+ u8 bdaddr[6]; -+ u8 chip_type; -+ u8 bt_wakeup_gpio; -+ u8 host_wakeup_gpio; -+ u8 reset_gpio; -+ u8 bt_sysclk; -+ -+ -+ struct sk_buff_head fw_queue; -+ struct sk_buff *alive_cmd_skb; -+ struct completion init_completion; -+ struct completion fw_completion; -+ int fw_error; -+ int init_error; -+ -+ struct sk_buff_head txq; -+ struct tasklet_struct tx_task; -+ -+ struct sk_buff *rx_skb; -+ long rx_count; -+ unsigned long rx_state; -+ unsigned long garbage_bytes; -+ struct tasklet_struct rx_task; -+ -+ int pm_enabled; -+ int tx_pm_enabled; -+ int rx_pm_enabled; -+ struct timer_list tx_pm_timer; -+ struct timer_list rx_pm_timer; -+ -+ int tx_clocks_en; -+ int rx_clocks_en; -+ spinlock_t clocks_lock; -+ struct clk *uart_iclk; -+ struct clk *uart_fclk; -+}; -+ -+#define MAX_BAUD_RATE 921600 -+#define BC4_MAX_BAUD_RATE 3692300 -+#define UART_CLOCK 48000000 -+#define BT_INIT_DIVIDER 320 -+#define BT_BAUDRATE_DIVIDER 384000000 -+#define BT_SYSCLK_DIV 1000 -+#define INIT_SPEED 120000 -+ -+#define H4_TYPE_SIZE 1 -+ -+/* H4+ packet types */ -+#define H4_CMD_PKT 0x01 -+#define H4_ACL_PKT 0x02 -+#define H4_SCO_PKT 0x03 -+#define H4_EVT_PKT 0x04 -+#define H4_NEG_PKT 0x06 -+#define H4_ALIVE_PKT 0x07 -+ -+/* TX states */ -+#define WAIT_FOR_PKT_TYPE 1 -+#define WAIT_FOR_HEADER 2 -+#define WAIT_FOR_DATA 3 -+ -+struct hci_fw_event { -+ struct hci_event_hdr hev; -+ struct hci_ev_cmd_complete cmd; -+ u8 status; -+} __attribute__ ((packed)); -+ -+struct hci_bc4_set_bdaddr { -+ u8 type; -+ struct hci_command_hdr cmd_hdr; -+} __attribute__ ((packed)); -+ -+int hci_h4p_send_alive_packet(struct hci_h4p_info *info); -+ -+void hci_h4p_bc4_parse_fw_event(struct hci_h4p_info *info, -+ struct sk_buff *skb); -+int hci_h4p_bc4_send_fw(struct hci_h4p_info *info, -+ struct sk_buff_head *fw_queue); -+ -+void hci_h4p_brf6150_parse_fw_event(struct hci_h4p_info *info, -+ struct sk_buff *skb); -+int hci_h4p_brf6150_send_fw(struct hci_h4p_info *info, -+ struct sk_buff_head *fw_queue); -+ -+int hci_h4p_read_fw(struct hci_h4p_info *info, struct sk_buff_head *fw_queue); -+int hci_h4p_send_fw(struct hci_h4p_info *info, struct sk_buff_head *fw_queue); -+void hci_h4p_parse_fw_event(struct hci_h4p_info *info, struct sk_buff *skb); -+ -+int hci_h4p_sysfs_create_files(struct device *dev); -+ -+void hci_h4p_outb(struct hci_h4p_info *info, unsigned int offset, u8 val); -+u8 hci_h4p_inb(struct hci_h4p_info *info, unsigned int offset); -+void hci_h4p_set_rts(struct hci_h4p_info *info, int active); -+int hci_h4p_wait_for_cts(struct hci_h4p_info *info, int active, int timeout_ms); -+void __hci_h4p_set_auto_ctsrts(struct hci_h4p_info *info, int on, u8 which); -+void hci_h4p_set_auto_ctsrts(struct hci_h4p_info *info, int on, u8 which); -+void hci_h4p_change_speed(struct hci_h4p_info *info, unsigned long speed); -+int hci_h4p_reset_uart(struct hci_h4p_info *info); -+int hci_h4p_init_uart(struct hci_h4p_info *info); -+ -+#endif /* __DRIVERS_BLUETOOTH_HCI_H4P_H */ ---- /dev/null -+++ b/drivers/bluetooth/hci_h4p/Makefile -@@ -0,0 +1,7 @@ -+# -+# Makefile for the Linux Bluetooth HCI device drivers. -+# -+ -+obj-$(CONFIG_BT_HCIH4P) += hci_h4p.o -+ -+hci_h4p-objs := core.o fw.o uart.o sysfs.o fw-ti.o fw-csr.o ---- /dev/null -+++ b/drivers/bluetooth/hci_h4p/sysfs.c -@@ -0,0 +1,84 @@ -+/* -+ * This file is part of hci_h4p bluetooth driver -+ * -+ * Copyright (C) 2005, 2006 Nokia Corporation. -+ * -+ * Contact: Ville Tervo <ville.tervo@nokia.com> -+ * -+ * 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. -+ * -+ * This program is distributed in the hope that it will be useful, but -+ * WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA -+ * 02110-1301 USA -+ * -+ */ -+ -+#include <linux/kernel.h> -+#include <linux/init.h> -+#include <linux/device.h> -+#include <linux/platform_device.h> -+ -+#include "hci_h4p.h" -+ -+#ifdef CONFIG_SYSFS -+ -+static ssize_t hci_h4p_store_bdaddr(struct device *dev, struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct hci_h4p_info *info = (struct hci_h4p_info*)dev_get_drvdata(dev); -+ unsigned int bdaddr[6]; -+ int ret, i; -+ -+ dev_info(info->dev, "HCI_H4P_STORE_BDADDR called\n"); -+ -+ ret = sscanf(buf, "%2x:%2x:%2x:%2x:%2x:%2x\n", -+ &bdaddr[0], &bdaddr[1], &bdaddr[2], -+ &bdaddr[3], &bdaddr[4], &bdaddr[5]); -+ -+ if (ret != 6) { -+ dev_info(info->dev, "bdaddr isn't found\n"); -+ return -EINVAL; -+ } -+ -+ //for (i = 0; i < 6; i++) -+ //info->bdaddr[i] = bdaddr[i] & 0xff; -+ -+ info->bdaddr[0] = 0x00; -+ info->bdaddr[1] = 0x1D; -+ info->bdaddr[2] = 0x6E; -+ info->bdaddr[3] = 0xD4; -+ info->bdaddr[4] = 0xF0; -+ info->bdaddr[5] = 0x37; -+ -+ return count; -+} -+ -+static ssize_t hci_h4p_show_bdaddr(struct device *dev, struct device_attribute *attr, -+ char *buf) -+{ -+ struct hci_h4p_info *info = (struct hci_h4p_info*)dev_get_drvdata(dev); -+ -+ return sprintf(buf, "%.2x:%.2x:%.2x:%.2x:%.2x:%.2x\n", -+ info->bdaddr[0], -+ info->bdaddr[1], -+ info->bdaddr[2], -+ info->bdaddr[3], -+ info->bdaddr[4], -+ info->bdaddr[5]); -+} -+ -+static DEVICE_ATTR(bdaddr, S_IRUGO | S_IWUSR, hci_h4p_show_bdaddr, hci_h4p_store_bdaddr); -+int hci_h4p_sysfs_create_files(struct device *dev) -+{ -+ return device_create_file(dev, &dev_attr_bdaddr); -+} -+ -+#endif ---- /dev/null -+++ b/drivers/bluetooth/hci_h4p/uart.c -@@ -0,0 +1,169 @@ -+/* -+ * This file is part of hci_h4p bluetooth driver -+ * -+ * Copyright (C) 2005, 2006 Nokia Corporation. -+ * -+ * Contact: Ville Tervo <ville.tervo@nokia.com> -+ * -+ * 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. -+ * -+ * This program is distributed in the hope that it will be useful, but -+ * WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA -+ * 02110-1301 USA -+ * -+ */ -+ -+#include <linux/serial_reg.h> -+#include <linux/delay.h> -+#include <linux/clk.h> -+ -+#include <asm/io.h> -+ -+#include "hci_h4p.h" -+ -+inline void hci_h4p_outb(struct hci_h4p_info *info, unsigned int offset, u8 val) -+{ -+ offset <<= 2; -+ __raw_writeb(val, info->uart_base + offset); -+ //outb(val, info->uart_base + (offset << 2)); -+} -+ -+inline u8 hci_h4p_inb(struct hci_h4p_info *info, unsigned int offset) -+{ -+ offset <<= 2; -+ return (u8)__raw_readb(info->uart_base + offset); -+ //return (unsigned int)__raw_readb(up->membase + offset); -+ //return inb(info->uart_base + (offset << 2)); -+} -+ -+void hci_h4p_set_rts(struct hci_h4p_info *info, int active) -+{ -+ u8 b; -+ -+ b = hci_h4p_inb(info, UART_MCR); -+ if (active) -+ b |= UART_MCR_RTS; -+ else -+ b &= ~UART_MCR_RTS; -+ hci_h4p_outb(info, UART_MCR, b); -+} -+ -+int hci_h4p_wait_for_cts(struct hci_h4p_info *info, int active, -+ int timeout_ms) -+{ -+ int okay; -+ unsigned long timeout; -+ -+ okay = 0; -+ timeout = jiffies + msecs_to_jiffies(timeout_ms); -+ for (;;) { -+ int state; -+ -+ state = hci_h4p_inb(info, UART_MSR) & UART_MSR_CTS; -+ if (active) { -+ if (state) -+ return 0; -+ } else { -+ if (!state) -+ return 0; -+ } -+ if (time_after(jiffies, timeout)) -+ return -ETIMEDOUT; -+ } -+} -+ -+void __hci_h4p_set_auto_ctsrts(struct hci_h4p_info *info, int on, u8 which) -+{ -+ u8 lcr, b; -+ -+ lcr = hci_h4p_inb(info, UART_LCR); -+ hci_h4p_outb(info, UART_LCR, 0xbf); -+ b = hci_h4p_inb(info, UART_EFR); -+ if (on) -+ b |= which; -+ else -+ b &= ~which; -+ hci_h4p_outb(info, UART_EFR, b); -+ hci_h4p_outb(info, UART_LCR, lcr); -+} -+ -+void hci_h4p_set_auto_ctsrts(struct hci_h4p_info *info, int on, u8 which) -+{ -+ unsigned long flags; -+ -+ spin_lock_irqsave(&info->lock, flags); -+ __hci_h4p_set_auto_ctsrts(info, on, which); -+ spin_unlock_irqrestore(&info->lock, flags); -+} -+ -+void hci_h4p_change_speed(struct hci_h4p_info *info, unsigned long speed) -+{ -+ unsigned int divisor; -+ u8 lcr, mdr1; -+ -+ NBT_DBG("Setting speed %lu\n", speed); -+ -+ if (speed >= 460800) { -+ divisor = UART_CLOCK / 13 / speed; -+ mdr1 = 3; -+ } else { -+ divisor = UART_CLOCK / 16 / speed; -+ mdr1 = 0; -+ } -+ -+ hci_h4p_outb(info, UART_OMAP_MDR1, 7); /* Make sure UART mode is disabled */ -+ lcr = hci_h4p_inb(info, UART_LCR); -+ hci_h4p_outb(info, UART_LCR, UART_LCR_DLAB); /* Set DLAB */ -+ hci_h4p_outb(info, UART_DLL, divisor & 0xff); /* Set speed */ -+ hci_h4p_outb(info, UART_DLM, divisor >> 8); -+ hci_h4p_outb(info, UART_LCR, lcr); -+ hci_h4p_outb(info, UART_OMAP_MDR1, mdr1); /* Make sure UART mode is enabled */ -+} -+ -+int hci_h4p_reset_uart(struct hci_h4p_info *info) -+{ -+ int count = 0; -+ -+ /* Reset the UART */ -+ hci_h4p_outb(info, UART_OMAP_SYSC, UART_SYSC_OMAP_RESET); -+ while (!(hci_h4p_inb(info, UART_OMAP_SYSS) & UART_SYSS_RESETDONE)) { -+ if (count++ > 20000) { -+ dev_err(info->dev, "hci_h4p: UART reset timeout\n"); -+ return -ENODEV; -+ } -+ udelay(1); -+ } -+ -+ return 0; -+} -+ -+int hci_h4p_init_uart(struct hci_h4p_info *info) -+{ -+ int err; -+ -+ err = hci_h4p_reset_uart(info); -+ if (err < 0) -+ return err; -+ -+ /* Enable and setup FIFO */ -+ hci_h4p_outb(info, UART_LCR, UART_LCR_WLEN8); -+ hci_h4p_outb(info, UART_OMAP_MDR1, 0x00); /* Make sure UART mode is enabled */ -+ hci_h4p_outb(info, UART_OMAP_SCR, 0x80); -+ hci_h4p_outb(info, UART_EFR, UART_EFR_ECB); -+ hci_h4p_outb(info, UART_MCR, UART_MCR_TCRTLR); -+ hci_h4p_outb(info, UART_TI752_TLR, 0x1f); -+ hci_h4p_outb(info, UART_TI752_TCR, 0xef); -+ hci_h4p_outb(info, UART_FCR, UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR | -+ UART_FCR_CLEAR_XMIT | UART_FCR_R_TRIG_00); -+ hci_h4p_outb(info, UART_IER, UART_IER_RDI); -+ -+ return 0; -+} ---- a/drivers/bluetooth/Kconfig -+++ b/drivers/bluetooth/Kconfig -@@ -173,6 +173,16 @@ config BT_HCIBTUART - Say Y here to compile support for HCI UART devices into the - kernel or say M to compile it as module (btuart_cs). - -+config BT_HCIH4P -+ tristate "HCI driver with H4 Nokia extensions" -+ depends on BT && ARCH_OMAP -+ help -+ Bluetooth HCI driver with H4 extensions. This driver provides -+ support for H4+ Bluetooth chip with vendor-specific H4 extensions. -+ -+ Say Y here to compile support for h4 extended devices into the kernel -+ or say M to compile it as module (hci_h4p). -+ - config BT_HCIVHCI - tristate "HCI VHCI (Virtual HCI device) driver" - help ---- a/drivers/bluetooth/Makefile -+++ b/drivers/bluetooth/Makefile -@@ -11,6 +11,7 @@ obj-$(CONFIG_BT_HCIDTL1) += dtl1_cs.o - obj-$(CONFIG_BT_HCIBT3C) += bt3c_cs.o - obj-$(CONFIG_BT_HCIBLUECARD) += bluecard_cs.o - obj-$(CONFIG_BT_HCIBTUART) += btuart_cs.o -+obj-$(CONFIG_BT_HCIH4P) += hci_h4p/ - - obj-$(CONFIG_BT_HCIBTUSB) += btusb.o - obj-$(CONFIG_BT_HCIBTSDIO) += btsdio.o diff --git a/target/linux/omap24xx/patches-3.3/410-hci-h4p-fixes.patch b/target/linux/omap24xx/patches-3.3/410-hci-h4p-fixes.patch deleted file mode 100644 index 6741511a88..0000000000 --- a/target/linux/omap24xx/patches-3.3/410-hci-h4p-fixes.patch +++ /dev/null @@ -1,46 +0,0 @@ ---- a/drivers/bluetooth/hci_h4p/core.c -+++ b/drivers/bluetooth/hci_h4p/core.c -@@ -36,9 +36,9 @@ - #include <linux/clk.h> - #include <linux/gpio.h> - --#include <mach/hardware.h> --#include <mach/board.h> --#include <mach/irqs.h> -+#include <plat/hardware.h> -+#include <plat/board.h> -+#include <plat/irqs.h> - #include <plat/serial.h> - - #include <net/bluetooth/bluetooth.h> ---- a/drivers/bluetooth/hci_h4p/hci_h4p.h -+++ b/drivers/bluetooth/hci_h4p/hci_h4p.h -@@ -21,7 +21,7 @@ - * - */ - --#include <mach/board.h> -+#include <plat/board.h> - - #include <net/bluetooth/bluetooth.h> - #include <net/bluetooth/hci_core.h> ---- a/drivers/bluetooth/hci_h4p/sysfs.c -+++ b/drivers/bluetooth/hci_h4p/sysfs.c -@@ -48,15 +48,8 @@ static ssize_t hci_h4p_store_bdaddr(stru - return -EINVAL; - } - -- //for (i = 0; i < 6; i++) -- //info->bdaddr[i] = bdaddr[i] & 0xff; -- -- info->bdaddr[0] = 0x00; -- info->bdaddr[1] = 0x1D; -- info->bdaddr[2] = 0x6E; -- info->bdaddr[3] = 0xD4; -- info->bdaddr[4] = 0xF0; -- info->bdaddr[5] = 0x37; -+ for (i = 0; i < 6; i++) -+ info->bdaddr[i] = bdaddr[i] & 0xff; - - return count; - } diff --git a/target/linux/omap24xx/patches-3.3/420-hci-h4p-interrupt-workaround.patch b/target/linux/omap24xx/patches-3.3/420-hci-h4p-interrupt-workaround.patch deleted file mode 100644 index 0d2b4d24fd..0000000000 --- a/target/linux/omap24xx/patches-3.3/420-hci-h4p-interrupt-workaround.patch +++ /dev/null @@ -1,36 +0,0 @@ ---- a/arch/arm/mach-omap2/omap_hwmod_2xxx_3xxx_ipblock_data.c -+++ b/arch/arm/mach-omap2/omap_hwmod_2xxx_3xxx_ipblock_data.c -@@ -235,7 +235,7 @@ struct omap_hwmod_irq_info omap2_timer11 - }; - - struct omap_hwmod_irq_info omap2_uart1_mpu_irqs[] = { -- { .irq = INT_24XX_UART1_IRQ, }, -+ { .irq = 0, }, - { .irq = -1 } - }; - ---- a/drivers/tty/serial/omap-serial.c -+++ b/drivers/tty/serial/omap-serial.c -@@ -517,8 +517,10 @@ static int serial_omap_startup(struct ua - /* - * Allocate the IRQ - */ -- retval = request_irq(up->port.irq, serial_omap_irq, up->port.irqflags, -- up->name, up); -+ retval = 0; -+ if (up->port.irq) -+ retval = request_irq(up->port.irq, serial_omap_irq, -+ up->port.irqflags, up->name, up); - if (retval) - return retval; - -@@ -629,7 +631,8 @@ static void serial_omap_shutdown(struct - } - - pm_runtime_put(&up->pdev->dev); -- free_irq(up->port.irq, up); -+ if (up->port.irq) -+ free_irq(up->port.irq, up); - } - - static inline void diff --git a/target/linux/omap24xx/patches-3.3/597-cbus-tahvo-usb-platform.patch b/target/linux/omap24xx/patches-3.3/597-cbus-tahvo-usb-platform.patch deleted file mode 100644 index a635a8784c..0000000000 --- a/target/linux/omap24xx/patches-3.3/597-cbus-tahvo-usb-platform.patch +++ /dev/null @@ -1,34 +0,0 @@ ---- a/arch/arm/mach-omap2/board-n8x0.c -+++ b/arch/arm/mach-omap2/board-n8x0.c -@@ -41,6 +41,7 @@ - #include <plat/mmc.h> - #include <plat/serial.h> - #include <plat/gpio-switch.h> -+#include <plat/usb.h> - - #include "mux.h" - -@@ -486,6 +487,14 @@ static struct musb_hdrc_platform_data tu - .config = &musb_config, - }; - -+static struct omap_usb_config n8x0_omap_usb_config __initdata = { -+ .otg = 1, -+ .register_host = 1, -+ .register_dev = 1, -+ .hmc_mode = 16, -+ .pins[0] = 6, -+}; -+ - static void __init n8x0_usb_init(void) - { - int ret = 0; -@@ -507,6 +516,8 @@ static void __init n8x0_usb_init(void) - if (ret != 0) - goto err; - -+ omap2_usbfs_init(&n8x0_omap_usb_config); -+ - printk(announce); - - return; diff --git a/target/linux/omap24xx/patches-3.3/710-evdev-events-without-grab.patch b/target/linux/omap24xx/patches-3.3/710-evdev-events-without-grab.patch deleted file mode 100644 index b4637595f9..0000000000 --- a/target/linux/omap24xx/patches-3.3/710-evdev-events-without-grab.patch +++ /dev/null @@ -1,31 +0,0 @@ ---- - drivers/input/evdev.c | 10 +++++++--- - 1 file changed, 7 insertions(+), 3 deletions(-) - ---- a/drivers/input/evdev.c -+++ b/drivers/input/evdev.c -@@ -92,7 +92,7 @@ static void evdev_event(struct input_han - unsigned int type, unsigned int code, int value) - { - struct evdev *evdev = handle->private; -- struct evdev_client *client; -+ struct evdev_client *client, *c; - struct input_event event; - - do_gettimeofday(&event.time); -@@ -103,9 +103,13 @@ static void evdev_event(struct input_han - rcu_read_lock(); - - client = rcu_dereference(evdev->grab); -- if (client) -+ if (client) { - evdev_pass_event(client, &event); -- else -+ /* Also pass events to clients that did not grab the device. */ -+ list_for_each_entry_rcu(c, &evdev->client_list, node) -+ if (c != client) -+ evdev_pass_event(c, &event); -+ } else - list_for_each_entry_rcu(client, &evdev->client_list, node) - evdev_pass_event(client, &event); - diff --git a/target/linux/omap24xx/patches-3.3/810-mmc-fixes.patch b/target/linux/omap24xx/patches-3.3/810-mmc-fixes.patch deleted file mode 100644 index 3dfb11661b..0000000000 --- a/target/linux/omap24xx/patches-3.3/810-mmc-fixes.patch +++ /dev/null @@ -1,50 +0,0 @@ ---- a/drivers/mmc/host/omap.c -+++ b/drivers/mmc/host/omap.c -@@ -1456,6 +1456,7 @@ static int __init mmc_omap_probe(struct - host->dma_ch = -1; - - host->irq = irq; -+ host->reg_shift = (cpu_is_omap7xx() ? 1 : 2); - host->phys_base = host->mem_res->start; - host->virt_base = ioremap(res->start, resource_size(res)); - if (!host->virt_base) -@@ -1495,7 +1496,9 @@ static int __init mmc_omap_probe(struct - } - } - -- host->reg_shift = (cpu_is_omap7xx() ? 1 : 2); -+ /* Make sure the detect workqueue was run at least once. */ -+ printk(KERN_INFO "OMAP-mmc: waiting for cards...\n"); -+ mmc_flush_scheduled_work(); - - return 0; - ---- a/drivers/mmc/core/core.c -+++ b/drivers/mmc/core/core.c -@@ -78,12 +78,13 @@ static int mmc_schedule_delayed_work(str - } - - /* -- * Internal function. Flush all scheduled work from the MMC work queue. -+ * Flush all scheduled work from the MMC work queue. - */ --static void mmc_flush_scheduled_work(void) -+void mmc_flush_scheduled_work(void) - { - flush_workqueue(workqueue); - } -+EXPORT_SYMBOL(mmc_flush_scheduled_work); - - #ifdef CONFIG_FAIL_MMC_REQUEST - ---- a/include/linux/mmc/host.h -+++ b/include/linux/mmc/host.h -@@ -445,6 +445,8 @@ static inline int mmc_boot_partition_acc - return !(host->caps2 & MMC_CAP2_BOOTPART_NOACC); - } - -+void mmc_flush_scheduled_work(void); -+ - #ifdef CONFIG_MMC_CLKGATE - void mmc_host_clk_hold(struct mmc_host *host); - void mmc_host_clk_release(struct mmc_host *host); diff --git a/target/linux/omap24xx/patches-3.3/830-omap2-serial-fixes.patch b/target/linux/omap24xx/patches-3.3/830-omap2-serial-fixes.patch deleted file mode 100644 index a80ee69411..0000000000 --- a/target/linux/omap24xx/patches-3.3/830-omap2-serial-fixes.patch +++ /dev/null @@ -1,23 +0,0 @@ ---- a/arch/arm/mach-omap2/serial.c -+++ b/arch/arm/mach-omap2/serial.c -@@ -258,6 +258,8 @@ char *cmdline_find_option(char *str) - return strstr(saved_command_line, str); - } - -+static struct omap_uart_state statebuf[4]; -+ - static int __init omap_serial_early_init(void) - { - do { -@@ -272,9 +274,9 @@ static int __init omap_serial_early_init - if (!oh) - break; - -- uart = kzalloc(sizeof(struct omap_uart_state), GFP_KERNEL); -- if (WARN_ON(!uart)) -+ if (WARN_ON(num_uarts >= ARRAY_SIZE(statebuf))) - return -ENODEV; -+ uart = &statebuf[num_uarts]; - - uart->oh = oh; - uart->num = num_uarts++; diff --git a/target/linux/omap24xx/patches-3.3/850-musb-tusb-modular-fixes.patch b/target/linux/omap24xx/patches-3.3/850-musb-tusb-modular-fixes.patch deleted file mode 100644 index 55a25a4aeb..0000000000 --- a/target/linux/omap24xx/patches-3.3/850-musb-tusb-modular-fixes.patch +++ /dev/null @@ -1,135 +0,0 @@ ---- a/drivers/usb/musb/tusb6010.c -+++ b/drivers/usb/musb/tusb6010.c -@@ -221,6 +221,7 @@ void musb_write_fifo(struct musb_hw_ep * - if (len > 0) - tusb_fifo_write_unaligned(fifo, buf, len); - } -+EXPORT_SYMBOL(musb_write_fifo); - - void musb_read_fifo(struct musb_hw_ep *hw_ep, u16 len, u8 *buf) - { -@@ -268,6 +269,7 @@ void musb_read_fifo(struct musb_hw_ep *h - if (len > 0) - tusb_fifo_read_unaligned(fifo, buf, len); - } -+EXPORT_SYMBOL(musb_read_fifo); - - static struct musb *the_musb; - -@@ -1165,7 +1167,7 @@ static const struct musb_platform_ops tu - - static u64 tusb_dmamask = DMA_BIT_MASK(32); - --static int __init tusb_probe(struct platform_device *pdev) -+static int tusb_probe(struct platform_device *pdev) - { - struct musb_hdrc_platform_data *pdata = pdev->dev.platform_data; - struct platform_device *musb; -@@ -1245,18 +1247,18 @@ static struct platform_driver tusb_drive - }, - }; - --MODULE_DESCRIPTION("TUSB6010 MUSB Glue Layer"); --MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>"); --MODULE_LICENSE("GPL v2"); -+//MODULE_DESCRIPTION("TUSB6010 MUSB Glue Layer"); -+//MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>"); -+//MODULE_LICENSE("GPL v2"); - --static int __init tusb_init(void) -+int musb_hdrc_glue_init(void) - { - return platform_driver_probe(&tusb_driver, tusb_probe); - } --subsys_initcall(tusb_init); -+EXPORT_SYMBOL(musb_hdrc_glue_init); - --static void __exit tusb_exit(void) -+void musb_hdrc_glue_exit(void) - { - platform_driver_unregister(&tusb_driver); - } --module_exit(tusb_exit); -+EXPORT_SYMBOL(musb_hdrc_glue_exit); ---- a/drivers/usb/musb/musb_core.c -+++ b/drivers/usb/musb/musb_core.c -@@ -207,7 +207,7 @@ static struct otg_io_access_ops musb_ulp - - /*-------------------------------------------------------------------------*/ - --#if !defined(CONFIG_USB_MUSB_TUSB6010) && !defined(CONFIG_USB_MUSB_BLACKFIN) -+#if !defined(CONFIG_USB_MUSB_TUSB6010) && !defined(CONFIG_USB_MUSB_TUSB6010_MODULE) && !defined(CONFIG_USB_MUSB_BLACKFIN) - - /* - * Load an endpoint's FIFO -@@ -250,7 +250,7 @@ void musb_write_fifo(struct musb_hw_ep * - } - } - --#if !defined(CONFIG_USB_MUSB_AM35X) -+#if !defined(CONFIG_USB_MUSB_AM35X) && !defined(CONFIG_USB_MUSB_TUSB6010) && !defined(CONFIG_USB_MUSB_TUSB6010_MODULE) - /* - * Unload an endpoint's FIFO - */ -@@ -2370,8 +2370,13 @@ static struct platform_driver musb_drive - - /*-------------------------------------------------------------------------*/ - -+extern int musb_hdrc_glue_init(void); -+extern void musb_hdrc_glue_exit(void); -+ - static int __init musb_init(void) - { -+ int err; -+ - if (usb_disabled()) - return 0; - -@@ -2380,7 +2385,17 @@ static int __init musb_init(void) - ", " - "otg (peripheral+host)", - musb_driver_name); -- return platform_driver_probe(&musb_driver, musb_probe); -+ -+ err = musb_hdrc_glue_init(); -+ if (err) -+ return err; -+ err = platform_driver_probe(&musb_driver, musb_probe); -+ if (err) { -+ musb_hdrc_glue_exit(); -+ return err; -+ } -+ -+ return 0; - } - - /* make us init after usbcore and i2c (transceivers, regulators, etc) -@@ -2391,5 +2406,6 @@ fs_initcall(musb_init); - static void __exit musb_cleanup(void) - { - platform_driver_unregister(&musb_driver); -+ musb_hdrc_glue_exit(); - } - module_exit(musb_cleanup); ---- a/drivers/usb/Makefile -+++ b/drivers/usb/Makefile -@@ -51,7 +51,7 @@ obj-$(CONFIG_EARLY_PRINTK_DBGP) += early - obj-$(CONFIG_USB_ATM) += atm/ - obj-$(CONFIG_USB_SPEEDTOUCH) += atm/ - --obj-$(CONFIG_USB_MUSB_HDRC) += musb/ -+obj-y += musb/ - obj-$(CONFIG_USB_RENESAS_USBHS) += renesas_usbhs/ - obj-$(CONFIG_USB_GADGET) += gadget/ - ---- a/drivers/usb/musb/Makefile -+++ b/drivers/usb/musb/Makefile -@@ -13,7 +13,7 @@ musb_hdrc-$(CONFIG_DEBUG_FS) += musb_d - # Hardware Glue Layer - obj-$(CONFIG_USB_MUSB_OMAP2PLUS) += omap2430.o - obj-$(CONFIG_USB_MUSB_AM35X) += am35x.o --obj-$(CONFIG_USB_MUSB_TUSB6010) += tusb6010.o -+musb_hdrc-$(subst m,y,$(CONFIG_USB_MUSB_TUSB6010)) += tusb6010.o - obj-$(CONFIG_USB_MUSB_DAVINCI) += davinci.o - obj-$(CONFIG_USB_MUSB_DA8XX) += da8xx.o - obj-$(CONFIG_USB_MUSB_BLACKFIN) += blackfin.o diff --git a/target/linux/omap24xx/patches-3.3/900-n810-battery-management.patch b/target/linux/omap24xx/patches-3.3/900-n810-battery-management.patch deleted file mode 100644 index bdec65f777..0000000000 --- a/target/linux/omap24xx/patches-3.3/900-n810-battery-management.patch +++ /dev/null @@ -1,1917 +0,0 @@ ---- a/drivers/cbus/Kconfig -+++ b/drivers/cbus/Kconfig -@@ -83,4 +83,12 @@ config CBUS_RETU_HEADSET - - endif # CBUS_RETU - -+config N810BM -+ depends on CBUS_RETU && CBUS_TAHVO -+ tristate "Nokia n810 battery management" -+ ---help--- -+ Nokia n810 device battery management. -+ -+ If unsure, say N. -+ - endmenu ---- a/drivers/cbus/Makefile -+++ b/drivers/cbus/Makefile -@@ -11,3 +11,6 @@ obj-$(CONFIG_CBUS_RETU_POWERBUTTON) += r - obj-$(CONFIG_CBUS_RETU_RTC) += retu-rtc.o - obj-$(CONFIG_CBUS_RETU_WDT) += retu-wdt.o - obj-$(CONFIG_CBUS_RETU_HEADSET) += retu-headset.o -+n810bm-y += n810bm_main.o -+n810bm-y += lipocharge.o -+obj-$(CONFIG_N810BM) += n810bm.o ---- /dev/null -+++ b/drivers/cbus/n810bm_main.c -@@ -0,0 +1,1572 @@ -+/* -+ * Nokia n810 battery management -+ * -+ * WARNING: This driver is based on unconfirmed documentation. -+ * It is possibly dangerous to use this software. -+ * Use this software at your own risk! -+ * -+ * Copyright (c) 2010-2011 Michael Buesch <mb@bu3sch.de> -+ * -+ * This program is free software; you can redistribute it and/or -+ * modify it under the terms of the GNU General Public License -+ * as published by the Free Software Foundation; either version 2 -+ * of the License, or (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ */ -+ -+#define DEBUG -+ -+#include <linux/module.h> -+#include <linux/device.h> -+#include <linux/platform_device.h> -+#include <linux/slab.h> -+#include <linux/mutex.h> -+#include <linux/timer.h> -+#include <linux/firmware.h> -+#include <linux/bitops.h> -+#include <linux/workqueue.h> -+#include <linux/delay.h> -+#include <linux/interrupt.h> -+ -+#include "cbus.h" -+#include "retu.h" -+#include "tahvo.h" -+#include "lipocharge.h" -+ -+ -+#define N810BM_PMM_BLOCK_FILENAME "n810-cal-bme-pmm.fw" -+#define N810BM_PMM_BLOCK_SIZE 0x600 -+#define N810BM_PMM_GROUP_SIZE 0x200 -+#define N810BM_PMM_ELEM_SIZE 0x10 -+ -+#define N810BM_CHECK_INTERVAL (HZ * 2) -+#define N810BM_MIN_VOLTAGE_THRES 3200 /* Absolute minimum voltage threshold */ -+ -+ -+/* RETU_ADC_BSI -+ * The battery size indicator ADC measures the resistance between -+ * the battery BSI pin and ground. This is used to detect the battery -+ * capacity, as the BSI resistor is related to capacity. -+ * -+ * Manually measured lookup table. -+ * Hard to measure, thus not very accurate. -+ * -+ * Resistance | ADC value -+ * ======================== -+ * 120k | 0x3AC -+ * 110k | 0x37C -+ * 100k | 0x351 -+ * 90k | 0x329 -+ */ -+ -+/* RETU_ADC_BATTVOLT -+ * Manually measured lookup table. -+ * Hard to measure, thus not very accurate. -+ * -+ * Voltage | ADC value -+ * ===================== -+ * 2.80V | 0x037 -+ * 2.90V | 0x05E -+ * 3.00V | 0x090 -+ * 3.10V | 0x0A4 -+ * 3.20V | 0x0CC -+ * 3.30V | 0x0EF -+ * 3.40V | 0x115 -+ * 3.50V | 0x136 -+ * 3.60V | 0x15C -+ * 3.70V | 0x187 -+ * 3.80V | 0x1A5 -+ * 3.90V | 0x1C9 -+ * 4.00V | 0x1ED -+ * 4.10V | 0x212 -+ * 4.20V | 0x236 -+ */ -+ -+ -+/* PMM block ADC IDs */ -+enum n810bm_pmm_adc_id { -+ N810BM_PMM_ADC_BATVOLT = 0x01, /* Battery voltage */ -+ N810BM_PMM_ADC_CHGVOLT = 0x02, /* Charger voltage */ -+ N810BM_PMM_ADC_GND2 = 0x03, /* Ground 0V */ -+ N810BM_PMM_ADC_BSI = 0x04, /* Battery size indicator */ -+ N810BM_PMM_ADC_BATTEMP = 0x05, /* Battery temperature */ -+ N810BM_PMM_ADC_HEADSET = 0x06, /* Headset detection */ -+ N810BM_PMM_ADC_HOOKDET = 0x07, /* Hook detection */ -+ N810BM_PMM_ADC_LIGHTSENS = 0x08, /* Light sensor */ -+ N810BM_PMM_ADC_BATCURR = 0x0E, /* Battery current */ -+ N810BM_PMM_ADC_BKUPVOLT = 0x13, /* Backup battery voltage */ -+ N810BM_PMM_ADC_LIGHTTEMP = 0x14, /* Light sensor temperature */ -+ N810BM_PMM_ADC_RFGP = 0x15, /* RF GP */ -+ N810BM_PMM_ADC_WBTX = 0x16, /* Wideband TX detection */ -+ N810BM_PMM_ADC_RETUTEMP = 0x17, /* RETU chip temperature */ -+ N810BM_PMM_ADC_0xFE = 0xFE, -+}; -+ -+struct n810bm_adc_calib { -+ enum n810bm_pmm_adc_id id; -+ u8 flags; -+ u8 adc_groupnr; -+ u32 field1; -+ u32 field2; -+ u16 field3; -+ u16 field4; -+}; -+ -+struct n810bm_calib { -+ struct n810bm_adc_calib adc[25]; -+}; -+ -+enum n810bm_capacity { -+ N810BM_CAP_UNKNOWN = -1, -+ N810BM_CAP_NONE = 0, -+ N810BM_CAP_1500MAH = 1500, /* 1500 mAh battery */ -+}; -+ -+enum n810bm_notify_flags { -+ N810BM_NOTIFY_charger_present, -+ N810BM_NOTIFY_charger_state, -+ N810BM_NOTIFY_charger_pwm, -+}; -+ -+struct n810bm { -+ int tahvo_irq; -+ bool tahvo_irq_enabled; -+ -+ bool battery_present; /* A battery is inserted */ -+ bool charger_present; /* The charger is connected */ -+ enum n810bm_capacity capacity; /* The capacity of the inserted battery (if any) */ -+ -+ bool charger_enabled; /* Want to charge? */ -+ struct lipocharge charger; /* Charger subsystem */ -+ unsigned int active_current_pwm; /* Active value of TAHVO_REG_CHGCURR */ -+ int current_measure_enabled; /* Current measure enable refcount */ -+ -+ struct platform_device *pdev; -+ struct n810bm_calib calib; /* Calibration data */ -+ -+ bool verbose_charge_log; /* Verbose charge logging */ -+ -+ unsigned long notify_flags; -+ struct work_struct notify_work; -+ struct delayed_work periodic_check_work; -+ -+ bool initialized; /* The hardware was initialized */ -+ struct mutex mutex; -+}; -+ -+static void n810bm_notify_charger_present(struct n810bm *bm); -+static void n810bm_notify_charger_state(struct n810bm *bm); -+static void n810bm_notify_charger_pwm(struct n810bm *bm); -+ -+ -+static struct platform_device *n810bm_retu_device; -+static struct platform_device *n810bm_tahvo_device; -+ -+ -+static inline struct n810bm * device_to_n810bm(struct device *dev) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct n810bm *bm = platform_get_drvdata(pdev); -+ -+ return bm; -+} -+ -+static inline bool n810bm_known_battery_present(struct n810bm *bm) -+{ -+ return bm->battery_present && -+ bm->capacity != N810BM_CAP_UNKNOWN && -+ bm->capacity != N810BM_CAP_NONE; -+} -+ -+static void n810bm_emergency(struct n810bm *bm, const char *message) __noreturn; -+static void n810bm_emergency(struct n810bm *bm, const char *message) -+{ -+ printk(KERN_EMERG "n810 battery management fatal fault: %s\n", message); -+ cbus_emergency(); -+} -+ -+static u16 tahvo_read(struct n810bm *bm, unsigned int reg) -+{ -+ return tahvo_read_reg(&n810bm_tahvo_device->dev, reg); -+} -+ -+static void tahvo_maskset(struct n810bm *bm, unsigned int reg, u16 mask, u16 set) -+{ -+ tahvo_set_clear_reg_bits(&n810bm_tahvo_device->dev, reg, set, mask); -+} -+ -+static inline void tahvo_write(struct n810bm *bm, unsigned int reg, u16 value) -+{ -+ tahvo_write_reg(&n810bm_tahvo_device->dev, reg, value); -+} -+ -+static inline void tahvo_set(struct n810bm *bm, unsigned int reg, u16 mask) -+{ -+ tahvo_set_clear_reg_bits(&n810bm_tahvo_device->dev, reg, mask, mask); -+} -+ -+static inline void tahvo_clear(struct n810bm *bm, unsigned int reg, u16 mask) -+{ -+ tahvo_set_clear_reg_bits(&n810bm_tahvo_device->dev, reg, 0, mask); -+} -+ -+static u16 retu_read(struct n810bm *bm, unsigned int reg) -+{ -+ return retu_read_reg(&n810bm_retu_device->dev, reg); -+} -+ -+static void retu_maskset(struct n810bm *bm, unsigned int reg, u16 mask, u16 set) -+{ -+ retu_set_clear_reg_bits(&n810bm_retu_device->dev, reg, set, mask); -+} -+ -+static inline void retu_write(struct n810bm *bm, unsigned int reg, u16 value) -+{ -+ retu_write_reg(&n810bm_retu_device->dev, reg, value); -+} -+ -+static int retu_adc_average(struct n810bm *bm, unsigned int chan, -+ unsigned int nr_passes) -+{ -+ unsigned int i, value = 0; -+ int ret; -+ -+ if (WARN_ON(!nr_passes)) -+ return 0; -+ for (i = 0; i < nr_passes; i++) { -+ ret = retu_read_adc(&n810bm_retu_device->dev, chan); -+ if (ret < 0) -+ return ret; -+ value += ret; -+ } -+ value /= nr_passes; -+ -+ return value; -+} -+ -+static struct n810bm_adc_calib * n810bm_get_adc_calib(struct n810bm *bm, -+ enum n810bm_pmm_adc_id id) -+{ -+ unsigned int index = 0; -+ struct n810bm_adc_calib *cal; -+ -+ if (id != N810BM_PMM_ADC_0xFE) -+ index = (unsigned int)id + 1; -+ if (index >= ARRAY_SIZE(bm->calib.adc)) -+ return NULL; -+ -+ cal = &bm->calib.adc[index]; -+ WARN_ON(cal->id && cal->id != id); -+ -+ return cal; -+} -+ -+static int pmm_record_get(struct n810bm *bm, -+ const struct firmware *pmm_block, -+ void *buffer, size_t length, -+ unsigned int group, unsigned int element, unsigned int offset) -+{ -+ const u8 *pmm_area = pmm_block->data; -+ u8 active_group_mask; -+ -+ if (pmm_block->size != N810BM_PMM_BLOCK_SIZE) -+ return -EINVAL; -+ if (group >= N810BM_PMM_BLOCK_SIZE / N810BM_PMM_GROUP_SIZE) -+ return -EINVAL; -+ if (element >= N810BM_PMM_GROUP_SIZE / N810BM_PMM_ELEM_SIZE) -+ return -EINVAL; -+ if (offset >= N810BM_PMM_ELEM_SIZE || length > N810BM_PMM_ELEM_SIZE || -+ length + offset > N810BM_PMM_ELEM_SIZE) -+ return -EINVAL; -+ -+ active_group_mask = pmm_area[16]; -+ if (!(active_group_mask & (1 << group))) { -+ dev_dbg(&bm->pdev->dev, "pwm_record_get: Requested group %u, " -+ "but group is not active", group); -+ return -ENOENT; -+ } -+ -+ memcpy(buffer, -+ pmm_area + group * N810BM_PMM_GROUP_SIZE -+ + element * N810BM_PMM_ELEM_SIZE -+ + offset, -+ length); -+ -+ return 0; -+} -+ -+/* PMM block group 1 element */ -+struct group1_element { -+ u8 id; -+ u8 flags; -+ u8 adc_groupnr; -+ u8 _padding; -+ __le32 field1; -+ __le32 field2; -+} __packed; -+ -+static int extract_group1_elem(struct n810bm *bm, -+ const struct firmware *pmm_block, -+ const enum n810bm_pmm_adc_id *pmm_adc_ids, size_t nr_pmm_adc_ids, -+ u32 field1_mask, u32 field2_mask) -+{ -+ struct group1_element elem; -+ int err; -+ unsigned int i, element_nr; -+ struct n810bm_adc_calib *adc_calib; -+ -+ for (i = 0; i < nr_pmm_adc_ids; i++) { -+ element_nr = (unsigned int)(pmm_adc_ids[i]) + 3; -+ -+ err = pmm_record_get(bm, pmm_block, &elem, sizeof(elem), -+ 1, element_nr, 0); -+ if (err) -+ continue; -+ adc_calib = n810bm_get_adc_calib(bm, elem.id); -+ if (!adc_calib) { -+ dev_err(&bm->pdev->dev, "extract_group1_elem: " -+ "Could not get calib element for 0x%02X", -+ elem.id); -+ return -EINVAL; -+ } -+ -+ if (adc_calib->flags == elem.flags) { -+ adc_calib->field1 = le32_to_cpu(elem.field1) & field1_mask; -+ adc_calib->field2 = le32_to_cpu(elem.field2) & field2_mask; -+ } else { -+ dev_dbg(&bm->pdev->dev, "extract_group1_elem: " -+ "Not extracting fields due to flags mismatch: " -+ "0x%02X vs 0x%02X", -+ adc_calib->flags, elem.flags); -+ } -+ } -+ -+ return 0; -+} -+ -+static int n810bm_parse_pmm_group1(struct n810bm *bm, -+ const struct firmware *pmm_block) -+{ -+ struct n810bm_adc_calib *adc_calib; -+ struct group1_element elem; -+ int err; -+ -+ static const enum n810bm_pmm_adc_id pmm_adc_ids_1[] = { -+ N810BM_PMM_ADC_BATVOLT, -+ N810BM_PMM_ADC_CHGVOLT, -+ N810BM_PMM_ADC_BKUPVOLT, -+ N810BM_PMM_ADC_BATCURR, -+ }; -+ static const enum n810bm_pmm_adc_id pmm_adc_ids_2[] = { -+ N810BM_PMM_ADC_BSI, -+ }; -+ static const enum n810bm_pmm_adc_id pmm_adc_ids_3[] = { -+ N810BM_PMM_ADC_BATTEMP, -+ }; -+ -+ /* Parse element 2 */ -+ err = pmm_record_get(bm, pmm_block, &elem, sizeof(elem), -+ 1, 2, 0); -+ if (err) { -+ dev_err(&bm->pdev->dev, -+ "PMM: Failed to get group 1 / element 2"); -+ return err; -+ } -+ if (elem.id == N810BM_PMM_ADC_0xFE && elem.flags == 0x05) { -+ adc_calib = n810bm_get_adc_calib(bm, elem.id); -+ if (!adc_calib) { -+ dev_err(&bm->pdev->dev, -+ "calib extract: Failed to get 0xFE calib"); -+ return -EINVAL; -+ } -+ adc_calib->id = elem.id; -+ adc_calib->flags = elem.flags; -+ adc_calib->field1 = le32_to_cpu(elem.field1); -+ adc_calib->field2 = le32_to_cpu(elem.field2); -+ } -+ -+ err = extract_group1_elem(bm, pmm_block, -+ pmm_adc_ids_1, ARRAY_SIZE(pmm_adc_ids_1), -+ 0xFFFFFFFF, 0xFFFFFFFF); -+ if (err) -+ return err; -+ err = extract_group1_elem(bm, pmm_block, -+ pmm_adc_ids_2, ARRAY_SIZE(pmm_adc_ids_2), -+ 0xFFFFFFFF, 0); -+ if (err) -+ return err; -+ err = extract_group1_elem(bm, pmm_block, -+ pmm_adc_ids_3, ARRAY_SIZE(pmm_adc_ids_3), -+ 0xFFFFFFFF, 0x0000FFFF); -+ if (err) -+ return err; -+ -+ return 0; -+} -+ -+static int n810bm_parse_pmm_group2(struct n810bm *bm, -+ const struct firmware *pmm_block) -+{ -+ dev_err(&bm->pdev->dev, "TODO: CAL BME PMM group 2 parser not implemented, yet"); -+ return -EOPNOTSUPP; -+} -+ -+static void n810bm_adc_calib_set_defaults(struct n810bm *bm) -+{ -+ struct n810bm_adc_calib *adc_calib; -+ unsigned int i; -+ -+ static const struct n810bm_adc_calib defaults[] = { -+ /* ADC group-nr 0 */ -+ { -+ .id = N810BM_PMM_ADC_HEADSET, -+ .flags = 0x00, -+ .adc_groupnr = 0, -+ }, { -+ .id = N810BM_PMM_ADC_HOOKDET, -+ .flags = 0x00, -+ .adc_groupnr = 0, -+ }, { -+ .id = N810BM_PMM_ADC_RFGP, -+ .flags = 0x00, -+ .adc_groupnr = 0, -+ }, { -+ .id = N810BM_PMM_ADC_LIGHTSENS, -+ .flags = 0x00, -+ .adc_groupnr = 0, -+ }, { -+ .id = N810BM_PMM_ADC_WBTX, -+ .flags = 0x00, -+ .adc_groupnr = 0, -+ }, { -+ .id = N810BM_PMM_ADC_RETUTEMP, -+ .flags = 0x00, -+ .adc_groupnr = 0, -+ }, { -+ .id = N810BM_PMM_ADC_GND2, -+ .flags = 0x00, -+ .adc_groupnr = 0, -+ }, -+ /* ADC group-nr 1 */ -+ { -+ .id = N810BM_PMM_ADC_0xFE, -+ .flags = 0x05, -+ .adc_groupnr = 1, -+ .field1 = (u32)-2, -+ .field2 = 13189, -+ }, { -+ .id = N810BM_PMM_ADC_BATVOLT, -+ .flags = 0x01, -+ .adc_groupnr = 1, -+ .field1 = 2527, -+ .field2 = 21373, -+ }, { -+ .id = N810BM_PMM_ADC_CHGVOLT, -+ .flags = 0x01, -+ .adc_groupnr = 1, -+ .field1 = 0, -+ .field2 = 129848, -+ }, { -+ .id = N810BM_PMM_ADC_BKUPVOLT, -+ .flags = 0x01, -+ .adc_groupnr = 1, -+ .field1 = 0, -+ .field2 = 20000, -+ }, { -+ .id = N810BM_PMM_ADC_BATCURR, -+ .flags = 0x06, -+ .adc_groupnr = 1, -+ .field1 = 0, -+ .field2 = 9660, -+ }, -+ /* ADC group-nr 2 */ -+ { -+ .id = N810BM_PMM_ADC_BSI, -+ .flags = 0x02, -+ .adc_groupnr = 2, -+ .field1 = 1169, -+ .field2 = 0, -+ }, -+ /* ADC group-nr 3 */ -+ { -+ .id = N810BM_PMM_ADC_BATTEMP, -+ .flags = 0x03, -+ .adc_groupnr = 3, -+ .field1 = 265423000, -+ .field2 = 298, -+ }, -+ /* ADC group-nr 4 */ -+ { -+ .id = N810BM_PMM_ADC_LIGHTTEMP, -+ .flags = 0x04, -+ .adc_groupnr = 4, -+ .field1 = 19533778, -+ .field2 = 308019670, -+ .field3 = 4700, -+ .field4 = 2500, -+ }, -+ }; -+ -+ /* Clear the array */ -+ memset(&bm->calib.adc, 0, sizeof(bm->calib.adc)); -+ for (i = 0; i < ARRAY_SIZE(bm->calib.adc); i++) -+ bm->calib.adc[i].flags = 0xFF; -+ -+ /* Copy the defaults */ -+ for (i = 0; i < ARRAY_SIZE(defaults); i++) { -+ adc_calib = n810bm_get_adc_calib(bm, defaults[i].id); -+ if (WARN_ON(!adc_calib)) -+ continue; -+ *adc_calib = defaults[i]; -+ } -+} -+ -+static int n810bm_parse_pmm_block(struct n810bm *bm, -+ const struct firmware *pmm_block) -+{ -+ u8 byte; -+ int err; -+ unsigned int i, count; -+ struct n810bm_adc_calib *adc_calib; -+ -+ /* Initialize to defaults */ -+ n810bm_adc_calib_set_defaults(bm); -+ -+ /* Parse the PMM data */ -+ err = pmm_record_get(bm, pmm_block, &byte, sizeof(byte), -+ 1, 0, 0); /* group 1 / element 0 */ -+ err |= (byte != 0x01); -+ err |= pmm_record_get(bm, pmm_block, &byte, sizeof(byte), -+ 1, 1, 0); /* group 1 / element 1 */ -+ err |= (byte != 0x01); -+ if (err) -+ err = n810bm_parse_pmm_group2(bm, pmm_block); -+ else -+ err = n810bm_parse_pmm_group1(bm, pmm_block); -+ if (err) -+ return err; -+ -+ /* Sanity checks */ -+ for (i = 0, count = 0; i < ARRAY_SIZE(bm->calib.adc); i++) { -+ adc_calib = &bm->calib.adc[i]; -+ if (adc_calib->flags == 0xFF) -+ continue; -+ switch (adc_calib->id) { -+ case N810BM_PMM_ADC_BATVOLT: -+ if (adc_calib->field1 < 2400 || -+ adc_calib->field1 > 2700) -+ goto value_check_fail; -+ if (adc_calib->field2 < 20000 || -+ adc_calib->field2 > 23000) -+ goto value_check_fail; -+ count++; -+ break; -+ case N810BM_PMM_ADC_BSI: -+ if (adc_calib->field1 < 1100 || -+ adc_calib->field1 > 1300) -+ goto value_check_fail; -+ count++; -+ break; -+ case N810BM_PMM_ADC_BATCURR: -+ if (adc_calib->field2 < 7000 || -+ adc_calib->field2 > 12000) -+ goto value_check_fail; -+ count++; -+ break; -+ case N810BM_PMM_ADC_0xFE: -+ if ((s32)adc_calib->field1 > 14 || -+ (s32)adc_calib->field1 < -14) -+ goto value_check_fail; -+ if (adc_calib->field2 < 13000 || -+ adc_calib->field2 > 13350) -+ goto value_check_fail; -+ count++; -+ break; -+ case N810BM_PMM_ADC_CHGVOLT: -+ case N810BM_PMM_ADC_BATTEMP: -+ case N810BM_PMM_ADC_BKUPVOLT: -+ count++; -+ break; -+ case N810BM_PMM_ADC_GND2: -+ case N810BM_PMM_ADC_HOOKDET: -+ case N810BM_PMM_ADC_LIGHTSENS: -+ case N810BM_PMM_ADC_HEADSET: -+ case N810BM_PMM_ADC_LIGHTTEMP: -+ case N810BM_PMM_ADC_RFGP: -+ case N810BM_PMM_ADC_WBTX: -+ case N810BM_PMM_ADC_RETUTEMP: -+ break; -+ } -+ dev_dbg(&bm->pdev->dev, -+ "ADC 0x%02X calib: 0x%02X 0x%02X 0x%08X 0x%08X 0x%04X 0x%04X", -+ adc_calib->id, adc_calib->flags, adc_calib->adc_groupnr, -+ adc_calib->field1, adc_calib->field2, -+ adc_calib->field3, adc_calib->field4); -+ } -+ if (count != 7) { -+ dev_err(&bm->pdev->dev, "PMM sanity check: Did not find " -+ "all required values (count=%u)", count); -+ goto check_fail; -+ } -+ -+ return 0; -+ -+value_check_fail: -+ dev_err(&bm->pdev->dev, "PMM image sanity check failed " -+ "(id=%02X, field1=%08X, field2=%08X)", -+ adc_calib->id, adc_calib->field1, adc_calib->field2); -+check_fail: -+ return -EILSEQ; -+} -+ -+/* Set the current measure timer that triggers on Tahvo IRQ 7 -+ * An interval of zero disables the timer. */ -+static void n810bm_set_current_measure_timer(struct n810bm *bm, -+ u16 millisec_interval) -+{ -+ u16 value = millisec_interval; -+ -+ if (value <= 0xF905) { -+ value = ((u64)0x10624DD3 * (u64)(value + 0xF9)) >> 32; -+ value /= 16; -+ } else -+ value = 0xFF; -+ -+ tahvo_write(bm, TAHVO_REG_BATCURRTIMER, value & 0xFF); -+ -+ tahvo_set(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_CURTIMRST); -+ tahvo_clear(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_CURTIMRST); -+ -+ if (millisec_interval) { -+ if (!bm->tahvo_irq_enabled) { -+ bm->tahvo_irq_enabled = 1; -+ enable_irq(bm->tahvo_irq); -+ } -+ } else { -+ if (bm->tahvo_irq_enabled) { -+ bm->tahvo_irq_enabled = 0; -+ disable_irq_nosync(bm->tahvo_irq); -+ } -+ } -+ -+ //TODO also do a software timer for safety. -+} -+ -+static void n810bm_enable_current_measure(struct n810bm *bm) -+{ -+ WARN_ON(bm->current_measure_enabled < 0); -+ if (!bm->current_measure_enabled) { -+ /* Enable the current measurement circuitry */ -+ tahvo_set(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_CURMEAS); -+ dev_dbg(&bm->pdev->dev, -+ "Current measurement circuitry enabled"); -+ } -+ bm->current_measure_enabled++; -+} -+ -+static void n810bm_disable_current_measure(struct n810bm *bm) -+{ -+ bm->current_measure_enabled--; -+ WARN_ON(bm->current_measure_enabled < 0); -+ if (!bm->current_measure_enabled) { -+ /* Disable the current measurement circuitry */ -+ tahvo_clear(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_CURMEAS); -+ dev_dbg(&bm->pdev->dev, -+ "Current measurement circuitry disabled"); -+ } -+} -+ -+/* Measure the actual battery current. Returns a signed value in mA. -+ * Does only work, if current measurement was enabled. */ -+static int n810bm_measure_batt_current(struct n810bm *bm) -+{ -+ u16 retval; -+ int adc = 0, ma, i; -+ -+ if (WARN_ON(bm->current_measure_enabled <= 0)) -+ return 0; -+ for (i = 0; i < 3; i++) { -+ retval = tahvo_read(bm, TAHVO_REG_BATCURR); -+ adc += (s16)retval; /* Value is signed */ -+ } -+ adc /= 3; -+ -+ //TODO convert to mA -+ ma = adc; -+ -+ return ma; -+} -+ -+/* Requires bm->mutex locked */ -+static int n810bm_measure_batt_current_async(struct n810bm *bm) -+{ -+ int ma; -+ bool charging = lipocharge_is_charging(&bm->charger); -+ -+ n810bm_enable_current_measure(bm); -+ if (!charging) -+ WARN_ON(bm->active_current_pwm != 0); -+ tahvo_maskset(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_EN | -+ TAHVO_REG_CHGCTL_PWMOVR | -+ TAHVO_REG_CHGCTL_PWMOVRZERO, -+ TAHVO_REG_CHGCTL_EN | -+ TAHVO_REG_CHGCTL_PWMOVR | -+ (charging ? 0 : TAHVO_REG_CHGCTL_PWMOVRZERO)); -+ ma = n810bm_measure_batt_current(bm); -+ tahvo_maskset(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_EN | -+ TAHVO_REG_CHGCTL_PWMOVR | -+ TAHVO_REG_CHGCTL_PWMOVRZERO, -+ (charging ? TAHVO_REG_CHGCTL_EN : 0)); -+ n810bm_disable_current_measure(bm); -+ -+ return ma; -+} -+ -+static int adc_sanity_check(struct n810bm *bm, unsigned int channel) -+{ -+ int value; -+ -+ value = retu_read_adc(&n810bm_retu_device->dev, channel); -+ if (value < 0) { -+ dev_err(&bm->pdev->dev, "Failed to read GND ADC channel %u", -+ channel); -+ return -EIO; -+ } -+ dev_dbg(&bm->pdev->dev, -+ "GND ADC channel %u sanity check got value: %d", -+ channel, value); -+ if (value > 5) { -+ n810bm_emergency(bm, "GND ADC sanity check failed"); -+ return -EIO; -+ } -+ -+ return 0; -+} -+ -+static int n810bm_check_adc_sanity(struct n810bm *bm) -+{ -+ int err; -+ -+ /* Discard one conversion */ -+ retu_write(bm, RETU_REG_ADCSCR, 0); -+ retu_read_adc(&n810bm_retu_device->dev, RETU_ADC_GND2); -+ -+ err = adc_sanity_check(bm, RETU_ADC_GND2); -+ if (err) -+ return err; -+ -+ return 0; -+} -+ -+/* Measure the battery voltage. Returns the value in mV (or negative value on error). */ -+static int n810bm_measure_batt_voltage(struct n810bm *bm) -+{ -+ int adc; -+ unsigned int mv; -+ const unsigned int scale = 1000; -+ -+ adc = retu_adc_average(bm, RETU_ADC_BATTVOLT, 5); -+ if (adc < 0) -+ return adc; -+ if (adc <= 0x37) -+ return 2800; -+ mv = 2800 + ((adc - 0x37) * (((4200 - 2800) * scale) / (0x236 - 0x37))) / scale; -+ -+ //TODO compensate for power consumption -+ //TODO honor calibration values -+ -+ return mv; -+} -+ -+/* Measure the charger voltage. Returns the value in mV (or negative value on error). */ -+static int n810bm_measure_charger_voltage(struct n810bm *bm) -+{ -+ int adc; -+ unsigned int mv; -+ -+ adc = retu_adc_average(bm, RETU_ADC_CHGVOLT, 5); -+ if (adc < 0) -+ return adc; -+ //TODO convert to mV -+ mv = adc; -+ -+ return mv; -+} -+ -+/* Measure backup battery voltage. Returns the value in mV (or negative value on error). */ -+static int n810bm_measure_backup_batt_voltage(struct n810bm *bm) -+{ -+ int adc; -+ unsigned int mv; -+ -+ adc = retu_adc_average(bm, RETU_ADC_BKUPVOLT, 3); -+ if (adc < 0) -+ return adc; -+ //TODO convert to mV -+ mv = adc; -+ -+ return mv; -+} -+ -+/* Measure the battery temperature. Returns the value in K (or negative value on error). */ -+static int n810bm_measure_batt_temp(struct n810bm *bm) -+{ -+ int adc; -+ unsigned int k; -+ -+ adc = retu_adc_average(bm, RETU_ADC_BATTEMP, 3); -+ if (adc < 0) -+ return adc; -+ //TODO convert to K -+ k = adc; -+ -+ return k; -+} -+ -+/* Read the battery capacity via BSI pin. */ -+static enum n810bm_capacity n810bm_read_batt_capacity(struct n810bm *bm) -+{ -+ int adc; -+ const unsigned int hyst = 20; -+ -+ adc = retu_adc_average(bm, RETU_ADC_BSI, 5); -+ if (adc < 0) { -+ dev_err(&bm->pdev->dev, "Failed to read BSI ADC"); -+ return N810BM_CAP_UNKNOWN; -+ } -+ -+ if (adc >= 0x3B5 - hyst && adc <= 0x3B5 + hyst) -+ return N810BM_CAP_1500MAH; -+ -+ dev_err(&bm->pdev->dev, "Capacity indicator 0x%X unknown", adc); -+ -+ return N810BM_CAP_UNKNOWN; -+} -+ -+/* Convert a battery voltage (in mV) to percentage. */ -+static unsigned int n810bm_mvolt2percent(unsigned int mv) -+{ -+ const unsigned int minv = 3700; -+ const unsigned int maxv = 4150; -+ unsigned int percent; -+ -+ mv = clamp(mv, minv, maxv); -+ percent = (mv - minv) * 100 / (maxv - minv); -+ -+ return percent; -+} -+ -+static void n810bm_start_charge(struct n810bm *bm) -+{ -+ int err; -+ -+ WARN_ON(!bm->battery_present); -+ WARN_ON(!bm->charger_present); -+ -+ /* Set PWM to zero */ -+ bm->active_current_pwm = 0; -+ tahvo_write(bm, TAHVO_REG_CHGCURR, bm->active_current_pwm); -+ -+ /* Charge global enable */ -+ tahvo_maskset(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_EN | -+ TAHVO_REG_CHGCTL_PWMOVR | -+ TAHVO_REG_CHGCTL_PWMOVRZERO, -+ TAHVO_REG_CHGCTL_EN); -+ -+ WARN_ON((int)bm->capacity <= 0); -+ bm->charger.capacity = bm->capacity; -+ err = lipocharge_start(&bm->charger); -+ WARN_ON(err); -+ -+ /* Initialize current measurement circuitry */ -+ n810bm_enable_current_measure(bm); -+ n810bm_set_current_measure_timer(bm, 250); -+ -+ dev_info(&bm->pdev->dev, "Charging battery"); -+ n810bm_notify_charger_state(bm); -+ n810bm_notify_charger_pwm(bm); -+} -+ -+static void n810bm_stop_charge(struct n810bm *bm) -+{ -+ if (lipocharge_is_charging(&bm->charger)) { -+ n810bm_set_current_measure_timer(bm, 0); -+ n810bm_disable_current_measure(bm); -+ } -+ lipocharge_stop(&bm->charger); -+ -+ /* Set PWM to zero */ -+ bm->active_current_pwm = 0; -+ tahvo_write(bm, TAHVO_REG_CHGCURR, bm->active_current_pwm); -+ -+ /* Charge global disable */ -+ tahvo_maskset(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_EN | -+ TAHVO_REG_CHGCTL_PWMOVR | -+ TAHVO_REG_CHGCTL_PWMOVRZERO, -+ 0); -+ -+ dev_info(&bm->pdev->dev, "Not charging battery"); -+ n810bm_notify_charger_state(bm); -+ n810bm_notify_charger_pwm(bm); -+} -+ -+/* Periodic check */ -+static void n810bm_periodic_check_work(struct work_struct *work) -+{ -+ struct n810bm *bm = container_of(to_delayed_work(work), -+ struct n810bm, periodic_check_work); -+ u16 status; -+ bool battery_was_present, charger_was_present; -+ int mv; -+ -+ mutex_lock(&bm->mutex); -+ -+ status = retu_read(bm, RETU_REG_STATUS); -+ battery_was_present = bm->battery_present; -+ charger_was_present = bm->charger_present; -+ bm->battery_present = !!(status & RETU_REG_STATUS_BATAVAIL); -+ bm->charger_present = !!(status & RETU_REG_STATUS_CHGPLUG); -+ -+ if (bm->battery_present != battery_was_present) { -+ /* Battery state changed */ -+ if (bm->battery_present) { -+ bm->capacity = n810bm_read_batt_capacity(bm); -+ if (bm->capacity == N810BM_CAP_UNKNOWN) { -+ dev_err(&bm->pdev->dev, "Unknown battery detected"); -+ } else { -+ dev_info(&bm->pdev->dev, "Detected %u mAh battery", -+ (unsigned int)bm->capacity); -+ } -+ } else { -+ bm->capacity = N810BM_CAP_NONE; -+ dev_info(&bm->pdev->dev, "The main battery was removed"); -+ //TODO disable charging -+ } -+ } -+ -+ if (bm->charger_present != charger_was_present) { -+ /* Charger state changed */ -+ dev_info(&bm->pdev->dev, "The charger was %s", -+ bm->charger_present ? "plugged in" : "removed"); -+ n810bm_notify_charger_present(bm); -+ } -+ -+ if ((bm->battery_present && !bm->charger_present) || -+ !n810bm_known_battery_present(bm)){ -+ /* We're draining the battery */ -+ mv = n810bm_measure_batt_voltage(bm); -+ if (mv < 0) { -+ n810bm_emergency(bm, -+ "check: Failed to measure voltage"); -+ } -+ if (mv < N810BM_MIN_VOLTAGE_THRES) { -+ n810bm_emergency(bm, -+ "check: Minimum voltage threshold reached"); -+ } -+ } -+ -+ if (bm->charger_present && n810bm_known_battery_present(bm)) { -+ /* Known battery and charger are connected */ -+ if (bm->charger_enabled) { -+ /* Charger is enabled */ -+ if (!lipocharge_is_charging(&bm->charger)) { -+ //TODO start charging, if battery is below some threshold -+ n810bm_start_charge(bm); -+ } -+ } -+ } -+ -+ if (lipocharge_is_charging(&bm->charger) && !bm->charger_present) { -+ /* Charger was unplugged. */ -+ n810bm_stop_charge(bm); -+ } -+ -+ mutex_unlock(&bm->mutex); -+ schedule_delayed_work(&bm->periodic_check_work, -+ round_jiffies_relative(N810BM_CHECK_INTERVAL)); -+} -+ -+/*XXX -+static void n810bm_adc_irq_handler(unsigned long data) -+{ -+ struct n810bm *bm = (struct n810bm *)data; -+ -+ retu_ack_irq(RETU_INT_ADCS); -+ //TODO -+dev_info(&bm->pdev->dev, "ADC interrupt triggered\n"); -+} -+*/ -+ -+static irqreturn_t n810bm_tahvo_current_measure_irq_handler(int irq, void *data) -+{ -+ struct n810bm *bm = data; -+ int res, ma, mv, temp; -+ -+ mutex_lock(&bm->mutex); -+ if (!lipocharge_is_charging(&bm->charger)) -+ goto out_unlock; -+ -+ tahvo_maskset(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_PWMOVR | -+ TAHVO_REG_CHGCTL_PWMOVRZERO, -+ TAHVO_REG_CHGCTL_PWMOVR); -+ ma = n810bm_measure_batt_current(bm); -+ tahvo_maskset(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_PWMOVR | -+ TAHVO_REG_CHGCTL_PWMOVRZERO, -+ TAHVO_REG_CHGCTL_PWMOVR | -+ TAHVO_REG_CHGCTL_PWMOVRZERO); -+ msleep(10); -+ mv = n810bm_measure_batt_voltage(bm); -+ tahvo_maskset(bm, TAHVO_REG_CHGCTL, -+ TAHVO_REG_CHGCTL_PWMOVR | -+ TAHVO_REG_CHGCTL_PWMOVRZERO, -+ 0); -+ temp = n810bm_measure_batt_temp(bm); -+ if (WARN_ON(mv < 0)) -+ goto out_unlock; -+ if (WARN_ON(temp < 0)) -+ goto out_unlock; -+ -+ if (bm->verbose_charge_log) { -+ dev_info(&bm->pdev->dev, -+ "Battery charge state: %d mV, %d mA (%s)", -+ mv, ma, -+ (ma <= 0) ? "discharging" : "charging"); -+ } -+ res = lipocharge_update_state(&bm->charger, mv, ma, temp); -+ if (res) { -+ if (res > 0) -+ dev_info(&bm->pdev->dev, "Battery fully charged"); -+ n810bm_stop_charge(bm); -+ } -+out_unlock: -+ mutex_unlock(&bm->mutex); -+ -+ return IRQ_HANDLED; -+} -+ -+#define DEFINE_ATTR_NOTIFY(attr_name) \ -+ void n810bm_notify_##attr_name(struct n810bm *bm) \ -+ { \ -+ set_bit(N810BM_NOTIFY_##attr_name, &bm->notify_flags); \ -+ wmb(); \ -+ schedule_work(&bm->notify_work); \ -+ } -+ -+#define DEFINE_SHOW_INT_FUNC(name, member) \ -+ static ssize_t n810bm_attr_##name##_show(struct device *dev, \ -+ struct device_attribute *attr, \ -+ char *buf) \ -+ { \ -+ struct n810bm *bm = device_to_n810bm(dev); \ -+ ssize_t count; \ -+ \ -+ mutex_lock(&bm->mutex); \ -+ count = snprintf(buf, PAGE_SIZE, "%d\n", (int)(bm->member)); \ -+ mutex_unlock(&bm->mutex); \ -+ \ -+ return count; \ -+ } -+ -+#define DEFINE_STORE_INT_FUNC(name, member) \ -+ static ssize_t n810bm_attr_##name##_store(struct device *dev, \ -+ struct device_attribute *attr,\ -+ const char *buf, size_t count)\ -+ { \ -+ struct n810bm *bm = device_to_n810bm(dev); \ -+ long val; \ -+ int err; \ -+ \ -+ mutex_lock(&bm->mutex); \ -+ err = strict_strtol(buf, 0, &val); \ -+ if (!err) \ -+ bm->member = (typeof(bm->member))val; \ -+ mutex_unlock(&bm->mutex); \ -+ \ -+ return err ? err : count; \ -+ } -+ -+#define DEFINE_ATTR_SHOW_INT(name, member) \ -+ DEFINE_SHOW_INT_FUNC(name, member) \ -+ static DEVICE_ATTR(name, S_IRUGO, \ -+ n810bm_attr_##name##_show, NULL); -+ -+#define DEFINE_ATTR_SHOW_STORE_INT(name, member) \ -+ DEFINE_SHOW_INT_FUNC(name, member) \ -+ DEFINE_STORE_INT_FUNC(name, member) \ -+ static DEVICE_ATTR(name, S_IRUGO | S_IWUSR, \ -+ n810bm_attr_##name##_show, \ -+ n810bm_attr_##name##_store); -+ -+DEFINE_ATTR_SHOW_INT(battery_present, battery_present); -+DEFINE_ATTR_SHOW_INT(charger_present, charger_present); -+static DEFINE_ATTR_NOTIFY(charger_present); -+DEFINE_ATTR_SHOW_INT(charger_state, charger.state); -+static DEFINE_ATTR_NOTIFY(charger_state); -+DEFINE_ATTR_SHOW_INT(charger_pwm, active_current_pwm); -+static DEFINE_ATTR_NOTIFY(charger_pwm); -+DEFINE_ATTR_SHOW_STORE_INT(charger_enable, charger_enabled); -+DEFINE_ATTR_SHOW_STORE_INT(charger_verbose, verbose_charge_log); -+ -+static ssize_t n810bm_attr_battery_level_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct n810bm *bm = device_to_n810bm(dev); -+ ssize_t count = -ENODEV; -+ int millivolt; -+ -+ mutex_lock(&bm->mutex); -+ if (!bm->battery_present || lipocharge_is_charging(&bm->charger)) -+ millivolt = 0; -+ else -+ millivolt = n810bm_measure_batt_voltage(bm); -+ if (millivolt >= 0) { -+ count = snprintf(buf, PAGE_SIZE, "%u\n", -+ n810bm_mvolt2percent(millivolt)); -+ } -+ mutex_unlock(&bm->mutex); -+ -+ return count; -+} -+static DEVICE_ATTR(battery_level, S_IRUGO, -+ n810bm_attr_battery_level_show, NULL); -+ -+static ssize_t n810bm_attr_battery_capacity_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct n810bm *bm = device_to_n810bm(dev); -+ ssize_t count; -+ int capacity = 0; -+ -+ mutex_lock(&bm->mutex); -+ if (n810bm_known_battery_present(bm)) -+ capacity = (int)bm->capacity; -+ count = snprintf(buf, PAGE_SIZE, "%d\n", capacity); -+ mutex_unlock(&bm->mutex); -+ -+ return count; -+} -+static DEVICE_ATTR(battery_capacity, S_IRUGO, -+ n810bm_attr_battery_capacity_show, NULL); -+ -+static ssize_t n810bm_attr_battery_temp_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct n810bm *bm = device_to_n810bm(dev); -+ ssize_t count = -ENODEV; -+ int k; -+ -+ mutex_lock(&bm->mutex); -+ k = n810bm_measure_batt_temp(bm); -+ if (k >= 0) -+ count = snprintf(buf, PAGE_SIZE, "%d\n", k); -+ mutex_unlock(&bm->mutex); -+ -+ return count; -+} -+static DEVICE_ATTR(battery_temp, S_IRUGO, -+ n810bm_attr_battery_temp_show, NULL); -+ -+static ssize_t n810bm_attr_charger_voltage_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct n810bm *bm = device_to_n810bm(dev); -+ ssize_t count = -ENODEV; -+ int mv = 0; -+ -+ mutex_lock(&bm->mutex); -+ if (bm->charger_present) -+ mv = n810bm_measure_charger_voltage(bm); -+ if (mv >= 0) -+ count = snprintf(buf, PAGE_SIZE, "%d\n", mv); -+ mutex_unlock(&bm->mutex); -+ -+ return count; -+} -+static DEVICE_ATTR(charger_voltage, S_IRUGO, -+ n810bm_attr_charger_voltage_show, NULL); -+ -+static ssize_t n810bm_attr_backup_battery_voltage_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct n810bm *bm = device_to_n810bm(dev); -+ ssize_t count = -ENODEV; -+ int mv; -+ -+ mutex_lock(&bm->mutex); -+ mv = n810bm_measure_backup_batt_voltage(bm); -+ if (mv >= 0) -+ count = snprintf(buf, PAGE_SIZE, "%d\n", mv); -+ mutex_unlock(&bm->mutex); -+ -+ return count; -+} -+static DEVICE_ATTR(backup_battery_voltage, S_IRUGO, -+ n810bm_attr_backup_battery_voltage_show, NULL); -+ -+static ssize_t n810bm_attr_battery_current_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct n810bm *bm = device_to_n810bm(dev); -+ ssize_t count = -ENODEV; -+ int ma = 0; -+ -+ mutex_lock(&bm->mutex); -+ if (bm->battery_present) -+ ma = n810bm_measure_batt_current_async(bm); -+ count = snprintf(buf, PAGE_SIZE, "%d\n", ma); -+ mutex_unlock(&bm->mutex); -+ -+ return count; -+} -+static DEVICE_ATTR(battery_current, S_IRUGO, -+ n810bm_attr_battery_current_show, NULL); -+ -+static const struct device_attribute *n810bm_attrs[] = { -+ &dev_attr_battery_present, -+ &dev_attr_battery_level, -+ &dev_attr_battery_current, -+ &dev_attr_battery_capacity, -+ &dev_attr_battery_temp, -+ &dev_attr_backup_battery_voltage, -+ &dev_attr_charger_present, -+ &dev_attr_charger_state, -+ &dev_attr_charger_verbose, -+ &dev_attr_charger_voltage, -+ &dev_attr_charger_enable, -+ &dev_attr_charger_pwm, -+}; -+ -+static void n810bm_notify_work(struct work_struct *work) -+{ -+ struct n810bm *bm = container_of(work, struct n810bm, notify_work); -+ unsigned long notify_flags; -+ -+ notify_flags = xchg(&bm->notify_flags, 0); -+ mb(); -+ -+#define do_notify(attr_name) \ -+ do { \ -+ if (notify_flags & (1 << N810BM_NOTIFY_##attr_name)) { \ -+ sysfs_notify(&bm->pdev->dev.kobj, NULL, \ -+ dev_attr_##attr_name.attr.name); \ -+ } \ -+ } while (0) -+ -+ do_notify(charger_present); -+ do_notify(charger_state); -+ do_notify(charger_pwm); -+} -+ -+static int n810bm_charger_set_current_pwm(struct lipocharge *c, -+ unsigned int duty_cycle) -+{ -+ struct n810bm *bm = container_of(c, struct n810bm, charger); -+ int err = -EINVAL; -+ -+ WARN_ON(!mutex_is_locked(&bm->mutex)); -+ if (WARN_ON(duty_cycle > 0xFF)) -+ goto out; -+ if (WARN_ON(!bm->charger_enabled)) -+ goto out; -+ if (WARN_ON(!bm->battery_present || !bm->charger_present)) -+ goto out; -+ -+ if (duty_cycle != bm->active_current_pwm) { -+ bm->active_current_pwm = duty_cycle; -+ tahvo_write(bm, TAHVO_REG_CHGCURR, duty_cycle); -+ n810bm_notify_charger_pwm(bm); -+ } -+ -+ err = 0; -+out: -+ -+ return err; -+} -+ -+static void n810bm_charger_emergency(struct lipocharge *c) -+{ -+ struct n810bm *bm = container_of(c, struct n810bm, charger); -+ -+ n810bm_emergency(bm, "Battery charger fault"); -+} -+ -+static void n810bm_hw_exit(struct n810bm *bm) -+{ -+ n810bm_stop_charge(bm); -+ retu_write(bm, RETU_REG_ADCSCR, 0); -+} -+ -+static int n810bm_hw_init(struct n810bm *bm) -+{ -+ int err; -+ -+ err = n810bm_check_adc_sanity(bm); -+ if (err) -+ return err; -+ -+ n810bm_stop_charge(bm); -+ -+ return 0; -+} -+ -+static void n810bm_cancel_and_flush_work(struct n810bm *bm) -+{ -+ cancel_delayed_work_sync(&bm->periodic_check_work); -+ cancel_work_sync(&bm->notify_work); -+ flush_scheduled_work(); -+} -+ -+static int n810bm_device_init(struct n810bm *bm) -+{ -+ int attr_index; -+ int err; -+ -+ bm->charger.rate = LIPORATE_p6C; -+ bm->charger.top_voltage = 4100; -+ bm->charger.duty_cycle_max = 0xFF; -+ bm->charger.set_current_pwm = n810bm_charger_set_current_pwm; -+ bm->charger.emergency = n810bm_charger_emergency; -+ lipocharge_init(&bm->charger, &bm->pdev->dev); -+ -+ err = n810bm_hw_init(bm); -+ if (err) -+ goto error; -+ for (attr_index = 0; attr_index < ARRAY_SIZE(n810bm_attrs); attr_index++) { -+ err = device_create_file(&bm->pdev->dev, n810bm_attrs[attr_index]); -+ if (err) -+ goto err_unwind_attrs; -+ } -+/*XXX -+ err = retu_request_irq(RETU_INT_ADCS, -+ n810bm_adc_irq_handler, -+ (unsigned long)bm, "n810bm"); -+ if (err) -+ goto err_unwind_attrs; -+*/ -+ bm->tahvo_irq = platform_get_irq(n810bm_tahvo_device, 0); -+ err = request_threaded_irq(bm->tahvo_irq, NULL, -+ n810bm_tahvo_current_measure_irq_handler, -+ IRQF_ONESHOT, "tahvo-n810bm", bm); -+ if (err) -+ goto err_free_retu_irq; -+ disable_irq_nosync(bm->tahvo_irq); -+ bm->tahvo_irq_enabled = 0; -+ -+ schedule_delayed_work(&bm->periodic_check_work, -+ round_jiffies_relative(N810BM_CHECK_INTERVAL)); -+ -+ bm->initialized = 1; -+ dev_info(&bm->pdev->dev, "Battery management initialized"); -+ -+ return 0; -+ -+err_free_retu_irq: -+//XXX retu_free_irq(RETU_INT_ADCS); -+err_unwind_attrs: -+ for (attr_index--; attr_index >= 0; attr_index--) -+ device_remove_file(&bm->pdev->dev, n810bm_attrs[attr_index]); -+/*err_exit:*/ -+ n810bm_hw_exit(bm); -+error: -+ n810bm_cancel_and_flush_work(bm); -+ -+ return err; -+} -+ -+static void n810bm_device_exit(struct n810bm *bm) -+{ -+ int i; -+ -+ if (!bm->initialized) -+ return; -+ -+ lipocharge_exit(&bm->charger); -+ free_irq(bm->tahvo_irq, bm); -+//XXX retu_free_irq(RETU_INT_ADCS); -+ for (i = 0; i < ARRAY_SIZE(n810bm_attrs); i++) -+ device_remove_file(&bm->pdev->dev, n810bm_attrs[i]); -+ -+ n810bm_cancel_and_flush_work(bm); -+ -+ n810bm_hw_exit(bm); -+ -+ bm->initialized = 0; -+} -+ -+static void n810bm_pmm_block_found(const struct firmware *fw, void *context) -+{ -+ struct n810bm *bm = context; -+ int err; -+ -+ if (!fw) { -+ dev_err(&bm->pdev->dev, -+ "CAL PMM block image file not found"); -+ goto err_release; -+ } -+ if (fw->size != N810BM_PMM_BLOCK_SIZE || -+ memcmp(fw->data, "BME-PMM-BLOCK01", 15) != 0) { -+ dev_err(&bm->pdev->dev, -+ "CAL PMM block image file has an invalid format"); -+ goto err_release; -+ } -+ -+ err = n810bm_parse_pmm_block(bm, fw); -+ if (err) -+ goto err_release; -+ release_firmware(fw); -+ -+ err = n810bm_device_init(bm); -+ if (err) { -+ dev_err(&bm->pdev->dev, -+ "Failed to initialized battery management (%d)", err); -+ goto error; -+ } -+ -+ return; -+err_release: -+ release_firmware(fw); -+error: -+ return; -+} -+ -+static int __devinit n810bm_probe(void) -+{ -+ struct n810bm *bm; -+ int err; -+ -+ if (!n810bm_retu_device || !n810bm_tahvo_device) -+ return 0; -+ -+ bm = kzalloc(sizeof(*bm), GFP_KERNEL); -+ if (!bm) -+ return -ENOMEM; -+ bm->pdev = n810bm_retu_device; -+ platform_set_drvdata(n810bm_retu_device, bm); -+ platform_set_drvdata(n810bm_tahvo_device, bm); -+ mutex_init(&bm->mutex); -+ INIT_DELAYED_WORK(&bm->periodic_check_work, n810bm_periodic_check_work); -+ INIT_WORK(&bm->notify_work, n810bm_notify_work); -+ -+ dev_info(&bm->pdev->dev, "Requesting CAL BME PMM block firmware file " -+ N810BM_PMM_BLOCK_FILENAME); -+ err = request_firmware_nowait(THIS_MODULE, 1, -+ N810BM_PMM_BLOCK_FILENAME, -+ &bm->pdev->dev, GFP_KERNEL, -+ bm, n810bm_pmm_block_found); -+ if (err) { -+ dev_err(&bm->pdev->dev, -+ "Failed to request CAL PMM block image file (%d)", err); -+ goto err_free; -+ } -+ -+ return 0; -+ -+err_free: -+ kfree(bm); -+ -+ return err; -+} -+ -+static void __devexit n810bm_remove(void) -+{ -+ struct n810bm *bm; -+ -+ if (!n810bm_retu_device || !n810bm_tahvo_device) -+ return; -+ bm = platform_get_drvdata(n810bm_retu_device); -+ -+ n810bm_device_exit(bm); -+ -+ kfree(bm); -+ platform_set_drvdata(n810bm_retu_device, NULL); -+ platform_set_drvdata(n810bm_tahvo_device, NULL); -+} -+ -+static int __devinit n810bm_retu_probe(struct platform_device *pdev) -+{ -+ n810bm_retu_device = pdev; -+ return n810bm_probe(); -+} -+ -+static int __devexit n810bm_retu_remove(struct platform_device *pdev) -+{ -+ n810bm_remove(); -+ n810bm_retu_device = NULL; -+ return 0; -+} -+ -+static int __devinit n810bm_tahvo_probe(struct platform_device *pdev) -+{ -+ n810bm_tahvo_device = pdev; -+ return n810bm_probe(); -+} -+ -+static int __devexit n810bm_tahvo_remove(struct platform_device *pdev) -+{ -+ n810bm_remove(); -+ n810bm_tahvo_device = NULL; -+ return 0; -+} -+ -+static struct platform_driver n810bm_retu_driver = { -+ .remove = __devexit_p(n810bm_retu_remove), -+ .driver = { -+ .name = "retu-n810bm", -+ } -+}; -+ -+static struct platform_driver n810bm_tahvo_driver = { -+ .remove = __devexit_p(n810bm_tahvo_remove), -+ .driver = { -+ .name = "tahvo-n810bm", -+ } -+}; -+ -+static int __init n810bm_modinit(void) -+{ -+ int err; -+ -+ err = platform_driver_probe(&n810bm_retu_driver, n810bm_retu_probe); -+ if (err) -+ return err; -+ err = platform_driver_probe(&n810bm_tahvo_driver, n810bm_tahvo_probe); -+ if (err) { -+ platform_driver_unregister(&n810bm_retu_driver); -+ return err; -+ } -+ -+ return 0; -+} -+module_init(n810bm_modinit); -+ -+static void __exit n810bm_modexit(void) -+{ -+ platform_driver_unregister(&n810bm_tahvo_driver); -+ platform_driver_unregister(&n810bm_retu_driver); -+} -+module_exit(n810bm_modexit); -+ -+MODULE_DESCRIPTION("Nokia n810 battery management"); -+MODULE_FIRMWARE(N810BM_PMM_BLOCK_FILENAME); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Michael Buesch"); ---- /dev/null -+++ b/drivers/cbus/lipocharge.c -@@ -0,0 +1,183 @@ -+/* -+ * Generic LIPO battery charger -+ * -+ * Copyright (c) 2010-2011 Michael Buesch <mb@bu3sch.de> -+ * -+ * This program is free software; you can redistribute it and/or -+ * modify it under the terms of the GNU General Public License -+ * as published by the Free Software Foundation; either version 2 -+ * of the License, or (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ */ -+ -+#define DEBUG -+ -+#include "lipocharge.h" -+ -+#include <linux/slab.h> -+ -+ -+/* Hysteresis constants */ -+#define CURRENT_HYST 30 /* mA */ -+#define VOLTAGE_HYST 10 /* mV */ -+ -+/* Threshold constants */ -+#define FINISH_CURRENT_PERCENT 3 -+ -+ -+/* Returns the requested first-stage charge current in mA */ -+static inline unsigned int get_stage1_charge_current(struct lipocharge *c) -+{ -+ /* current = (capacity * C) */ -+ return c->capacity * c->rate / 1000; -+} -+ -+void lipocharge_init(struct lipocharge *c, struct device *dev) -+{ -+ c->dev = dev; -+ c->state = LIPO_IDLE; -+} -+ -+void lipocharge_exit(struct lipocharge *c) -+{ -+ c->state = LIPO_IDLE; -+} -+ -+int lipocharge_start(struct lipocharge *c) -+{ -+ int err; -+ -+ if (c->state != LIPO_IDLE) -+ return -EBUSY; -+ if (!c->set_current_pwm || !c->emergency) -+ return -EINVAL; -+ if (!c->top_voltage || c->top_voltage > 4200) -+ return -EINVAL; -+ -+ c->active_duty_cycle = 0; -+ err = c->set_current_pwm(c, c->active_duty_cycle); -+ if (err) -+ return err; -+ c->state = LIPO_FIRST_STAGE; -+ -+ return 0; -+} -+ -+void lipocharge_stop(struct lipocharge *c) -+{ -+ if (c->state == LIPO_IDLE) -+ return; -+ c->state = LIPO_IDLE; -+} -+ -+static int lipocharge_increase_current(struct lipocharge *c, -+ unsigned int inc_permille) -+{ -+ int old_pwm, new_pwm; -+ -+ if (c->active_duty_cycle >= c->duty_cycle_max) -+ return 0; -+ -+ old_pwm = c->active_duty_cycle; -+ new_pwm = old_pwm + (c->duty_cycle_max * inc_permille / 1000); -+ new_pwm = min(new_pwm, (int)c->duty_cycle_max); -+ c->active_duty_cycle = new_pwm; -+ -+ dev_dbg(c->dev, "lipo: Increasing duty_cycle by " -+ "%u permille (0x%02X -> 0x%02X)", -+ inc_permille, old_pwm, new_pwm); -+ -+ return c->set_current_pwm(c, c->active_duty_cycle); -+} -+ -+static int lipocharge_decrease_current(struct lipocharge *c, -+ unsigned int dec_permille) -+{ -+ int old_pwm, new_pwm; -+ -+ if (c->active_duty_cycle <= 0) -+ return 0; -+ -+ old_pwm = c->active_duty_cycle; -+ new_pwm = old_pwm - (c->duty_cycle_max * dec_permille / 1000); -+ new_pwm = max(0, new_pwm); -+ c->active_duty_cycle = new_pwm; -+ -+ dev_dbg(c->dev, "lipo: Decreasing duty_cycle by " -+ "%u permille (0x%02X -> 0x%02X)", -+ dec_permille, old_pwm, new_pwm); -+ -+ return c->set_current_pwm(c, c->active_duty_cycle); -+} -+ -+/** lipocharge_update_state - Update the charge state -+ * @c: The context. -+ * @voltage_mV: The measured battery voltage. -+ * @current_mA: The measured charge current. -+ * negative -> drain. -+ * positive -> charge. -+ * @temp_K: Battery temperature in K. -+ * -+ * Returns 0 on success, -1 on error. -+ * Returns 1, if the charging process is finished. -+ */ -+int lipocharge_update_state(struct lipocharge *c, -+ unsigned int voltage_mV, -+ int current_mA, -+ unsigned int temp_K) -+{ -+ int requested_current, current_diff; -+ int err; -+ unsigned int permille; -+ -+ //TODO temp -+ -+restart: -+ switch (c->state) { -+ case LIPO_IDLE: -+ dev_err(c->dev, "%s: called while idle", __func__); -+ return -EINVAL; -+ case LIPO_FIRST_STAGE: /* Constant current */ -+//printk("GOT %u %d %u\n", voltage_mV, current_mA, temp_K); -+ if (voltage_mV >= c->top_voltage) { -+ /* Float voltage reached. -+ * Switch charger mode to "constant current" */ -+ c->state = LIPO_SECOND_STAGE; -+ dev_dbg(c->dev, "Switched to second charging stage."); -+ goto restart; -+ } -+ /* Float voltage not reached, yet. -+ * Try to get the requested constant current. */ -+ requested_current = get_stage1_charge_current(c); -+ if (current_mA < 0) -+ current_mA = 0; -+ current_diff = requested_current - current_mA; -+ if (abs(requested_current - current_mA) > CURRENT_HYST) { -+ if (current_diff > 0) { -+ /* Increase current */ -+ permille = current_diff * 1000 / requested_current; -+ permille /= 2; -+ err = lipocharge_increase_current(c, permille); -+ if (err) -+ return err; -+ } else { -+ /* Decrease current */ -+ permille = (-current_diff) * 1000 / requested_current; -+ permille /= 2; -+ err = lipocharge_decrease_current(c, permille); -+ if (err) -+ return err; -+ } -+ } -+ break; -+ case LIPO_SECOND_STAGE: /* Constant voltage */ -+ //TODO -+ break; -+ } -+ -+ return 0; -+} ---- /dev/null -+++ b/drivers/cbus/lipocharge.h -@@ -0,0 +1,60 @@ -+#ifndef LIPOCHARGE_H_ -+#define LIPOCHARGE_H_ -+ -+#include <linux/types.h> -+#include <linux/device.h> -+ -+ -+#define LIPORATE(a,b) (((a) * 1000) + ((b) * 100)) -+#define LIPORATE_p6C LIPORATE(0,6) /* 0.6C */ -+ -+enum lipocharge_state { -+ LIPO_IDLE = 0, /* Not charging */ -+ LIPO_FIRST_STAGE, /* Charging: constant current */ -+ LIPO_SECOND_STAGE, /* Charging: constant voltage */ -+}; -+ -+/** struct lipocharge - A generic LIPO charger -+ * -+ * @capacity: Battery capacity in mAh. -+ * @rate: Charge rate. -+ * @top_voltage: Fully charged voltage, in mV. -+ * @duty_cycle_max: Max value for duty_cycle. -+ * -+ * @set_charge_current: Set the charge current PWM duty cycle. -+ * @emergency: Something went wrong. Force shutdown. -+ */ -+struct lipocharge { -+ unsigned int capacity; -+ unsigned int rate; -+ unsigned int top_voltage; -+ unsigned int duty_cycle_max; -+ -+ int (*set_current_pwm)(struct lipocharge *c, unsigned int duty_cycle); -+ void (*emergency)(struct lipocharge *c); -+ -+ /* internal */ -+ struct device *dev; -+ enum lipocharge_state state; -+ unsigned int active_duty_cycle; -+ -+ //TODO implement timer to cut power after maximum charge time. -+}; -+ -+void lipocharge_init(struct lipocharge *c, struct device *dev); -+void lipocharge_exit(struct lipocharge *c); -+ -+int lipocharge_start(struct lipocharge *c); -+void lipocharge_stop(struct lipocharge *c); -+ -+int lipocharge_update_state(struct lipocharge *c, -+ unsigned int voltage_mV, -+ int current_mA, -+ unsigned int temp_K); -+ -+static inline bool lipocharge_is_charging(struct lipocharge *c) -+{ -+ return (c->state != LIPO_IDLE); -+} -+ -+#endif /* LIPOCHARGE_H_ */ ---- a/drivers/cbus/cbus.c -+++ b/drivers/cbus/cbus.c -@@ -36,6 +36,7 @@ - #include <linux/gpio.h> - #include <linux/platform_device.h> - #include <linux/platform_data/cbus.h> -+#include <linux/reboot.h> - - #include "cbus.h" - -@@ -326,6 +327,13 @@ static void __exit cbus_bus_exit(void) - } - module_exit(cbus_bus_exit); - -+void cbus_emergency(void) -+{ -+ machine_power_off(); -+ panic("cbus: Failed to halt machine in emergency state\n"); -+} -+EXPORT_SYMBOL(cbus_emergency); -+ - MODULE_DESCRIPTION("CBUS serial protocol"); - MODULE_LICENSE("GPL"); - MODULE_AUTHOR("Juha Yrjölä"); ---- a/drivers/cbus/cbus.h -+++ b/drivers/cbus/cbus.h -@@ -27,4 +27,6 @@ extern int cbus_read_reg(struct device * - extern int cbus_write_reg(struct device *, unsigned dev, unsigned reg, - unsigned val); - -+void cbus_emergency(void) __noreturn; -+ - #endif /* __DRIVERS_CBUS_CBUS_H */ ---- a/drivers/cbus/retu.c -+++ b/drivers/cbus/retu.c -@@ -399,6 +399,11 @@ static int retu_allocate_children(struct - if (!child) - return -ENOMEM; - -+ child = retu_allocate_child("retu-n810bm", parent, irq_base, -+ RETU_INT_ADCS, -1, 1); -+ if (!child) -+ return -ENOMEM; -+ - return 0; - } - ---- a/drivers/cbus/tahvo.c -+++ b/drivers/cbus/tahvo.c -@@ -129,6 +129,7 @@ void tahvo_set_clear_reg_bits(struct dev - __tahvo_write_reg(tahvo, reg, w); - mutex_unlock(&tahvo->mutex); - } -+EXPORT_SYMBOL(tahvo_set_clear_reg_bits); - - static irqreturn_t tahvo_irq_handler(int irq, void *_tahvo) - { -@@ -292,6 +293,11 @@ static int tahvo_allocate_children(struc - if (!child) - return -ENOMEM; - -+ child = tahvo_allocate_child("tahvo-n810bm", parent, -+ irq_base + TAHVO_INT_BATCURR); -+ if (!child) -+ return -ENOMEM; -+ - return 0; - } - diff --git a/target/linux/omap24xx/patches-3.3/910-omap-fix-section-mismatch-warnings.patch b/target/linux/omap24xx/patches-3.3/910-omap-fix-section-mismatch-warnings.patch deleted file mode 100644 index a7772be4d2..0000000000 --- a/target/linux/omap24xx/patches-3.3/910-omap-fix-section-mismatch-warnings.patch +++ /dev/null @@ -1,116 +0,0 @@ ---- a/arch/arm/plat-omap/omap_device.c -+++ b/arch/arm/plat-omap/omap_device.c -@@ -619,7 +619,7 @@ static void omap_device_delete(struct om - * information. Returns ERR_PTR(-EINVAL) if @oh is NULL; otherwise, - * passes along the return value of omap_device_build_ss(). - */ --struct platform_device *omap_device_build(const char *pdev_name, int pdev_id, -+struct platform_device *__init omap_device_build(const char *pdev_name, int pdev_id, - struct omap_hwmod *oh, void *pdata, - int pdata_len, - struct omap_device_pm_latency *pm_lats, -@@ -652,7 +652,7 @@ struct platform_device *omap_device_buil - * platform_device record. Returns an ERR_PTR() on error, or passes - * along the return value of omap_device_register(). - */ --struct platform_device *omap_device_build_ss(const char *pdev_name, int pdev_id, -+struct platform_device *__init omap_device_build_ss(const char *pdev_name, int pdev_id, - struct omap_hwmod **ohs, int oh_cnt, - void *pdata, int pdata_len, - struct omap_device_pm_latency *pm_lats, -@@ -717,7 +717,7 @@ odbs_exit: - * platform_early_add_device() on the underlying platform_device. - * Returns 0 by default. - */ --static int omap_early_device_register(struct platform_device *pdev) -+static int __init omap_early_device_register(struct platform_device *pdev) - { - struct platform_device *devices[1]; - ---- a/arch/arm/plat-omap/common.c -+++ b/arch/arm/plat-omap/common.c -@@ -29,7 +29,7 @@ - - #define NO_LENGTH_CHECK 0xffffffff - --struct omap_board_config_kernel *omap_board_config __initdata; -+struct omap_board_config_kernel *omap_board_config; - int omap_board_config_size; - - unsigned char omap_bootloader_tag[1024]; -@@ -58,7 +58,7 @@ __tagtable(ATAG_BOARD, parse_tag_omap); - - #endif - --static const void *__init get_config(u16 tag, size_t len, -+static const void *get_config(u16 tag, size_t len, - int skip, size_t *len_out) - { - struct omap_board_config_kernel *kinfo = NULL; -@@ -125,12 +125,12 @@ static const void *__init get_config(u16 - return kinfo->data; - } - --const void *__init __omap_get_config(u16 tag, size_t len, int nr) -+const void *__omap_get_config(u16 tag, size_t len, int nr) - { - return get_config(tag, len, nr, NULL); - } - --const void *__init omap_get_var_config(u16 tag, size_t *len) -+const void *omap_get_var_config(u16 tag, size_t *len) - { - return get_config(tag, NO_LENGTH_CHECK, 0, len); - } ---- a/arch/arm/mach-omap2/devices.c -+++ b/arch/arm/mach-omap2/devices.c -@@ -380,7 +380,7 @@ static inline void omap_init_dmic(void) - - #include <plat/mcspi.h> - --static int omap_mcspi_init(struct omap_hwmod *oh, void *unused) -+static int __init omap_mcspi_init(struct omap_hwmod *oh, void *unused) - { - struct platform_device *pdev; - char *name = "omap2_mcspi"; ---- a/arch/arm/mach-omap2/gpio.c -+++ b/arch/arm/mach-omap2/gpio.c -@@ -24,7 +24,7 @@ - #include <plat/omap_hwmod.h> - #include <plat/omap_device.h> - --static int omap2_gpio_dev_init(struct omap_hwmod *oh, void *unused) -+static int __init omap2_gpio_dev_init(struct omap_hwmod *oh, void *unused) - { - struct platform_device *pdev; - struct omap_gpio_platform_data *pdata; ---- a/arch/arm/mach-omap2/mcbsp.c -+++ b/arch/arm/mach-omap2/mcbsp.c -@@ -122,7 +122,7 @@ static int omap3_enable_st_clock(unsigne - return 0; - } - --static int omap_init_mcbsp(struct omap_hwmod *oh, void *unused) -+static int __init omap_init_mcbsp(struct omap_hwmod *oh, void *unused) - { - int id, count = 1; - char *name = "omap-mcbsp"; ---- a/arch/arm/plat-omap/include/plat/board.h -+++ b/arch/arm/plat-omap/include/plat/board.h -@@ -159,14 +159,14 @@ struct omap_gpio_switch_config { - int key_code:24; /* Linux key code */ - }; - --extern const void *__init __omap_get_config(u16 tag, size_t len, int nr); -+extern const void * __omap_get_config(u16 tag, size_t len, int nr); - - #define omap_get_config(tag, type) \ - ((const type *) __omap_get_config((tag), sizeof(type), 0)) - #define omap_get_nr_config(tag, type, nr) \ - ((const type *) __omap_get_config((tag), sizeof(type), (nr))) - --extern const void *__init omap_get_var_config(u16 tag, size_t *len); -+extern const void * omap_get_var_config(u16 tag, size_t *len); - - extern struct omap_board_config_kernel *omap_board_config; - extern int omap_board_config_size; |