| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 1 | /* | 
 | 2 |  * Driver for the VoIP USB phones with CM109 chipsets. | 
 | 3 |  * | 
 | 4 |  * Copyright (C) 2007 - 2008 Alfred E. Heggestad <aeh@db.org> | 
 | 5 |  * | 
 | 6 |  *	This program is free software; you can redistribute it and/or | 
 | 7 |  *	modify it under the terms of the GNU General Public License as | 
 | 8 |  *	published by the Free Software Foundation, version 2. | 
 | 9 |  */ | 
 | 10 |  | 
 | 11 | /* | 
 | 12 |  *   Tested devices: | 
 | 13 |  *	- Komunikate KIP1000 | 
 | 14 |  *	- Genius G-talk | 
 | 15 |  *	- Allied-Telesis Corega USBPH01 | 
 | 16 |  *	- ... | 
 | 17 |  * | 
 | 18 |  * This driver is based on the yealink.c driver | 
 | 19 |  * | 
 | 20 |  * Thanks to: | 
 | 21 |  *   - Authors of yealink.c | 
 | 22 |  *   - Thomas Reitmayr | 
 | 23 |  *   - Oliver Neukum for good review comments and code | 
 | 24 |  *   - Shaun Jackman <sjackman@gmail.com> for Genius G-talk keymap | 
 | 25 |  *   - Dmitry Torokhov for valuable input and review | 
 | 26 |  * | 
 | 27 |  * Todo: | 
 | 28 |  *   - Read/write EEPROM | 
 | 29 |  */ | 
 | 30 |  | 
 | 31 | #include <linux/kernel.h> | 
 | 32 | #include <linux/init.h> | 
 | 33 | #include <linux/slab.h> | 
 | 34 | #include <linux/module.h> | 
 | 35 | #include <linux/moduleparam.h> | 
 | 36 | #include <linux/rwsem.h> | 
 | 37 | #include <linux/usb/input.h> | 
 | 38 |  | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 39 | #define DRIVER_VERSION "20080805" | 
 | 40 | #define DRIVER_AUTHOR  "Alfred E. Heggestad" | 
 | 41 | #define DRIVER_DESC    "CM109 phone driver" | 
 | 42 |  | 
 | 43 | static char *phone = "kip1000"; | 
 | 44 | module_param(phone, charp, S_IRUSR); | 
| Daniel Gimpelevich | 734f0ba | 2008-11-11 13:57:30 -0500 | [diff] [blame] | 45 | MODULE_PARM_DESC(phone, "Phone name {kip1000, gtalk, usbph01, atcom}"); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 46 |  | 
 | 47 | enum { | 
 | 48 | 	/* HID Registers */ | 
 | 49 | 	HID_IR0 = 0x00, /* Record/Playback-mute button, Volume up/down  */ | 
 | 50 | 	HID_IR1 = 0x01, /* GPI, generic registers or EEPROM_DATA0       */ | 
 | 51 | 	HID_IR2 = 0x02, /* Generic registers or EEPROM_DATA1            */ | 
 | 52 | 	HID_IR3 = 0x03, /* Generic registers or EEPROM_CTRL             */ | 
 | 53 | 	HID_OR0 = 0x00, /* Mapping control, buzzer, SPDIF (offset 0x04) */ | 
 | 54 | 	HID_OR1 = 0x01, /* GPO - General Purpose Output                 */ | 
 | 55 | 	HID_OR2 = 0x02, /* Set GPIO to input/output mode                */ | 
 | 56 | 	HID_OR3 = 0x03, /* SPDIF status channel or EEPROM_CTRL          */ | 
 | 57 |  | 
 | 58 | 	/* HID_IR0 */ | 
 | 59 | 	RECORD_MUTE   = 1 << 3, | 
 | 60 | 	PLAYBACK_MUTE = 1 << 2, | 
 | 61 | 	VOLUME_DOWN   = 1 << 1, | 
 | 62 | 	VOLUME_UP     = 1 << 0, | 
 | 63 |  | 
 | 64 | 	/* HID_OR0 */ | 
 | 65 | 	/* bits 7-6 | 
 | 66 | 	   0: HID_OR1-2 are used for GPO; HID_OR0, 3 are used for buzzer | 
 | 67 | 	      and SPDIF | 
 | 68 | 	   1: HID_OR0-3 are used as generic HID registers | 
 | 69 | 	   2: Values written to HID_OR0-3 are also mapped to MCU_CTRL, | 
 | 70 | 	      EEPROM_DATA0-1, EEPROM_CTRL (see Note) | 
 | 71 | 	   3: Reserved | 
 | 72 | 	 */ | 
 | 73 | 	HID_OR_GPO_BUZ_SPDIF   = 0 << 6, | 
 | 74 | 	HID_OR_GENERIC_HID_REG = 1 << 6, | 
 | 75 | 	HID_OR_MAP_MCU_EEPROM  = 2 << 6, | 
 | 76 |  | 
 | 77 | 	BUZZER_ON = 1 << 5, | 
 | 78 |  | 
 | 79 | 	/* up to 256 normal keys, up to 16 special keys */ | 
 | 80 | 	KEYMAP_SIZE = 256 + 16, | 
 | 81 | }; | 
 | 82 |  | 
 | 83 | /* CM109 protocol packet */ | 
 | 84 | struct cm109_ctl_packet { | 
 | 85 | 	u8 byte[4]; | 
 | 86 | } __attribute__ ((packed)); | 
 | 87 |  | 
 | 88 | enum { USB_PKT_LEN = sizeof(struct cm109_ctl_packet) }; | 
 | 89 |  | 
 | 90 | /* CM109 device structure */ | 
 | 91 | struct cm109_dev { | 
 | 92 | 	struct input_dev *idev;	 /* input device */ | 
 | 93 | 	struct usb_device *udev; /* usb device */ | 
 | 94 | 	struct usb_interface *intf; | 
 | 95 |  | 
 | 96 | 	/* irq input channel */ | 
 | 97 | 	struct cm109_ctl_packet *irq_data; | 
 | 98 | 	dma_addr_t irq_dma; | 
 | 99 | 	struct urb *urb_irq; | 
 | 100 |  | 
 | 101 | 	/* control output channel */ | 
 | 102 | 	struct cm109_ctl_packet *ctl_data; | 
 | 103 | 	dma_addr_t ctl_dma; | 
 | 104 | 	struct usb_ctrlrequest *ctl_req; | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 105 | 	struct urb *urb_ctl; | 
 | 106 | 	/* | 
 | 107 | 	 * The 3 bitfields below are protected by ctl_submit_lock. | 
 | 108 | 	 * They have to be separate since they are accessed from IRQ | 
 | 109 | 	 * context. | 
 | 110 | 	 */ | 
 | 111 | 	unsigned irq_urb_pending:1;	/* irq_urb is in flight */ | 
 | 112 | 	unsigned ctl_urb_pending:1;	/* ctl_urb is in flight */ | 
 | 113 | 	unsigned buzzer_pending:1;	/* need to issue buzz command */ | 
 | 114 | 	spinlock_t ctl_submit_lock; | 
 | 115 |  | 
 | 116 | 	unsigned char buzzer_state;	/* on/off */ | 
 | 117 |  | 
 | 118 | 	/* flags */ | 
 | 119 | 	unsigned open:1; | 
 | 120 | 	unsigned resetting:1; | 
 | 121 | 	unsigned shutdown:1; | 
 | 122 |  | 
 | 123 | 	/* This mutex protects writes to the above flags */ | 
 | 124 | 	struct mutex pm_mutex; | 
 | 125 |  | 
 | 126 | 	unsigned short keymap[KEYMAP_SIZE]; | 
 | 127 |  | 
 | 128 | 	char phys[64];		/* physical device path */ | 
 | 129 | 	int key_code;		/* last reported key */ | 
 | 130 | 	int keybit;		/* 0=new scan  1,2,4,8=scan columns  */ | 
 | 131 | 	u8 gpi;			/* Cached value of GPI (high nibble) */ | 
 | 132 | }; | 
 | 133 |  | 
 | 134 | /****************************************************************************** | 
 | 135 |  * CM109 key interface | 
 | 136 |  *****************************************************************************/ | 
 | 137 |  | 
 | 138 | static unsigned short special_keymap(int code) | 
 | 139 | { | 
 | 140 | 	if (code > 0xff) { | 
 | 141 | 		switch (code - 0xff) { | 
 | 142 | 		case RECORD_MUTE:	return KEY_MUTE; | 
 | 143 | 		case PLAYBACK_MUTE:	return KEY_MUTE; | 
 | 144 | 		case VOLUME_DOWN:	return KEY_VOLUMEDOWN; | 
 | 145 | 		case VOLUME_UP:		return KEY_VOLUMEUP; | 
 | 146 | 		} | 
 | 147 | 	} | 
 | 148 | 	return KEY_RESERVED; | 
 | 149 | } | 
 | 150 |  | 
 | 151 | /* Map device buttons to internal key events. | 
 | 152 |  * | 
 | 153 |  * The "up" and "down" keys, are symbolised by arrows on the button. | 
 | 154 |  * The "pickup" and "hangup" keys are symbolised by a green and red phone | 
 | 155 |  * on the button. | 
 | 156 |  | 
 | 157 |  Komunikate KIP1000 Keyboard Matrix | 
 | 158 |  | 
 | 159 |      -> -- 1 -- 2 -- 3  --> GPI pin 4 (0x10) | 
 | 160 |       |    |    |    | | 
 | 161 |      <- -- 4 -- 5 -- 6  --> GPI pin 5 (0x20) | 
 | 162 |       |    |    |    | | 
 | 163 |      END - 7 -- 8 -- 9  --> GPI pin 6 (0x40) | 
 | 164 |       |    |    |    | | 
 | 165 |      OK -- * -- 0 -- #  --> GPI pin 7 (0x80) | 
 | 166 |       |    |    |    | | 
 | 167 |  | 
 | 168 |      /|\  /|\  /|\  /|\ | 
 | 169 |       |    |    |    | | 
 | 170 | GPO | 
 | 171 | pin:  3    2    1    0 | 
 | 172 |      0x8  0x4  0x2  0x1 | 
 | 173 |  | 
 | 174 |  */ | 
 | 175 | static unsigned short keymap_kip1000(int scancode) | 
 | 176 | { | 
 | 177 | 	switch (scancode) {				/* phone key:   */ | 
 | 178 | 	case 0x82: return KEY_NUMERIC_0;		/*   0          */ | 
 | 179 | 	case 0x14: return KEY_NUMERIC_1;		/*   1          */ | 
 | 180 | 	case 0x12: return KEY_NUMERIC_2;		/*   2          */ | 
 | 181 | 	case 0x11: return KEY_NUMERIC_3;		/*   3          */ | 
 | 182 | 	case 0x24: return KEY_NUMERIC_4;		/*   4          */ | 
 | 183 | 	case 0x22: return KEY_NUMERIC_5;		/*   5          */ | 
 | 184 | 	case 0x21: return KEY_NUMERIC_6;		/*   6          */ | 
 | 185 | 	case 0x44: return KEY_NUMERIC_7;		/*   7          */ | 
 | 186 | 	case 0x42: return KEY_NUMERIC_8;		/*   8          */ | 
 | 187 | 	case 0x41: return KEY_NUMERIC_9;		/*   9          */ | 
 | 188 | 	case 0x81: return KEY_NUMERIC_POUND;		/*   #          */ | 
 | 189 | 	case 0x84: return KEY_NUMERIC_STAR;		/*   *          */ | 
 | 190 | 	case 0x88: return KEY_ENTER;			/*   pickup     */ | 
 | 191 | 	case 0x48: return KEY_ESC;			/*   hangup     */ | 
 | 192 | 	case 0x28: return KEY_LEFT;			/*   IN         */ | 
 | 193 | 	case 0x18: return KEY_RIGHT;			/*   OUT        */ | 
 | 194 | 	default:   return special_keymap(scancode); | 
 | 195 | 	} | 
 | 196 | } | 
 | 197 |  | 
 | 198 | /* | 
 | 199 |   Contributed by Shaun Jackman <sjackman@gmail.com> | 
 | 200 |  | 
 | 201 |   Genius G-Talk keyboard matrix | 
 | 202 |      0 1 2 3 | 
 | 203 |   4: 0 4 8 Talk | 
 | 204 |   5: 1 5 9 End | 
 | 205 |   6: 2 6 # Up | 
 | 206 |   7: 3 7 * Down | 
 | 207 | */ | 
 | 208 | static unsigned short keymap_gtalk(int scancode) | 
 | 209 | { | 
 | 210 | 	switch (scancode) { | 
 | 211 | 	case 0x11: return KEY_NUMERIC_0; | 
 | 212 | 	case 0x21: return KEY_NUMERIC_1; | 
 | 213 | 	case 0x41: return KEY_NUMERIC_2; | 
 | 214 | 	case 0x81: return KEY_NUMERIC_3; | 
 | 215 | 	case 0x12: return KEY_NUMERIC_4; | 
 | 216 | 	case 0x22: return KEY_NUMERIC_5; | 
 | 217 | 	case 0x42: return KEY_NUMERIC_6; | 
 | 218 | 	case 0x82: return KEY_NUMERIC_7; | 
 | 219 | 	case 0x14: return KEY_NUMERIC_8; | 
 | 220 | 	case 0x24: return KEY_NUMERIC_9; | 
 | 221 | 	case 0x44: return KEY_NUMERIC_POUND;	/* # */ | 
 | 222 | 	case 0x84: return KEY_NUMERIC_STAR;	/* * */ | 
 | 223 | 	case 0x18: return KEY_ENTER;		/* Talk (green handset) */ | 
 | 224 | 	case 0x28: return KEY_ESC;		/* End (red handset) */ | 
 | 225 | 	case 0x48: return KEY_UP;		/* Menu up (rocker switch) */ | 
 | 226 | 	case 0x88: return KEY_DOWN;		/* Menu down (rocker switch) */ | 
 | 227 | 	default:   return special_keymap(scancode); | 
 | 228 | 	} | 
 | 229 | } | 
 | 230 |  | 
 | 231 | /* | 
 | 232 |  * Keymap for Allied-Telesis Corega USBPH01 | 
 | 233 |  * http://www.alliedtelesis-corega.com/2/1344/1437/1360/chprd.html | 
 | 234 |  * | 
 | 235 |  * Contributed by july@nat.bg | 
 | 236 |  */ | 
 | 237 | static unsigned short keymap_usbph01(int scancode) | 
 | 238 | { | 
 | 239 | 	switch (scancode) { | 
 | 240 | 	case 0x11: return KEY_NUMERIC_0;		/*   0          */ | 
 | 241 | 	case 0x21: return KEY_NUMERIC_1;		/*   1          */ | 
 | 242 | 	case 0x41: return KEY_NUMERIC_2;		/*   2          */ | 
 | 243 | 	case 0x81: return KEY_NUMERIC_3;		/*   3          */ | 
 | 244 | 	case 0x12: return KEY_NUMERIC_4;		/*   4          */ | 
 | 245 | 	case 0x22: return KEY_NUMERIC_5;		/*   5          */ | 
 | 246 | 	case 0x42: return KEY_NUMERIC_6;		/*   6          */ | 
 | 247 | 	case 0x82: return KEY_NUMERIC_7;		/*   7          */ | 
 | 248 | 	case 0x14: return KEY_NUMERIC_8;		/*   8          */ | 
 | 249 | 	case 0x24: return KEY_NUMERIC_9;		/*   9          */ | 
 | 250 | 	case 0x44: return KEY_NUMERIC_POUND;		/*   #          */ | 
 | 251 | 	case 0x84: return KEY_NUMERIC_STAR;		/*   *          */ | 
 | 252 | 	case 0x18: return KEY_ENTER;			/*   pickup     */ | 
 | 253 | 	case 0x28: return KEY_ESC;			/*   hangup     */ | 
 | 254 | 	case 0x48: return KEY_LEFT;			/*   IN         */ | 
 | 255 | 	case 0x88: return KEY_RIGHT;			/*   OUT        */ | 
 | 256 | 	default:   return special_keymap(scancode); | 
 | 257 | 	} | 
 | 258 | } | 
 | 259 |  | 
| Daniel Gimpelevich | 734f0ba | 2008-11-11 13:57:30 -0500 | [diff] [blame] | 260 | /* | 
 | 261 |  * Keymap for ATCom AU-100 | 
| Justin P. Mattock | 631dd1a | 2010-10-18 11:03:14 +0200 | [diff] [blame] | 262 |  * http://www.atcom.cn/products.html  | 
| Daniel Gimpelevich | 734f0ba | 2008-11-11 13:57:30 -0500 | [diff] [blame] | 263 |  * http://www.packetizer.com/products/au100/ | 
 | 264 |  * http://www.voip-info.org/wiki/view/AU-100 | 
 | 265 |  * | 
 | 266 |  * Contributed by daniel@gimpelevich.san-francisco.ca.us | 
 | 267 |  */ | 
 | 268 | static unsigned short keymap_atcom(int scancode) | 
 | 269 | { | 
 | 270 | 	switch (scancode) {				/* phone key:   */ | 
 | 271 | 	case 0x82: return KEY_NUMERIC_0;		/*   0          */ | 
 | 272 | 	case 0x11: return KEY_NUMERIC_1;		/*   1          */ | 
 | 273 | 	case 0x12: return KEY_NUMERIC_2;		/*   2          */ | 
 | 274 | 	case 0x14: return KEY_NUMERIC_3;		/*   3          */ | 
 | 275 | 	case 0x21: return KEY_NUMERIC_4;		/*   4          */ | 
 | 276 | 	case 0x22: return KEY_NUMERIC_5;		/*   5          */ | 
 | 277 | 	case 0x24: return KEY_NUMERIC_6;		/*   6          */ | 
 | 278 | 	case 0x41: return KEY_NUMERIC_7;		/*   7          */ | 
 | 279 | 	case 0x42: return KEY_NUMERIC_8;		/*   8          */ | 
 | 280 | 	case 0x44: return KEY_NUMERIC_9;		/*   9          */ | 
 | 281 | 	case 0x84: return KEY_NUMERIC_POUND;		/*   #          */ | 
 | 282 | 	case 0x81: return KEY_NUMERIC_STAR;		/*   *          */ | 
 | 283 | 	case 0x18: return KEY_ENTER;			/*   pickup     */ | 
 | 284 | 	case 0x28: return KEY_ESC;			/*   hangup     */ | 
 | 285 | 	case 0x48: return KEY_LEFT;			/* left arrow   */ | 
 | 286 | 	case 0x88: return KEY_RIGHT;			/* right arrow  */ | 
 | 287 | 	default:   return special_keymap(scancode); | 
 | 288 | 	} | 
 | 289 | } | 
 | 290 |  | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 291 | static unsigned short (*keymap)(int) = keymap_kip1000; | 
 | 292 |  | 
 | 293 | /* | 
 | 294 |  * Completes a request by converting the data into events for the | 
 | 295 |  * input subsystem. | 
 | 296 |  */ | 
 | 297 | static void report_key(struct cm109_dev *dev, int key) | 
 | 298 | { | 
 | 299 | 	struct input_dev *idev = dev->idev; | 
 | 300 |  | 
 | 301 | 	if (dev->key_code >= 0) { | 
 | 302 | 		/* old key up */ | 
 | 303 | 		input_report_key(idev, dev->key_code, 0); | 
 | 304 | 	} | 
 | 305 |  | 
 | 306 | 	dev->key_code = key; | 
 | 307 | 	if (key >= 0) { | 
 | 308 | 		/* new valid key */ | 
 | 309 | 		input_report_key(idev, key, 1); | 
 | 310 | 	} | 
 | 311 |  | 
 | 312 | 	input_sync(idev); | 
 | 313 | } | 
 | 314 |  | 
 | 315 | /****************************************************************************** | 
 | 316 |  * CM109 usb communication interface | 
 | 317 |  *****************************************************************************/ | 
 | 318 |  | 
 | 319 | static void cm109_submit_buzz_toggle(struct cm109_dev *dev) | 
 | 320 | { | 
 | 321 | 	int error; | 
 | 322 |  | 
 | 323 | 	if (dev->buzzer_state) | 
 | 324 | 		dev->ctl_data->byte[HID_OR0] |= BUZZER_ON; | 
 | 325 | 	else | 
 | 326 | 		dev->ctl_data->byte[HID_OR0] &= ~BUZZER_ON; | 
 | 327 |  | 
 | 328 | 	error = usb_submit_urb(dev->urb_ctl, GFP_ATOMIC); | 
 | 329 | 	if (error) | 
 | 330 | 		err("%s: usb_submit_urb (urb_ctl) failed %d", __func__, error); | 
 | 331 | } | 
 | 332 |  | 
 | 333 | /* | 
 | 334 |  * IRQ handler | 
 | 335 |  */ | 
 | 336 | static void cm109_urb_irq_callback(struct urb *urb) | 
 | 337 | { | 
 | 338 | 	struct cm109_dev *dev = urb->context; | 
 | 339 | 	const int status = urb->status; | 
 | 340 | 	int error; | 
 | 341 |  | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 342 | 	dev_dbg(&urb->dev->dev, "### URB IRQ: [0x%02x 0x%02x 0x%02x 0x%02x] keybit=0x%02x\n", | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 343 | 	     dev->irq_data->byte[0], | 
 | 344 | 	     dev->irq_data->byte[1], | 
 | 345 | 	     dev->irq_data->byte[2], | 
 | 346 | 	     dev->irq_data->byte[3], | 
 | 347 | 	     dev->keybit); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 348 |  | 
 | 349 | 	if (status) { | 
 | 350 | 		if (status == -ESHUTDOWN) | 
 | 351 | 			return; | 
 | 352 | 		err("%s: urb status %d", __func__, status); | 
 | 353 | 	} | 
 | 354 |  | 
 | 355 | 	/* Special keys */ | 
 | 356 | 	if (dev->irq_data->byte[HID_IR0] & 0x0f) { | 
 | 357 | 		const int code = (dev->irq_data->byte[HID_IR0] & 0x0f); | 
 | 358 | 		report_key(dev, dev->keymap[0xff + code]); | 
 | 359 | 	} | 
 | 360 |  | 
 | 361 | 	/* Scan key column */ | 
 | 362 | 	if (dev->keybit == 0xf) { | 
 | 363 |  | 
 | 364 | 		/* Any changes ? */ | 
 | 365 | 		if ((dev->gpi & 0xf0) == (dev->irq_data->byte[HID_IR1] & 0xf0)) | 
 | 366 | 			goto out; | 
 | 367 |  | 
 | 368 | 		dev->gpi = dev->irq_data->byte[HID_IR1] & 0xf0; | 
 | 369 | 		dev->keybit = 0x1; | 
 | 370 | 	} else { | 
 | 371 | 		report_key(dev, dev->keymap[dev->irq_data->byte[HID_IR1]]); | 
 | 372 |  | 
 | 373 | 		dev->keybit <<= 1; | 
 | 374 | 		if (dev->keybit > 0x8) | 
 | 375 | 			dev->keybit = 0xf; | 
 | 376 | 	} | 
 | 377 |  | 
 | 378 |  out: | 
 | 379 |  | 
 | 380 | 	spin_lock(&dev->ctl_submit_lock); | 
 | 381 |  | 
 | 382 | 	dev->irq_urb_pending = 0; | 
 | 383 |  | 
 | 384 | 	if (likely(!dev->shutdown)) { | 
 | 385 |  | 
 | 386 | 		if (dev->buzzer_state) | 
 | 387 | 			dev->ctl_data->byte[HID_OR0] |= BUZZER_ON; | 
 | 388 | 		else | 
 | 389 | 			dev->ctl_data->byte[HID_OR0] &= ~BUZZER_ON; | 
 | 390 |  | 
 | 391 | 		dev->ctl_data->byte[HID_OR1] = dev->keybit; | 
 | 392 | 		dev->ctl_data->byte[HID_OR2] = dev->keybit; | 
 | 393 |  | 
 | 394 | 		dev->buzzer_pending = 0; | 
 | 395 | 		dev->ctl_urb_pending = 1; | 
 | 396 |  | 
 | 397 | 		error = usb_submit_urb(dev->urb_ctl, GFP_ATOMIC); | 
 | 398 | 		if (error) | 
 | 399 | 			err("%s: usb_submit_urb (urb_ctl) failed %d", | 
 | 400 | 				__func__, error); | 
 | 401 | 	} | 
 | 402 |  | 
 | 403 | 	spin_unlock(&dev->ctl_submit_lock); | 
 | 404 | } | 
 | 405 |  | 
 | 406 | static void cm109_urb_ctl_callback(struct urb *urb) | 
 | 407 | { | 
 | 408 | 	struct cm109_dev *dev = urb->context; | 
 | 409 | 	const int status = urb->status; | 
 | 410 | 	int error; | 
 | 411 |  | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 412 | 	dev_dbg(&urb->dev->dev, "### URB CTL: [0x%02x 0x%02x 0x%02x 0x%02x]\n", | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 413 | 	     dev->ctl_data->byte[0], | 
 | 414 | 	     dev->ctl_data->byte[1], | 
 | 415 | 	     dev->ctl_data->byte[2], | 
 | 416 | 	     dev->ctl_data->byte[3]); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 417 |  | 
 | 418 | 	if (status) | 
 | 419 | 		err("%s: urb status %d", __func__, status); | 
 | 420 |  | 
 | 421 | 	spin_lock(&dev->ctl_submit_lock); | 
 | 422 |  | 
 | 423 | 	dev->ctl_urb_pending = 0; | 
 | 424 |  | 
 | 425 | 	if (likely(!dev->shutdown)) { | 
 | 426 |  | 
 | 427 | 		if (dev->buzzer_pending) { | 
 | 428 | 			dev->buzzer_pending = 0; | 
 | 429 | 			dev->ctl_urb_pending = 1; | 
 | 430 | 			cm109_submit_buzz_toggle(dev); | 
 | 431 | 		} else if (likely(!dev->irq_urb_pending)) { | 
 | 432 | 			/* ask for key data */ | 
 | 433 | 			dev->irq_urb_pending = 1; | 
 | 434 | 			error = usb_submit_urb(dev->urb_irq, GFP_ATOMIC); | 
 | 435 | 			if (error) | 
 | 436 | 				err("%s: usb_submit_urb (urb_irq) failed %d", | 
 | 437 | 					__func__, error); | 
 | 438 | 		} | 
 | 439 | 	} | 
 | 440 |  | 
 | 441 | 	spin_unlock(&dev->ctl_submit_lock); | 
 | 442 | } | 
 | 443 |  | 
 | 444 | static void cm109_toggle_buzzer_async(struct cm109_dev *dev) | 
 | 445 | { | 
 | 446 | 	unsigned long flags; | 
 | 447 |  | 
 | 448 | 	spin_lock_irqsave(&dev->ctl_submit_lock, flags); | 
 | 449 |  | 
 | 450 | 	if (dev->ctl_urb_pending) { | 
 | 451 | 		/* URB completion will resubmit */ | 
 | 452 | 		dev->buzzer_pending = 1; | 
 | 453 | 	} else { | 
 | 454 | 		dev->ctl_urb_pending = 1; | 
 | 455 | 		cm109_submit_buzz_toggle(dev); | 
 | 456 | 	} | 
 | 457 |  | 
 | 458 | 	spin_unlock_irqrestore(&dev->ctl_submit_lock, flags); | 
 | 459 | } | 
 | 460 |  | 
 | 461 | static void cm109_toggle_buzzer_sync(struct cm109_dev *dev, int on) | 
 | 462 | { | 
 | 463 | 	int error; | 
 | 464 |  | 
 | 465 | 	if (on) | 
 | 466 | 		dev->ctl_data->byte[HID_OR0] |= BUZZER_ON; | 
 | 467 | 	else | 
 | 468 | 		dev->ctl_data->byte[HID_OR0] &= ~BUZZER_ON; | 
 | 469 |  | 
 | 470 | 	error = usb_control_msg(dev->udev, | 
 | 471 | 				usb_sndctrlpipe(dev->udev, 0), | 
 | 472 | 				dev->ctl_req->bRequest, | 
 | 473 | 				dev->ctl_req->bRequestType, | 
 | 474 | 				le16_to_cpu(dev->ctl_req->wValue), | 
 | 475 | 				le16_to_cpu(dev->ctl_req->wIndex), | 
 | 476 | 				dev->ctl_data, | 
 | 477 | 				USB_PKT_LEN, USB_CTRL_SET_TIMEOUT); | 
| axel lin | 7b727ac | 2011-08-25 09:42:09 -0700 | [diff] [blame] | 478 | 	if (error < 0 && error != -EINTR) | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 479 | 		err("%s: usb_control_msg() failed %d", __func__, error); | 
 | 480 | } | 
 | 481 |  | 
 | 482 | static void cm109_stop_traffic(struct cm109_dev *dev) | 
 | 483 | { | 
 | 484 | 	dev->shutdown = 1; | 
 | 485 | 	/* | 
 | 486 | 	 * Make sure other CPUs see this | 
 | 487 | 	 */ | 
 | 488 | 	smp_wmb(); | 
 | 489 |  | 
 | 490 | 	usb_kill_urb(dev->urb_ctl); | 
 | 491 | 	usb_kill_urb(dev->urb_irq); | 
 | 492 |  | 
 | 493 | 	cm109_toggle_buzzer_sync(dev, 0); | 
 | 494 |  | 
 | 495 | 	dev->shutdown = 0; | 
 | 496 | 	smp_wmb(); | 
 | 497 | } | 
 | 498 |  | 
 | 499 | static void cm109_restore_state(struct cm109_dev *dev) | 
 | 500 | { | 
 | 501 | 	if (dev->open) { | 
 | 502 | 		/* | 
 | 503 | 		 * Restore buzzer state. | 
 | 504 | 		 * This will also kick regular URB submission | 
 | 505 | 		 */ | 
 | 506 | 		cm109_toggle_buzzer_async(dev); | 
 | 507 | 	} | 
 | 508 | } | 
 | 509 |  | 
 | 510 | /****************************************************************************** | 
 | 511 |  * input event interface | 
 | 512 |  *****************************************************************************/ | 
 | 513 |  | 
 | 514 | static int cm109_input_open(struct input_dev *idev) | 
 | 515 | { | 
 | 516 | 	struct cm109_dev *dev = input_get_drvdata(idev); | 
 | 517 | 	int error; | 
 | 518 |  | 
 | 519 | 	error = usb_autopm_get_interface(dev->intf); | 
 | 520 | 	if (error < 0) { | 
 | 521 | 		err("%s - cannot autoresume, result %d", | 
 | 522 | 		    __func__, error); | 
 | 523 | 		return error; | 
 | 524 | 	} | 
 | 525 |  | 
 | 526 | 	mutex_lock(&dev->pm_mutex); | 
 | 527 |  | 
 | 528 | 	dev->buzzer_state = 0; | 
 | 529 | 	dev->key_code = -1;	/* no keys pressed */ | 
 | 530 | 	dev->keybit = 0xf; | 
 | 531 |  | 
 | 532 | 	/* issue INIT */ | 
 | 533 | 	dev->ctl_data->byte[HID_OR0] = HID_OR_GPO_BUZ_SPDIF; | 
 | 534 | 	dev->ctl_data->byte[HID_OR1] = dev->keybit; | 
 | 535 | 	dev->ctl_data->byte[HID_OR2] = dev->keybit; | 
 | 536 | 	dev->ctl_data->byte[HID_OR3] = 0x00; | 
 | 537 |  | 
 | 538 | 	error = usb_submit_urb(dev->urb_ctl, GFP_KERNEL); | 
 | 539 | 	if (error) | 
 | 540 | 		err("%s: usb_submit_urb (urb_ctl) failed %d", __func__, error); | 
 | 541 | 	else | 
 | 542 | 		dev->open = 1; | 
 | 543 |  | 
 | 544 | 	mutex_unlock(&dev->pm_mutex); | 
 | 545 |  | 
 | 546 | 	if (error) | 
 | 547 | 		usb_autopm_put_interface(dev->intf); | 
 | 548 |  | 
 | 549 | 	return error; | 
 | 550 | } | 
 | 551 |  | 
 | 552 | static void cm109_input_close(struct input_dev *idev) | 
 | 553 | { | 
 | 554 | 	struct cm109_dev *dev = input_get_drvdata(idev); | 
 | 555 |  | 
 | 556 | 	mutex_lock(&dev->pm_mutex); | 
 | 557 |  | 
 | 558 | 	/* | 
 | 559 | 	 * Once we are here event delivery is stopped so we | 
 | 560 | 	 * don't need to worry about someone starting buzzer | 
 | 561 | 	 * again | 
 | 562 | 	 */ | 
 | 563 | 	cm109_stop_traffic(dev); | 
 | 564 | 	dev->open = 0; | 
 | 565 |  | 
 | 566 | 	mutex_unlock(&dev->pm_mutex); | 
 | 567 |  | 
 | 568 | 	usb_autopm_put_interface(dev->intf); | 
 | 569 | } | 
 | 570 |  | 
 | 571 | static int cm109_input_ev(struct input_dev *idev, unsigned int type, | 
 | 572 | 			  unsigned int code, int value) | 
 | 573 | { | 
 | 574 | 	struct cm109_dev *dev = input_get_drvdata(idev); | 
 | 575 |  | 
| Stephen Rothwell | 67d4764 | 2008-08-22 16:33:18 -0400 | [diff] [blame] | 576 | 	dev_dbg(&dev->udev->dev, | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 577 | 		"input_ev: type=%u code=%u value=%d\n", type, code, value); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 578 |  | 
 | 579 | 	if (type != EV_SND) | 
 | 580 | 		return -EINVAL; | 
 | 581 |  | 
 | 582 | 	switch (code) { | 
 | 583 | 	case SND_TONE: | 
 | 584 | 	case SND_BELL: | 
 | 585 | 		dev->buzzer_state = !!value; | 
 | 586 | 		if (!dev->resetting) | 
 | 587 | 			cm109_toggle_buzzer_async(dev); | 
 | 588 | 		return 0; | 
 | 589 |  | 
 | 590 | 	default: | 
 | 591 | 		return -EINVAL; | 
 | 592 | 	} | 
 | 593 | } | 
 | 594 |  | 
 | 595 |  | 
 | 596 | /****************************************************************************** | 
 | 597 |  * Linux interface and usb initialisation | 
 | 598 |  *****************************************************************************/ | 
 | 599 |  | 
 | 600 | struct driver_info { | 
 | 601 | 	char *name; | 
 | 602 | }; | 
 | 603 |  | 
 | 604 | static const struct driver_info info_cm109 = { | 
 | 605 | 	.name = "CM109 USB driver", | 
 | 606 | }; | 
 | 607 |  | 
 | 608 | enum { | 
 | 609 | 	VENDOR_ID        = 0x0d8c, /* C-Media Electronics */ | 
 | 610 | 	PRODUCT_ID_CM109 = 0x000e, /* CM109 defines range 0x0008 - 0x000f */ | 
 | 611 | }; | 
 | 612 |  | 
 | 613 | /* table of devices that work with this driver */ | 
 | 614 | static const struct usb_device_id cm109_usb_table[] = { | 
 | 615 | 	{ | 
 | 616 | 		.match_flags = USB_DEVICE_ID_MATCH_DEVICE | | 
 | 617 | 				USB_DEVICE_ID_MATCH_INT_INFO, | 
 | 618 | 		.idVendor = VENDOR_ID, | 
 | 619 | 		.idProduct = PRODUCT_ID_CM109, | 
 | 620 | 		.bInterfaceClass = USB_CLASS_HID, | 
 | 621 | 		.bInterfaceSubClass = 0, | 
 | 622 | 		.bInterfaceProtocol = 0, | 
 | 623 | 		.driver_info = (kernel_ulong_t) &info_cm109 | 
 | 624 | 	}, | 
 | 625 | 	/* you can add more devices here with product ID 0x0008 - 0x000f */ | 
 | 626 | 	{ } | 
 | 627 | }; | 
 | 628 |  | 
 | 629 | static void cm109_usb_cleanup(struct cm109_dev *dev) | 
 | 630 | { | 
| Alan Stern | 0ede76f | 2010-03-05 15:10:17 -0500 | [diff] [blame] | 631 | 	kfree(dev->ctl_req); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 632 | 	if (dev->ctl_data) | 
| Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 633 | 		usb_free_coherent(dev->udev, USB_PKT_LEN, | 
 | 634 | 				  dev->ctl_data, dev->ctl_dma); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 635 | 	if (dev->irq_data) | 
| Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 636 | 		usb_free_coherent(dev->udev, USB_PKT_LEN, | 
 | 637 | 				  dev->irq_data, dev->irq_dma); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 638 |  | 
 | 639 | 	usb_free_urb(dev->urb_irq);	/* parameter validation in core/urb */ | 
 | 640 | 	usb_free_urb(dev->urb_ctl);	/* parameter validation in core/urb */ | 
 | 641 | 	kfree(dev); | 
 | 642 | } | 
 | 643 |  | 
 | 644 | static void cm109_usb_disconnect(struct usb_interface *interface) | 
 | 645 | { | 
 | 646 | 	struct cm109_dev *dev = usb_get_intfdata(interface); | 
 | 647 |  | 
 | 648 | 	usb_set_intfdata(interface, NULL); | 
 | 649 | 	input_unregister_device(dev->idev); | 
 | 650 | 	cm109_usb_cleanup(dev); | 
 | 651 | } | 
 | 652 |  | 
 | 653 | static int cm109_usb_probe(struct usb_interface *intf, | 
 | 654 | 			   const struct usb_device_id *id) | 
 | 655 | { | 
 | 656 | 	struct usb_device *udev = interface_to_usbdev(intf); | 
 | 657 | 	struct driver_info *nfo = (struct driver_info *)id->driver_info; | 
 | 658 | 	struct usb_host_interface *interface; | 
 | 659 | 	struct usb_endpoint_descriptor *endpoint; | 
 | 660 | 	struct cm109_dev *dev; | 
 | 661 | 	struct input_dev *input_dev = NULL; | 
 | 662 | 	int ret, pipe, i; | 
 | 663 | 	int error = -ENOMEM; | 
 | 664 |  | 
 | 665 | 	interface = intf->cur_altsetting; | 
 | 666 | 	endpoint = &interface->endpoint[0].desc; | 
 | 667 |  | 
 | 668 | 	if (!usb_endpoint_is_int_in(endpoint)) | 
 | 669 | 		return -ENODEV; | 
 | 670 |  | 
 | 671 | 	dev = kzalloc(sizeof(*dev), GFP_KERNEL); | 
 | 672 | 	if (!dev) | 
 | 673 | 		return -ENOMEM; | 
 | 674 |  | 
 | 675 | 	spin_lock_init(&dev->ctl_submit_lock); | 
 | 676 | 	mutex_init(&dev->pm_mutex); | 
 | 677 |  | 
 | 678 | 	dev->udev = udev; | 
 | 679 | 	dev->intf = intf; | 
 | 680 |  | 
 | 681 | 	dev->idev = input_dev = input_allocate_device(); | 
 | 682 | 	if (!input_dev) | 
 | 683 | 		goto err_out; | 
 | 684 |  | 
 | 685 | 	/* allocate usb buffers */ | 
| Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 686 | 	dev->irq_data = usb_alloc_coherent(udev, USB_PKT_LEN, | 
 | 687 | 					   GFP_KERNEL, &dev->irq_dma); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 688 | 	if (!dev->irq_data) | 
 | 689 | 		goto err_out; | 
 | 690 |  | 
| Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 691 | 	dev->ctl_data = usb_alloc_coherent(udev, USB_PKT_LEN, | 
 | 692 | 					   GFP_KERNEL, &dev->ctl_dma); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 693 | 	if (!dev->ctl_data) | 
 | 694 | 		goto err_out; | 
 | 695 |  | 
| Alan Stern | 0ede76f | 2010-03-05 15:10:17 -0500 | [diff] [blame] | 696 | 	dev->ctl_req = kmalloc(sizeof(*(dev->ctl_req)), GFP_KERNEL); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 697 | 	if (!dev->ctl_req) | 
 | 698 | 		goto err_out; | 
 | 699 |  | 
 | 700 | 	/* allocate urb structures */ | 
 | 701 | 	dev->urb_irq = usb_alloc_urb(0, GFP_KERNEL); | 
 | 702 | 	if (!dev->urb_irq) | 
 | 703 | 		goto err_out; | 
 | 704 |  | 
 | 705 | 	dev->urb_ctl = usb_alloc_urb(0, GFP_KERNEL); | 
 | 706 | 	if (!dev->urb_ctl) | 
 | 707 | 		goto err_out; | 
 | 708 |  | 
 | 709 | 	/* get a handle to the interrupt data pipe */ | 
 | 710 | 	pipe = usb_rcvintpipe(udev, endpoint->bEndpointAddress); | 
 | 711 | 	ret = usb_maxpacket(udev, pipe, usb_pipeout(pipe)); | 
 | 712 | 	if (ret != USB_PKT_LEN) | 
 | 713 | 		err("invalid payload size %d, expected %d", ret, USB_PKT_LEN); | 
 | 714 |  | 
 | 715 | 	/* initialise irq urb */ | 
 | 716 | 	usb_fill_int_urb(dev->urb_irq, udev, pipe, dev->irq_data, | 
 | 717 | 			 USB_PKT_LEN, | 
 | 718 | 			 cm109_urb_irq_callback, dev, endpoint->bInterval); | 
 | 719 | 	dev->urb_irq->transfer_dma = dev->irq_dma; | 
 | 720 | 	dev->urb_irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 
 | 721 | 	dev->urb_irq->dev = udev; | 
 | 722 |  | 
 | 723 | 	/* initialise ctl urb */ | 
 | 724 | 	dev->ctl_req->bRequestType = USB_TYPE_CLASS | USB_RECIP_INTERFACE | | 
 | 725 | 					USB_DIR_OUT; | 
 | 726 | 	dev->ctl_req->bRequest = USB_REQ_SET_CONFIGURATION; | 
 | 727 | 	dev->ctl_req->wValue = cpu_to_le16(0x200); | 
 | 728 | 	dev->ctl_req->wIndex = cpu_to_le16(interface->desc.bInterfaceNumber); | 
 | 729 | 	dev->ctl_req->wLength = cpu_to_le16(USB_PKT_LEN); | 
 | 730 |  | 
 | 731 | 	usb_fill_control_urb(dev->urb_ctl, udev, usb_sndctrlpipe(udev, 0), | 
 | 732 | 			     (void *)dev->ctl_req, dev->ctl_data, USB_PKT_LEN, | 
 | 733 | 			     cm109_urb_ctl_callback, dev); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 734 | 	dev->urb_ctl->transfer_dma = dev->ctl_dma; | 
| Alan Stern | 0ede76f | 2010-03-05 15:10:17 -0500 | [diff] [blame] | 735 | 	dev->urb_ctl->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 736 | 	dev->urb_ctl->dev = udev; | 
 | 737 |  | 
 | 738 | 	/* find out the physical bus location */ | 
 | 739 | 	usb_make_path(udev, dev->phys, sizeof(dev->phys)); | 
 | 740 | 	strlcat(dev->phys, "/input0", sizeof(dev->phys)); | 
 | 741 |  | 
 | 742 | 	/* register settings for the input device */ | 
 | 743 | 	input_dev->name = nfo->name; | 
 | 744 | 	input_dev->phys = dev->phys; | 
 | 745 | 	usb_to_input_id(udev, &input_dev->id); | 
 | 746 | 	input_dev->dev.parent = &intf->dev; | 
 | 747 |  | 
 | 748 | 	input_set_drvdata(input_dev, dev); | 
 | 749 | 	input_dev->open = cm109_input_open; | 
 | 750 | 	input_dev->close = cm109_input_close; | 
 | 751 | 	input_dev->event = cm109_input_ev; | 
 | 752 |  | 
 | 753 | 	input_dev->keycode = dev->keymap; | 
 | 754 | 	input_dev->keycodesize = sizeof(unsigned char); | 
 | 755 | 	input_dev->keycodemax = ARRAY_SIZE(dev->keymap); | 
 | 756 |  | 
 | 757 | 	input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_SND); | 
 | 758 | 	input_dev->sndbit[0] = BIT_MASK(SND_BELL) | BIT_MASK(SND_TONE); | 
 | 759 |  | 
 | 760 | 	/* register available key events */ | 
 | 761 | 	for (i = 0; i < KEYMAP_SIZE; i++) { | 
 | 762 | 		unsigned short k = keymap(i); | 
 | 763 | 		dev->keymap[i] = k; | 
 | 764 | 		__set_bit(k, input_dev->keybit); | 
 | 765 | 	} | 
 | 766 | 	__clear_bit(KEY_RESERVED, input_dev->keybit); | 
 | 767 |  | 
 | 768 | 	error = input_register_device(dev->idev); | 
 | 769 | 	if (error) | 
 | 770 | 		goto err_out; | 
 | 771 |  | 
 | 772 | 	usb_set_intfdata(intf, dev); | 
 | 773 |  | 
 | 774 | 	return 0; | 
 | 775 |  | 
 | 776 |  err_out: | 
 | 777 | 	input_free_device(input_dev); | 
 | 778 | 	cm109_usb_cleanup(dev); | 
 | 779 | 	return error; | 
 | 780 | } | 
 | 781 |  | 
 | 782 | static int cm109_usb_suspend(struct usb_interface *intf, pm_message_t message) | 
 | 783 | { | 
 | 784 | 	struct cm109_dev *dev = usb_get_intfdata(intf); | 
 | 785 |  | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 786 | 	dev_info(&intf->dev, "cm109: usb_suspend (event=%d)\n", message.event); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 787 |  | 
 | 788 | 	mutex_lock(&dev->pm_mutex); | 
 | 789 | 	cm109_stop_traffic(dev); | 
 | 790 | 	mutex_unlock(&dev->pm_mutex); | 
 | 791 |  | 
 | 792 | 	return 0; | 
 | 793 | } | 
 | 794 |  | 
 | 795 | static int cm109_usb_resume(struct usb_interface *intf) | 
 | 796 | { | 
 | 797 | 	struct cm109_dev *dev = usb_get_intfdata(intf); | 
 | 798 |  | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 799 | 	dev_info(&intf->dev, "cm109: usb_resume\n"); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 800 |  | 
 | 801 | 	mutex_lock(&dev->pm_mutex); | 
 | 802 | 	cm109_restore_state(dev); | 
 | 803 | 	mutex_unlock(&dev->pm_mutex); | 
 | 804 |  | 
 | 805 | 	return 0; | 
 | 806 | } | 
 | 807 |  | 
 | 808 | static int cm109_usb_pre_reset(struct usb_interface *intf) | 
 | 809 | { | 
 | 810 | 	struct cm109_dev *dev = usb_get_intfdata(intf); | 
 | 811 |  | 
 | 812 | 	mutex_lock(&dev->pm_mutex); | 
 | 813 |  | 
 | 814 | 	/* | 
 | 815 | 	 * Make sure input events don't try to toggle buzzer | 
 | 816 | 	 * while we are resetting | 
 | 817 | 	 */ | 
 | 818 | 	dev->resetting = 1; | 
 | 819 | 	smp_wmb(); | 
 | 820 |  | 
 | 821 | 	cm109_stop_traffic(dev); | 
 | 822 |  | 
 | 823 | 	return 0; | 
 | 824 | } | 
 | 825 |  | 
 | 826 | static int cm109_usb_post_reset(struct usb_interface *intf) | 
 | 827 | { | 
 | 828 | 	struct cm109_dev *dev = usb_get_intfdata(intf); | 
 | 829 |  | 
 | 830 | 	dev->resetting = 0; | 
 | 831 | 	smp_wmb(); | 
 | 832 |  | 
 | 833 | 	cm109_restore_state(dev); | 
 | 834 |  | 
 | 835 | 	mutex_unlock(&dev->pm_mutex); | 
 | 836 |  | 
 | 837 | 	return 0; | 
 | 838 | } | 
 | 839 |  | 
 | 840 | static struct usb_driver cm109_driver = { | 
 | 841 | 	.name		= "cm109", | 
 | 842 | 	.probe		= cm109_usb_probe, | 
 | 843 | 	.disconnect	= cm109_usb_disconnect, | 
 | 844 | 	.suspend	= cm109_usb_suspend, | 
 | 845 | 	.resume		= cm109_usb_resume, | 
 | 846 | 	.reset_resume	= cm109_usb_resume, | 
 | 847 | 	.pre_reset	= cm109_usb_pre_reset, | 
 | 848 | 	.post_reset	= cm109_usb_post_reset, | 
 | 849 | 	.id_table	= cm109_usb_table, | 
 | 850 | 	.supports_autosuspend = 1, | 
 | 851 | }; | 
 | 852 |  | 
 | 853 | static int __init cm109_select_keymap(void) | 
 | 854 | { | 
 | 855 | 	/* Load the phone keymap */ | 
 | 856 | 	if (!strcasecmp(phone, "kip1000")) { | 
 | 857 | 		keymap = keymap_kip1000; | 
| Stephen Rothwell | 67d4764 | 2008-08-22 16:33:18 -0400 | [diff] [blame] | 858 | 		printk(KERN_INFO KBUILD_MODNAME ": " | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 859 | 			"Keymap for Komunikate KIP1000 phone loaded\n"); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 860 | 	} else if (!strcasecmp(phone, "gtalk")) { | 
 | 861 | 		keymap = keymap_gtalk; | 
| Stephen Rothwell | 67d4764 | 2008-08-22 16:33:18 -0400 | [diff] [blame] | 862 | 		printk(KERN_INFO KBUILD_MODNAME ": " | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 863 | 			"Keymap for Genius G-talk phone loaded\n"); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 864 | 	} else if (!strcasecmp(phone, "usbph01")) { | 
 | 865 | 		keymap = keymap_usbph01; | 
| Stephen Rothwell | 67d4764 | 2008-08-22 16:33:18 -0400 | [diff] [blame] | 866 | 		printk(KERN_INFO KBUILD_MODNAME ": " | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 867 | 			"Keymap for Allied-Telesis Corega USBPH01 phone loaded\n"); | 
| Daniel Gimpelevich | 734f0ba | 2008-11-11 13:57:30 -0500 | [diff] [blame] | 868 | 	} else if (!strcasecmp(phone, "atcom")) { | 
 | 869 | 		keymap = keymap_atcom; | 
 | 870 | 		printk(KERN_INFO KBUILD_MODNAME ": " | 
 | 871 | 			"Keymap for ATCom AU-100 phone loaded\n"); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 872 | 	} else { | 
| Stephen Rothwell | 67d4764 | 2008-08-22 16:33:18 -0400 | [diff] [blame] | 873 | 		printk(KERN_ERR KBUILD_MODNAME ": " | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 874 | 			"Unsupported phone: %s\n", phone); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 875 | 		return -EINVAL; | 
 | 876 | 	} | 
 | 877 |  | 
 | 878 | 	return 0; | 
 | 879 | } | 
 | 880 |  | 
 | 881 | static int __init cm109_init(void) | 
 | 882 | { | 
 | 883 | 	int err; | 
 | 884 |  | 
 | 885 | 	err = cm109_select_keymap(); | 
 | 886 | 	if (err) | 
 | 887 | 		return err; | 
 | 888 |  | 
 | 889 | 	err = usb_register(&cm109_driver); | 
 | 890 | 	if (err) | 
 | 891 | 		return err; | 
 | 892 |  | 
| Stephen Rothwell | 67d4764 | 2008-08-22 16:33:18 -0400 | [diff] [blame] | 893 | 	printk(KERN_INFO KBUILD_MODNAME ": " | 
| Daniel Gimpelevich | 2d517ca | 2008-10-09 00:44:47 -0400 | [diff] [blame] | 894 | 		DRIVER_DESC ": " DRIVER_VERSION " (C) " DRIVER_AUTHOR "\n"); | 
| Alfred E. Heggestad | c04148f | 2008-08-08 11:49:08 -0400 | [diff] [blame] | 895 |  | 
 | 896 | 	return 0; | 
 | 897 | } | 
 | 898 |  | 
 | 899 | static void __exit cm109_exit(void) | 
 | 900 | { | 
 | 901 | 	usb_deregister(&cm109_driver); | 
 | 902 | } | 
 | 903 |  | 
 | 904 | module_init(cm109_init); | 
 | 905 | module_exit(cm109_exit); | 
 | 906 |  | 
 | 907 | MODULE_DEVICE_TABLE(usb, cm109_usb_table); | 
 | 908 |  | 
 | 909 | MODULE_AUTHOR(DRIVER_AUTHOR); | 
 | 910 | MODULE_DESCRIPTION(DRIVER_DESC); | 
 | 911 | MODULE_LICENSE("GPL"); |