2 * nokia.c -- Nokia Composite Gadget Driver
4 * Copyright (C) 2008-2010 Nokia Corporation
5 * Contact: Felipe Balbi <felipe.balbi@nokia.com>
7 * This gadget driver borrows from serial.c which is:
9 * Copyright (C) 2003 Al Borchers (alborchers@steinerpoint.com)
10 * Copyright (C) 2008 by David Brownell
11 * Copyright (C) 2008 by Nokia Corporation
13 * This software is distributed under the terms of the GNU General
14 * Public License ("GPL") as published by the Free Software Foundation,
15 * version 2 of that License.
18 #include <linux/kernel.h>
19 #include <linux/device.h>
24 #include "gadget_chips.h"
28 #define NOKIA_VERSION_NUM 0x0211
29 #define NOKIA_LONG_NAME "N900 (PC-Suite Mode)"
31 /*-------------------------------------------------------------------------*/
34 * Kbuild is not very cooperative with respect to linking separately
35 * compiled library objects into one module. So for now we won't use
36 * separate compilation ... ensuring init/exit sections work to shrink
37 * the runtime footprint, and giving us at least some parts of what
38 * a "gcc --combine ... part1.c part2.c part3.c ... " build would.
40 #define USBF_OBEX_INCLUDED
46 /*-------------------------------------------------------------------------*/
47 USB_GADGET_COMPOSITE_OPTIONS();
49 #define NOKIA_VENDOR_ID 0x0421 /* Nokia */
50 #define NOKIA_PRODUCT_ID 0x01c8 /* Nokia Gadget */
52 /* string IDs are assigned dynamically */
54 #define STRING_DESCRIPTION_IDX USB_GADGET_FIRST_AVAIL_IDX
56 static char manufacturer_nokia[] = "Nokia";
57 static const char product_nokia[] = NOKIA_LONG_NAME;
58 static const char description_nokia[] = "PC-Suite Configuration";
60 static struct usb_string strings_dev[] = {
61 [USB_GADGET_MANUFACTURER_IDX].s = manufacturer_nokia,
62 [USB_GADGET_PRODUCT_IDX].s = NOKIA_LONG_NAME,
63 [USB_GADGET_SERIAL_IDX].s = "",
64 [STRING_DESCRIPTION_IDX].s = description_nokia,
68 static struct usb_gadget_strings stringtab_dev = {
69 .language = 0x0409, /* en-us */
70 .strings = strings_dev,
73 static struct usb_gadget_strings *dev_strings[] = {
78 static struct usb_device_descriptor device_desc = {
79 .bLength = USB_DT_DEVICE_SIZE,
80 .bDescriptorType = USB_DT_DEVICE,
81 .bcdUSB = __constant_cpu_to_le16(0x0200),
82 .bDeviceClass = USB_CLASS_COMM,
83 .idVendor = __constant_cpu_to_le16(NOKIA_VENDOR_ID),
84 .idProduct = __constant_cpu_to_le16(NOKIA_PRODUCT_ID),
85 .bcdDevice = cpu_to_le16(NOKIA_VERSION_NUM),
86 /* .iManufacturer = DYNAMIC */
87 /* .iProduct = DYNAMIC */
88 .bNumConfigurations = 1,
91 /*-------------------------------------------------------------------------*/
94 MODULE_DESCRIPTION("Nokia composite gadget driver for N900");
95 MODULE_AUTHOR("Felipe Balbi");
96 MODULE_LICENSE("GPL");
98 /*-------------------------------------------------------------------------*/
99 static struct usb_function *f_acm_cfg1;
100 static struct usb_function *f_acm_cfg2;
101 static u8 hostaddr[ETH_ALEN];
102 static struct eth_dev *the_dev;
110 static unsigned char tty_lines[TTY_PORTS_MAX];
112 static struct usb_configuration nokia_config_500ma_driver = {
113 .label = "Bus Powered",
114 .bConfigurationValue = 1,
115 /* .iConfiguration = DYNAMIC */
116 .bmAttributes = USB_CONFIG_ATT_ONE,
120 static struct usb_configuration nokia_config_100ma_driver = {
121 .label = "Self Powered",
122 .bConfigurationValue = 2,
123 /* .iConfiguration = DYNAMIC */
124 .bmAttributes = USB_CONFIG_ATT_ONE | USB_CONFIG_ATT_SELFPOWER,
128 static struct usb_function_instance *fi_acm;
130 static int __init nokia_bind_config(struct usb_configuration *c)
132 struct usb_function *f_acm;
135 status = phonet_bind_config(c);
137 printk(KERN_DEBUG "could not bind phonet config\n");
139 status = obex_bind_config(c, tty_lines[TTY_PORT_OBEX0]);
141 printk(KERN_DEBUG "could not bind obex config %d\n", 0);
143 status = obex_bind_config(c, tty_lines[TTY_PORT_OBEX1]);
145 printk(KERN_DEBUG "could not bind obex config %d\n", 0);
147 f_acm = usb_get_function(fi_acm);
149 return PTR_ERR(f_acm);
151 status = usb_add_function(c, f_acm);
155 status = ecm_bind_config(c, hostaddr, the_dev);
157 pr_debug("could not bind ecm config %d\n", status);
160 if (c == &nokia_config_500ma_driver)
167 usb_remove_function(c, f_acm);
169 usb_put_function(f_acm);
173 static int __init nokia_bind(struct usb_composite_dev *cdev)
175 struct usb_gadget *gadget = cdev->gadget;
179 status = gphonet_setup(cdev->gadget);
183 for (cur_line = 0; cur_line < TTY_PORTS_MAX; cur_line++) {
184 status = gserial_alloc_line(&tty_lines[cur_line]);
189 the_dev = gether_setup(cdev->gadget, hostaddr);
190 if (IS_ERR(the_dev)) {
191 status = PTR_ERR(the_dev);
195 status = usb_string_ids_tab(cdev, strings_dev);
198 device_desc.iManufacturer = strings_dev[USB_GADGET_MANUFACTURER_IDX].id;
199 device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id;
200 status = strings_dev[STRING_DESCRIPTION_IDX].id;
201 nokia_config_500ma_driver.iConfiguration = status;
202 nokia_config_100ma_driver.iConfiguration = status;
204 if (!gadget_supports_altsettings(gadget))
207 fi_acm = usb_get_function_instance("acm");
211 /* finally register the configuration */
212 status = usb_add_config(cdev, &nokia_config_500ma_driver,
217 status = usb_add_config(cdev, &nokia_config_100ma_driver,
222 usb_composite_overwrite_options(cdev, &coverwrite);
223 dev_info(&gadget->dev, "%s\n", NOKIA_LONG_NAME);
228 usb_put_function(f_acm_cfg1);
230 usb_put_function_instance(fi_acm);
232 gether_cleanup(the_dev);
235 while (cur_line >= 0)
236 gserial_free_line(tty_lines[cur_line--]);
243 static int __exit nokia_unbind(struct usb_composite_dev *cdev)
247 usb_put_function(f_acm_cfg1);
248 usb_put_function(f_acm_cfg2);
249 usb_put_function_instance(fi_acm);
252 for (i = 0; i < TTY_PORTS_MAX; i++)
253 gserial_free_line(tty_lines[i]);
255 gether_cleanup(the_dev);
260 static __refdata struct usb_composite_driver nokia_driver = {
263 .strings = dev_strings,
264 .max_speed = USB_SPEED_HIGH,
266 .unbind = __exit_p(nokia_unbind),
269 static int __init nokia_init(void)
271 return usb_composite_probe(&nokia_driver);
273 module_init(nokia_init);
275 static void __exit nokia_cleanup(void)
277 usb_composite_unregister(&nokia_driver);
279 module_exit(nokia_cleanup);