From mboxrd@z Thu Jan 1 00:00:00 1970 From: anarsoul@gmail.com (Vasily Khoruzhick) Date: Sun, 28 Oct 2012 18:42:26 +0300 Subject: [PATCH v2 1/5] ARM: PXA: Add z2-usb-switch driver In-Reply-To: References: Message-ID: <1351438946-5331-1-git-send-email-anarsoul@gmail.com> To: linux-arm-kernel@lists.infradead.org List-Id: linux-arm-kernel.lists.infradead.org This driver controls mode of USB port #2 pins - device or host. Signed-off-by: Vasily Khoruzhick --- arch/arm/mach-pxa/Kconfig | 7 +++ arch/arm/mach-pxa/Makefile | 1 + arch/arm/mach-pxa/z2-usb-switch.c | 100 ++++++++++++++++++++++++++++++++++++++ 3 files changed, 108 insertions(+) create mode 100644 arch/arm/mach-pxa/z2-usb-switch.c diff --git a/arch/arm/mach-pxa/Kconfig b/arch/arm/mach-pxa/Kconfig index 11aa739..5fffc4b 100644 --- a/arch/arm/mach-pxa/Kconfig +++ b/arch/arm/mach-pxa/Kconfig @@ -630,6 +630,13 @@ config MACH_ZIPIT2 bool "Zipit Z2 Handheld" select HAVE_PWM select PXA27x + +config Z2_USB_SWITCH + tristate "Control the state of USB port on Zipit Z2" + depends on MACH_ZIPIT2 + help + This is a simple driver that is able to control + usb mode of Zipit Z2 endif endmenu diff --git a/arch/arm/mach-pxa/Makefile b/arch/arm/mach-pxa/Makefile index ee88d6e..86a032f 100644 --- a/arch/arm/mach-pxa/Makefile +++ b/arch/arm/mach-pxa/Makefile @@ -99,3 +99,4 @@ obj-$(CONFIG_MACH_RAUMFELD_SPEAKER) += raumfeld.o obj-$(CONFIG_MACH_ZIPIT2) += z2.o obj-$(CONFIG_TOSA_BT) += tosa-bt.o +obj-$(CONFIG_Z2_USB_SWITCH) += z2-usb-switch.o diff --git a/arch/arm/mach-pxa/z2-usb-switch.c b/arch/arm/mach-pxa/z2-usb-switch.c new file mode 100644 index 0000000..9583092 --- /dev/null +++ b/arch/arm/mach-pxa/z2-usb-switch.c @@ -0,0 +1,100 @@ +/* + * USB mode switcher for Z2 + * + * Copyright (c) 2011 Vasily Khoruzhick + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + */ + +#include +#include +#include +#include + +#include +#include + +#include + +#define MIN(a, b) ((a) < (b) ? (a) : (b)) + +static ssize_t usb_mode_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + if (UP2OCR & UP2OCR_HXS) + return sprintf(buf, "host\n"); + else + return sprintf(buf, "device\n"); +} + +static ssize_t usb_mode_set(struct device *dev, struct device_attribute *attr, + const char *buf, size_t count) +{ + if (strncmp(buf, "host", MIN(count, 4)) == 0) { + UP2OCR = UP2OCR_HXS | UP2OCR_HXOE | UP2OCR_DPPDE | UP2OCR_DMPDE; + return count; + } else if (strncmp(buf, "device", MIN(count, 6)) == 0) { + UP2OCR = UP2OCR_HXOE | UP2OCR_DPPUE; + return count; + } + return -EINVAL; +} + +static DEVICE_ATTR(usb_mode, 0644, usb_mode_show, usb_mode_set); + +static const struct attribute *attrs[] = { + &dev_attr_usb_mode.attr, + NULL, +}; + +static const struct attribute_group attr_group = { + .attrs = (struct attribute **)attrs, +}; + +static int z2_usb_switch_probe(struct platform_device *dev) +{ + int res; + + res = sysfs_create_group(&dev->dev.kobj, &attr_group); + if (res) + return res; + + UP2OCR = UP2OCR_HXOE | UP2OCR_DPPUE; + + return 0; +} + +static int __devexit z2_usb_switch_remove(struct platform_device *dev) +{ + UP2OCR = UP2OCR_HXOE; + sysfs_remove_group(&dev->dev.kobj, &attr_group); + + return 0; +} + +static struct platform_driver z2_usb_switch_driver = { + .probe = z2_usb_switch_probe, + .remove = __devexit_p(z2_usb_switch_remove), + + .driver = { + .name = "z2-usb-switch", + .owner = THIS_MODULE, + }, +}; + + +static int __init z2_usb_switch_init(void) +{ + return platform_driver_register(&z2_usb_switch_driver); +} + +static void __exit z2_usb_switch_exit(void) +{ + platform_driver_unregister(&z2_usb_switch_driver); +} + +module_init(z2_usb_switch_init); +module_exit(z2_usb_switch_exit); -- 1.7.12.4