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
);