Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
4cc27bd6 | 2 | * Silicon Laboratories CP210x USB to RS232 serial adaptor driver |
1da177e4 LT |
3 | * |
4 | * Copyright (C) 2005 Craig Shelley (craig@microtron.org.uk) | |
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 version | |
8 | * 2 as published by the Free Software Foundation. | |
9 | * | |
39a66b8d CS |
10 | * Support to set flow control line levels using TIOCMGET and TIOCMSET |
11 | * thanks to Karl Hiramoto karl@hiramoto.org. RTSCTS hardware flow | |
12 | * control thanks to Munir Nassar nassarmu@real-time.com | |
13 | * | |
1da177e4 LT |
14 | */ |
15 | ||
1da177e4 LT |
16 | #include <linux/kernel.h> |
17 | #include <linux/errno.h> | |
18 | #include <linux/slab.h> | |
19 | #include <linux/tty.h> | |
20 | #include <linux/tty_flip.h> | |
21 | #include <linux/module.h> | |
22 | #include <linux/moduleparam.h> | |
23 | #include <linux/usb.h> | |
ff7eb602 | 24 | #include <linux/uaccess.h> |
a969888c | 25 | #include <linux/usb/serial.h> |
1da177e4 | 26 | |
4cc27bd6 | 27 | #define DRIVER_DESC "Silicon Labs CP210x RS232 serial adaptor driver" |
1da177e4 LT |
28 | |
29 | /* | |
30 | * Function Prototypes | |
31 | */ | |
a509a7e4 | 32 | static int cp210x_open(struct tty_struct *tty, struct usb_serial_port *); |
4cc27bd6 | 33 | static void cp210x_close(struct usb_serial_port *); |
4f2ab888 | 34 | static void cp210x_get_termios(struct tty_struct *, struct usb_serial_port *); |
4cc27bd6 | 35 | static void cp210x_get_termios_port(struct usb_serial_port *port, |
d2ad67b3 | 36 | unsigned int *cflagp, unsigned int *baudp); |
e5990874 JH |
37 | static void cp210x_change_speed(struct tty_struct *, struct usb_serial_port *, |
38 | struct ktermios *); | |
4cc27bd6 | 39 | static void cp210x_set_termios(struct tty_struct *, struct usb_serial_port *, |
95da310e | 40 | struct ktermios*); |
6f923a01 | 41 | static bool cp210x_tx_empty(struct usb_serial_port *port); |
60b33c13 | 42 | static int cp210x_tiocmget(struct tty_struct *); |
20b9d177 AC |
43 | static int cp210x_tiocmset(struct tty_struct *, unsigned int, unsigned int); |
44 | static int cp210x_tiocmset_port(struct usb_serial_port *port, | |
d2ad67b3 | 45 | unsigned int, unsigned int); |
4cc27bd6 | 46 | static void cp210x_break_ctl(struct tty_struct *, int); |
e2ae67a3 KS |
47 | static int cp210x_port_probe(struct usb_serial_port *); |
48 | static int cp210x_port_remove(struct usb_serial_port *); | |
d94c7bd4 | 49 | static void cp210x_dtr_rts(struct usb_serial_port *p, int on); |
1da177e4 | 50 | |
7d40d7e8 | 51 | static const struct usb_device_id id_table[] = { |
2f1136d1 | 52 | { USB_DEVICE(0x045B, 0x0053) }, /* Renesas RX610 RX-Stick */ |
5091b587 | 53 | { USB_DEVICE(0x0471, 0x066A) }, /* AKTAKOM ACE-1001 cable */ |
59fba744 | 54 | { USB_DEVICE(0x0489, 0xE000) }, /* Pirelli Broadband S.p.A, DP-L10 SIP/GSM Mobile */ |
5b22a32e | 55 | { USB_DEVICE(0x0489, 0xE003) }, /* Pirelli Broadband S.p.A, DP-L10 SIP/GSM Mobile */ |
b7c7cbc8 | 56 | { USB_DEVICE(0x0745, 0x1000) }, /* CipherLab USB CCD Barcode Scanner 1000 */ |
90625070 | 57 | { USB_DEVICE(0x0846, 0x1100) }, /* NetGear Managed Switch M4100 series, M5300 series, M7100 series */ |
1f4f714f | 58 | { USB_DEVICE(0x08e6, 0x5501) }, /* Gemalto Prox-PU/CU contactless smartcard reader */ |
b7c7cbc8 | 59 | { USB_DEVICE(0x08FD, 0x000A) }, /* Digianswer A/S , ZigBee/802.15.4 MAC Device */ |
a6f03312 | 60 | { USB_DEVICE(0x0908, 0x01FF) }, /* Siemens RUGGEDCOM USB Serial Console */ |
eefd9029 CS |
61 | { USB_DEVICE(0x0BED, 0x1100) }, /* MEI (TM) Cashflow-SC Bill/Voucher Acceptor */ |
62 | { USB_DEVICE(0x0BED, 0x1101) }, /* MEI series 2000 Combo Acceptor */ | |
198b9517 | 63 | { USB_DEVICE(0x0FCF, 0x1003) }, /* Dynastream ANT development board */ |
014840ec | 64 | { USB_DEVICE(0x0FCF, 0x1004) }, /* Dynastream ANT2USB */ |
59fba744 | 65 | { USB_DEVICE(0x0FCF, 0x1006) }, /* Dynastream ANT development board */ |
8de7f4da | 66 | { USB_DEVICE(0x0FDE, 0xCA05) }, /* OWL Wireless Electricity Monitor CM-160 */ |
198b9517 | 67 | { USB_DEVICE(0x10A6, 0xAA26) }, /* Knock-off DCU-11 cable */ |
e988fc8a CS |
68 | { USB_DEVICE(0x10AB, 0x10C5) }, /* Siemens MC60 Cable */ |
69 | { USB_DEVICE(0x10B5, 0xAC70) }, /* Nokia CA-42 USB */ | |
b7c7cbc8 | 70 | { USB_DEVICE(0x10C4, 0x0F91) }, /* Vstabi */ |
0601e116 AK |
71 | { USB_DEVICE(0x10C4, 0x1101) }, /* Arkham Technology DS101 Bus Monitor */ |
72 | { USB_DEVICE(0x10C4, 0x1601) }, /* Arkham Technology DS101 Adapter */ | |
5de8b3ac | 73 | { USB_DEVICE(0x10C4, 0x800A) }, /* SPORTident BSM7-D-USB main station */ |
59224f53 | 74 | { USB_DEVICE(0x10C4, 0x803B) }, /* Pololu USB-serial converter */ |
eefd9029 CS |
75 | { USB_DEVICE(0x10C4, 0x8044) }, /* Cygnal Debug Adapter */ |
76 | { USB_DEVICE(0x10C4, 0x804E) }, /* Software Bisque Paramount ME build-in converter */ | |
92f5cae2 | 77 | { USB_DEVICE(0x10C4, 0x8053) }, /* Enfora EDG1228 */ |
9a18e75f | 78 | { USB_DEVICE(0x10C4, 0x8054) }, /* Enfora GSM2228 */ |
212a4b4e | 79 | { USB_DEVICE(0x10C4, 0x8066) }, /* Argussoft In-System Programmer */ |
eefd9029 | 80 | { USB_DEVICE(0x10C4, 0x806F) }, /* IMS USB to RS422 Converter Cable */ |
e988fc8a | 81 | { USB_DEVICE(0x10C4, 0x807A) }, /* Crumb128 board */ |
5bbfa6f4 | 82 | { USB_DEVICE(0x10C4, 0x80C4) }, /* Cygnal Integrated Products, Inc., Optris infrared thermometer */ |
e988fc8a | 83 | { USB_DEVICE(0x10C4, 0x80CA) }, /* Degree Controls Inc */ |
92f5cae2 | 84 | { USB_DEVICE(0x10C4, 0x80DD) }, /* Tracient RFID */ |
e988fc8a | 85 | { USB_DEVICE(0x10C4, 0x80F6) }, /* Suunto sports instrument */ |
ba0f332c | 86 | { USB_DEVICE(0x10C4, 0x8115) }, /* Arygon NFC/Mifare Reader */ |
e988fc8a | 87 | { USB_DEVICE(0x10C4, 0x813D) }, /* Burnside Telecom Deskmobile */ |
8bf16ba7 | 88 | { USB_DEVICE(0x10C4, 0x813F) }, /* Tams Master Easy Control */ |
fc4bd64c JH |
89 | { USB_DEVICE(0x10C4, 0x814A) }, /* West Mountain Radio RIGblaster P&P */ |
90 | { USB_DEVICE(0x10C4, 0x814B) }, /* West Mountain Radio RIGtalk */ | |
a57e82a1 | 91 | { USB_DEVICE(0x2405, 0x0003) }, /* West Mountain Radio RIGblaster Advantage */ |
0bf7a81c | 92 | { USB_DEVICE(0x10C4, 0x8156) }, /* B&G H3000 link cable */ |
e988fc8a | 93 | { USB_DEVICE(0x10C4, 0x815E) }, /* Helicomm IP-Link 1220-DVM */ |
3fcc8f96 | 94 | { USB_DEVICE(0x10C4, 0x815F) }, /* Timewave HamLinkUSB */ |
eefd9029 | 95 | { USB_DEVICE(0x10C4, 0x818B) }, /* AVIT Research USB to TTL */ |
c6535668 | 96 | { USB_DEVICE(0x10C4, 0x819F) }, /* MJS USB Toslink Switcher */ |
96623697 | 97 | { USB_DEVICE(0x10C4, 0x81A6) }, /* ThinkOptics WavIt */ |
08e87d0d | 98 | { USB_DEVICE(0x10C4, 0x81A9) }, /* Multiplex RC Interface */ |
59fba744 | 99 | { USB_DEVICE(0x10C4, 0x81AC) }, /* MSD Dash Hawk */ |
eefd9029 | 100 | { USB_DEVICE(0x10C4, 0x81AD) }, /* INSYS USB Modem */ |
78001e3d | 101 | { USB_DEVICE(0x10C4, 0x81C8) }, /* Lipowsky Industrie Elektronik GmbH, Baby-JTAG */ |
f487c54d | 102 | { USB_DEVICE(0x10C4, 0x81D7) }, /* IAI Corp. RCB-CV-USB USB to RS485 Adaptor */ |
78001e3d | 103 | { USB_DEVICE(0x10C4, 0x81E2) }, /* Lipowsky Industrie Elektronik GmbH, Baby-LIN */ |
8be27c2d | 104 | { USB_DEVICE(0x10C4, 0x81E7) }, /* Aerocomm Radio */ |
bd07c551 | 105 | { USB_DEVICE(0x10C4, 0x81E8) }, /* Zephyr Bioharness */ |
b7c7cbc8 | 106 | { USB_DEVICE(0x10C4, 0x81F2) }, /* C1007 HF band RFID controller */ |
78001e3d | 107 | { USB_DEVICE(0x10C4, 0x8218) }, /* Lipowsky Industrie Elektronik GmbH, HARP-1 */ |
877e262c | 108 | { USB_DEVICE(0x10C4, 0x822B) }, /* Modem EDGE(GSM) Comander 2 */ |
25985edc | 109 | { USB_DEVICE(0x10C4, 0x826B) }, /* Cygnal Integrated Products, Inc., Fasttrax GPS demonstration module */ |
72b30079 | 110 | { USB_DEVICE(0x10C4, 0x8281) }, /* Nanotec Plug & Drive */ |
c851e83f | 111 | { USB_DEVICE(0x10C4, 0x8293) }, /* Telegesis ETRX2USB */ |
b7c7cbc8 | 112 | { USB_DEVICE(0x10C4, 0x82F9) }, /* Procyon AVS */ |
ba0f332c | 113 | { USB_DEVICE(0x10C4, 0x8341) }, /* Siemens MC35PU GPRS Modem */ |
8bf16ba7 | 114 | { USB_DEVICE(0x10C4, 0x8382) }, /* Cygnal Integrated Products, Inc. */ |
881e3c98 | 115 | { USB_DEVICE(0x10C4, 0x83A8) }, /* Amber Wireless AMB2560 */ |
faea63f7 | 116 | { USB_DEVICE(0x10C4, 0x83D8) }, /* DekTec DTA Plus VHF/UHF Booster/Attenuator */ |
8bf16ba7 | 117 | { USB_DEVICE(0x10C4, 0x8411) }, /* Kyocera GPS Module */ |
faea63f7 | 118 | { USB_DEVICE(0x10C4, 0x8418) }, /* IRZ Automation Teleport SG-10 GSM/GPRS Modem */ |
d23bac9f | 119 | { USB_DEVICE(0x10C4, 0x846E) }, /* BEI USB Sensor Interface (VCP) */ |
541e05ec | 120 | { USB_DEVICE(0x10C4, 0x8477) }, /* Balluff RFID */ |
4eff0b40 CS |
121 | { USB_DEVICE(0x10C4, 0x85EA) }, /* AC-Services IBUS-IF */ |
122 | { USB_DEVICE(0x10C4, 0x85EB) }, /* AC-Services CIS-IBUS */ | |
356fe44f | 123 | { USB_DEVICE(0x10C4, 0x85F8) }, /* Virtenio Preon32 */ |
4eff0b40 CS |
124 | { USB_DEVICE(0x10C4, 0x8664) }, /* AC-Services CAN-IF */ |
125 | { USB_DEVICE(0x10C4, 0x8665) }, /* AC-Services OBD-IF */ | |
1ae78a48 DP |
126 | { USB_DEVICE(0x10C4, 0x8856) }, /* CEL EM357 ZigBee USB Stick - LR */ |
127 | { USB_DEVICE(0x10C4, 0x8857) }, /* CEL EM357 ZigBee USB Stick */ | |
76811569 SR |
128 | { USB_DEVICE(0x10C4, 0x88A4) }, /* MMB Networks ZigBee USB Device */ |
129 | { USB_DEVICE(0x10C4, 0x88A5) }, /* Planet Innovation Ingeni ZigBee USB Device */ | |
bfc2d7df | 130 | { USB_DEVICE(0x10C4, 0x8946) }, /* Ketra N1 Wireless Interface */ |
1ae78a48 | 131 | { USB_DEVICE(0x10C4, 0x8977) }, /* CEL MeshWorks DevKit Device */ |
c735ed74 | 132 | { USB_DEVICE(0x10C4, 0x8998) }, /* KCF Technologies PRN */ |
df72d588 | 133 | { USB_DEVICE(0x10C4, 0x8A2A) }, /* HubZ dual ZigBee and Z-Wave dongle */ |
e988fc8a | 134 | { USB_DEVICE(0x10C4, 0xEA60) }, /* Silicon Labs factory default */ |
61926b97 | 135 | { USB_DEVICE(0x10C4, 0xEA61) }, /* Silicon Labs factory default */ |
a5360a53 | 136 | { USB_DEVICE(0x10C4, 0xEA70) }, /* Silicon Labs factory default */ |
eefd9029 | 137 | { USB_DEVICE(0x10C4, 0xEA71) }, /* Infinity GPS-MIC-1 Radio Monophone */ |
5de8b3ac CS |
138 | { USB_DEVICE(0x10C4, 0xF001) }, /* Elan Digital Systems USBscope50 */ |
139 | { USB_DEVICE(0x10C4, 0xF002) }, /* Elan Digital Systems USBwave12 */ | |
140 | { USB_DEVICE(0x10C4, 0xF003) }, /* Elan Digital Systems USBpulse100 */ | |
141 | { USB_DEVICE(0x10C4, 0xF004) }, /* Elan Digital Systems USBcount50 */ | |
ebaf494e | 142 | { USB_DEVICE(0x10C5, 0xEA61) }, /* Silicon Labs MobiData GPRS USB Modem */ |
b7c7cbc8 | 143 | { USB_DEVICE(0x10CE, 0xEA6A) }, /* Silicon Labs MobiData GPRS USB Modem 100EU */ |
e05998d5 | 144 | { USB_DEVICE(0x13AD, 0x9999) }, /* Baltech card reader */ |
b7c7cbc8 | 145 | { USB_DEVICE(0x1555, 0x0004) }, /* Owen AC4 USB-RS485 Converter */ |
3fcc8f96 CS |
146 | { USB_DEVICE(0x166A, 0x0201) }, /* Clipsal 5500PACA C-Bus Pascal Automation Controller */ |
147 | { USB_DEVICE(0x166A, 0x0301) }, /* Clipsal 5800PC C-Bus Wireless PC Interface */ | |
5de8b3ac | 148 | { USB_DEVICE(0x166A, 0x0303) }, /* Clipsal 5500PCU C-Bus USB interface */ |
3fcc8f96 CS |
149 | { USB_DEVICE(0x166A, 0x0304) }, /* Clipsal 5000CT2 C-Bus Black and White Touchscreen */ |
150 | { USB_DEVICE(0x166A, 0x0305) }, /* Clipsal C-5000CT2 C-Bus Spectrum Colour Touchscreen */ | |
151 | { USB_DEVICE(0x166A, 0x0401) }, /* Clipsal L51xx C-Bus Architectural Dimmer */ | |
152 | { USB_DEVICE(0x166A, 0x0101) }, /* Clipsal 5560884 C-Bus Multi-room Audio Matrix Switcher */ | |
675af708 MG |
153 | { USB_DEVICE(0x16C0, 0x09B0) }, /* Lunatico Seletek */ |
154 | { USB_DEVICE(0x16C0, 0x09B1) }, /* Lunatico Seletek */ | |
b0ce84d5 | 155 | { USB_DEVICE(0x16D6, 0x0001) }, /* Jablotron serial interface */ |
356c5a48 AIB |
156 | { USB_DEVICE(0x16DC, 0x0010) }, /* W-IE-NE-R Plein & Baus GmbH PL512 Power Supply */ |
157 | { USB_DEVICE(0x16DC, 0x0011) }, /* W-IE-NE-R Plein & Baus GmbH RCM Remote Control for MARATON Power Supply */ | |
158 | { USB_DEVICE(0x16DC, 0x0012) }, /* W-IE-NE-R Plein & Baus GmbH MPOD Multi Channel Power Supply */ | |
159 | { USB_DEVICE(0x16DC, 0x0015) }, /* W-IE-NE-R Plein & Baus GmbH CML Control, Monitoring and Data Logger */ | |
c6c1e449 BT |
160 | { USB_DEVICE(0x17A8, 0x0001) }, /* Kamstrup Optical Eye/3-wire */ |
161 | { USB_DEVICE(0x17A8, 0x0005) }, /* Kamstrup M-Bus Master MultiPort 250D */ | |
541e05ec CS |
162 | { USB_DEVICE(0x17F4, 0xAAAA) }, /* Wavesense Jazz blood glucose meter */ |
163 | { USB_DEVICE(0x1843, 0x0200) }, /* Vaisala USB Instrument Cable */ | |
164 | { USB_DEVICE(0x18EF, 0xE00F) }, /* ELV USB-I2C-Interface */ | |
f7d7f59a | 165 | { USB_DEVICE(0x18EF, 0xE025) }, /* ELV Marble Sound Board 1 */ |
b579fa52 | 166 | { USB_DEVICE(0x1ADB, 0x0001) }, /* Schweitzer Engineering C662 Cable */ |
b9326057 | 167 | { USB_DEVICE(0x1B1C, 0x1C00) }, /* Corsair USB Dongle */ |
35cc83ea | 168 | { USB_DEVICE(0x1BA4, 0x0002) }, /* Silicon Labs 358x factory default */ |
93ad03d6 | 169 | { USB_DEVICE(0x1BE3, 0x07A6) }, /* WAGO 750-923 USB Service Cable */ |
dee80ad1 | 170 | { USB_DEVICE(0x1D6F, 0x0010) }, /* Seluxit ApS RF Dongle */ |
3fcc8f96 CS |
171 | { USB_DEVICE(0x1E29, 0x0102) }, /* Festo CPX-USB */ |
172 | { USB_DEVICE(0x1E29, 0x0501) }, /* Festo CMSP */ | |
be3101c2 MK |
173 | { USB_DEVICE(0x1FB9, 0x0100) }, /* Lake Shore Model 121 Current Source */ |
174 | { USB_DEVICE(0x1FB9, 0x0200) }, /* Lake Shore Model 218A Temperature Monitor */ | |
175 | { USB_DEVICE(0x1FB9, 0x0201) }, /* Lake Shore Model 219 Temperature Monitor */ | |
176 | { USB_DEVICE(0x1FB9, 0x0202) }, /* Lake Shore Model 233 Temperature Transmitter */ | |
177 | { USB_DEVICE(0x1FB9, 0x0203) }, /* Lake Shore Model 235 Temperature Transmitter */ | |
178 | { USB_DEVICE(0x1FB9, 0x0300) }, /* Lake Shore Model 335 Temperature Controller */ | |
179 | { USB_DEVICE(0x1FB9, 0x0301) }, /* Lake Shore Model 336 Temperature Controller */ | |
180 | { USB_DEVICE(0x1FB9, 0x0302) }, /* Lake Shore Model 350 Temperature Controller */ | |
181 | { USB_DEVICE(0x1FB9, 0x0303) }, /* Lake Shore Model 371 AC Bridge */ | |
182 | { USB_DEVICE(0x1FB9, 0x0400) }, /* Lake Shore Model 411 Handheld Gaussmeter */ | |
183 | { USB_DEVICE(0x1FB9, 0x0401) }, /* Lake Shore Model 425 Gaussmeter */ | |
184 | { USB_DEVICE(0x1FB9, 0x0402) }, /* Lake Shore Model 455A Gaussmeter */ | |
185 | { USB_DEVICE(0x1FB9, 0x0403) }, /* Lake Shore Model 475A Gaussmeter */ | |
186 | { USB_DEVICE(0x1FB9, 0x0404) }, /* Lake Shore Model 465 Three Axis Gaussmeter */ | |
187 | { USB_DEVICE(0x1FB9, 0x0600) }, /* Lake Shore Model 625A Superconducting MPS */ | |
188 | { USB_DEVICE(0x1FB9, 0x0601) }, /* Lake Shore Model 642A Magnet Power Supply */ | |
189 | { USB_DEVICE(0x1FB9, 0x0602) }, /* Lake Shore Model 648 Magnet Power Supply */ | |
190 | { USB_DEVICE(0x1FB9, 0x0700) }, /* Lake Shore Model 737 VSM Controller */ | |
191 | { USB_DEVICE(0x1FB9, 0x0701) }, /* Lake Shore Model 776 Hall Matrix */ | |
f98a7aa8 | 192 | { USB_DEVICE(0x2626, 0xEA60) }, /* Aruba Networks 7xxx USB Serial Console */ |
791b7d7c | 193 | { USB_DEVICE(0x3195, 0xF190) }, /* Link Instruments MSO-19 */ |
3fcc8f96 CS |
194 | { USB_DEVICE(0x3195, 0xF280) }, /* Link Instruments MSO-28 */ |
195 | { USB_DEVICE(0x3195, 0xF281) }, /* Link Instruments MSO-28 */ | |
541e05ec | 196 | { USB_DEVICE(0x413C, 0x9500) }, /* DW700 GPS USB interface */ |
39a66b8d | 197 | { } /* Terminating Entry */ |
1da177e4 LT |
198 | }; |
199 | ||
ff7eb602 | 200 | MODULE_DEVICE_TABLE(usb, id_table); |
1da177e4 | 201 | |
e2ae67a3 | 202 | struct cp210x_port_private { |
a5360a53 | 203 | __u8 bInterfaceNumber; |
d0bf1ff0 | 204 | bool has_swapped_line_ctl; |
a5360a53 PF |
205 | }; |
206 | ||
4cc27bd6 | 207 | static struct usb_serial_driver cp210x_device = { |
18fcac35 GKH |
208 | .driver = { |
209 | .owner = THIS_MODULE, | |
4f2ab888 | 210 | .name = "cp210x", |
18fcac35 | 211 | }, |
1da177e4 | 212 | .id_table = id_table, |
1da177e4 | 213 | .num_ports = 1, |
aea006b9 | 214 | .bulk_in_size = 256, |
d4e598f6 | 215 | .bulk_out_size = 256, |
4cc27bd6 CS |
216 | .open = cp210x_open, |
217 | .close = cp210x_close, | |
218 | .break_ctl = cp210x_break_ctl, | |
219 | .set_termios = cp210x_set_termios, | |
6f923a01 | 220 | .tx_empty = cp210x_tx_empty, |
4f2ab888 | 221 | .tiocmget = cp210x_tiocmget, |
4cc27bd6 | 222 | .tiocmset = cp210x_tiocmset, |
e2ae67a3 KS |
223 | .port_probe = cp210x_port_probe, |
224 | .port_remove = cp210x_port_remove, | |
d14fc1a7 | 225 | .dtr_rts = cp210x_dtr_rts |
1da177e4 LT |
226 | }; |
227 | ||
08a4f6bc AS |
228 | static struct usb_serial_driver * const serial_drivers[] = { |
229 | &cp210x_device, NULL | |
230 | }; | |
231 | ||
39a66b8d | 232 | /* Config request types */ |
32445605 PF |
233 | #define REQTYPE_HOST_TO_INTERFACE 0x41 |
234 | #define REQTYPE_INTERFACE_TO_HOST 0xc1 | |
235 | #define REQTYPE_HOST_TO_DEVICE 0x40 | |
236 | #define REQTYPE_DEVICE_TO_HOST 0xc0 | |
1da177e4 | 237 | |
93ef1f1f CS |
238 | /* Config request codes */ |
239 | #define CP210X_IFC_ENABLE 0x00 | |
240 | #define CP210X_SET_BAUDDIV 0x01 | |
241 | #define CP210X_GET_BAUDDIV 0x02 | |
242 | #define CP210X_SET_LINE_CTL 0x03 | |
243 | #define CP210X_GET_LINE_CTL 0x04 | |
244 | #define CP210X_SET_BREAK 0x05 | |
245 | #define CP210X_IMM_CHAR 0x06 | |
246 | #define CP210X_SET_MHS 0x07 | |
247 | #define CP210X_GET_MDMSTS 0x08 | |
248 | #define CP210X_SET_XON 0x09 | |
249 | #define CP210X_SET_XOFF 0x0A | |
250 | #define CP210X_SET_EVENTMASK 0x0B | |
251 | #define CP210X_GET_EVENTMASK 0x0C | |
252 | #define CP210X_SET_CHAR 0x0D | |
253 | #define CP210X_GET_CHARS 0x0E | |
254 | #define CP210X_GET_PROPS 0x0F | |
255 | #define CP210X_GET_COMM_STATUS 0x10 | |
256 | #define CP210X_RESET 0x11 | |
257 | #define CP210X_PURGE 0x12 | |
258 | #define CP210X_SET_FLOW 0x13 | |
259 | #define CP210X_GET_FLOW 0x14 | |
260 | #define CP210X_EMBED_EVENTS 0x15 | |
261 | #define CP210X_GET_EVENTSTATE 0x16 | |
262 | #define CP210X_SET_CHARS 0x19 | |
7f482fc8 PF |
263 | #define CP210X_GET_BAUDRATE 0x1D |
264 | #define CP210X_SET_BAUDRATE 0x1E | |
93ef1f1f CS |
265 | |
266 | /* CP210X_IFC_ENABLE */ | |
1da177e4 LT |
267 | #define UART_ENABLE 0x0001 |
268 | #define UART_DISABLE 0x0000 | |
269 | ||
93ef1f1f | 270 | /* CP210X_(SET|GET)_BAUDDIV */ |
1da177e4 LT |
271 | #define BAUD_RATE_GEN_FREQ 0x384000 |
272 | ||
93ef1f1f | 273 | /* CP210X_(SET|GET)_LINE_CTL */ |
1da177e4 | 274 | #define BITS_DATA_MASK 0X0f00 |
39a66b8d | 275 | #define BITS_DATA_5 0X0500 |
1da177e4 LT |
276 | #define BITS_DATA_6 0X0600 |
277 | #define BITS_DATA_7 0X0700 | |
278 | #define BITS_DATA_8 0X0800 | |
279 | #define BITS_DATA_9 0X0900 | |
280 | ||
281 | #define BITS_PARITY_MASK 0x00f0 | |
282 | #define BITS_PARITY_NONE 0x0000 | |
283 | #define BITS_PARITY_ODD 0x0010 | |
284 | #define BITS_PARITY_EVEN 0x0020 | |
285 | #define BITS_PARITY_MARK 0x0030 | |
286 | #define BITS_PARITY_SPACE 0x0040 | |
287 | ||
288 | #define BITS_STOP_MASK 0x000f | |
289 | #define BITS_STOP_1 0x0000 | |
290 | #define BITS_STOP_1_5 0x0001 | |
291 | #define BITS_STOP_2 0x0002 | |
39a66b8d | 292 | |
93ef1f1f | 293 | /* CP210X_SET_BREAK */ |
72916791 CS |
294 | #define BREAK_ON 0x0001 |
295 | #define BREAK_OFF 0x0000 | |
1da177e4 | 296 | |
93ef1f1f | 297 | /* CP210X_(SET_MHS|GET_MDMSTS) */ |
39a66b8d CS |
298 | #define CONTROL_DTR 0x0001 |
299 | #define CONTROL_RTS 0x0002 | |
300 | #define CONTROL_CTS 0x0010 | |
301 | #define CONTROL_DSR 0x0020 | |
302 | #define CONTROL_RING 0x0040 | |
303 | #define CONTROL_DCD 0x0080 | |
304 | #define CONTROL_WRITE_DTR 0x0100 | |
305 | #define CONTROL_WRITE_RTS 0x0200 | |
1da177e4 | 306 | |
6f923a01 KS |
307 | /* CP210X_GET_COMM_STATUS returns these 0x13 bytes */ |
308 | struct cp210x_comm_status { | |
309 | __le32 ulErrors; | |
310 | __le32 ulHoldReasons; | |
311 | __le32 ulAmountInInQueue; | |
312 | __le32 ulAmountInOutQueue; | |
313 | u8 bEofReceived; | |
314 | u8 bWaitForImmediate; | |
315 | u8 bReserved; | |
316 | } __packed; | |
317 | ||
ebfb319b KS |
318 | /* |
319 | * CP210X_PURGE - 16 bits passed in wValue of USB request. | |
320 | * SiLabs app note AN571 gives a strange description of the 4 bits: | |
321 | * bit 0 or bit 2 clears the transmit queue and 1 or 3 receive. | |
322 | * writing 1 to all, however, purges cp2108 well enough to avoid the hang. | |
323 | */ | |
324 | #define PURGE_ALL 0x000f | |
325 | ||
39a66b8d | 326 | /* |
4cc27bd6 CS |
327 | * cp210x_get_config |
328 | * Reads from the CP210x configuration registers | |
39a66b8d CS |
329 | * 'size' is specified in bytes. |
330 | * 'data' is a pointer to a pre-allocated array of integers large | |
331 | * enough to hold 'size' bytes (with 4 bytes to each integer) | |
332 | */ | |
4cc27bd6 | 333 | static int cp210x_get_config(struct usb_serial_port *port, u8 request, |
39a66b8d | 334 | unsigned int *data, int size) |
1da177e4 LT |
335 | { |
336 | struct usb_serial *serial = port->serial; | |
e2ae67a3 | 337 | struct cp210x_port_private *port_priv = usb_get_serial_port_data(port); |
53ebb3b8 | 338 | __le32 *buf; |
39a66b8d CS |
339 | int result, i, length; |
340 | ||
341 | /* Number of integers required to contain the array */ | |
4f2ab888 | 342 | length = (((size - 1) | 3) + 1) / 4; |
39a66b8d | 343 | |
53ebb3b8 | 344 | buf = kcalloc(length, sizeof(__le32), GFP_KERNEL); |
10c642d0 | 345 | if (!buf) |
39a66b8d | 346 | return -ENOMEM; |
1da177e4 | 347 | |
39a66b8d | 348 | /* Issue the request, attempting to read 'size' bytes */ |
ff7eb602 | 349 | result = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0), |
32445605 | 350 | request, REQTYPE_INTERFACE_TO_HOST, 0x0000, |
e2ae67a3 | 351 | port_priv->bInterfaceNumber, buf, size, |
2d5733fc | 352 | USB_CTRL_GET_TIMEOUT); |
1da177e4 | 353 | |
39a66b8d | 354 | /* Convert data into an array of integers */ |
ff7eb602 | 355 | for (i = 0; i < length; i++) |
39a66b8d | 356 | data[i] = le32_to_cpu(buf[i]); |
1da177e4 | 357 | |
39a66b8d | 358 | kfree(buf); |
1da177e4 | 359 | |
39a66b8d | 360 | if (result != size) { |
660f3b14 GKH |
361 | dev_dbg(&port->dev, "%s - Unable to send config request, request=0x%x size=%d result=%d\n", |
362 | __func__, request, size, result); | |
2479e2a9 JH |
363 | if (result > 0) |
364 | result = -EPROTO; | |
365 | ||
366 | return result; | |
39a66b8d | 367 | } |
1da177e4 | 368 | |
39a66b8d | 369 | return 0; |
1da177e4 LT |
370 | } |
371 | ||
39a66b8d | 372 | /* |
4cc27bd6 CS |
373 | * cp210x_set_config |
374 | * Writes to the CP210x configuration registers | |
39a66b8d CS |
375 | * Values less than 16 bits wide are sent directly |
376 | * 'size' is specified in bytes. | |
377 | */ | |
4cc27bd6 | 378 | static int cp210x_set_config(struct usb_serial_port *port, u8 request, |
39a66b8d | 379 | unsigned int *data, int size) |
1da177e4 LT |
380 | { |
381 | struct usb_serial *serial = port->serial; | |
e2ae67a3 | 382 | struct cp210x_port_private *port_priv = usb_get_serial_port_data(port); |
53ebb3b8 | 383 | __le32 *buf; |
39a66b8d | 384 | int result, i, length; |
1da177e4 | 385 | |
39a66b8d | 386 | /* Number of integers required to contain the array */ |
4f2ab888 | 387 | length = (((size - 1) | 3) + 1) / 4; |
39a66b8d | 388 | |
53ebb3b8 | 389 | buf = kmalloc(length * sizeof(__le32), GFP_KERNEL); |
10c642d0 | 390 | if (!buf) |
39a66b8d | 391 | return -ENOMEM; |
39a66b8d CS |
392 | |
393 | /* Array of integers into bytes */ | |
394 | for (i = 0; i < length; i++) | |
395 | buf[i] = cpu_to_le32(data[i]); | |
396 | ||
397 | if (size > 2) { | |
ff7eb602 | 398 | result = usb_control_msg(serial->dev, |
39a66b8d | 399 | usb_sndctrlpipe(serial->dev, 0), |
32445605 | 400 | request, REQTYPE_HOST_TO_INTERFACE, 0x0000, |
e2ae67a3 | 401 | port_priv->bInterfaceNumber, buf, size, |
2d5733fc | 402 | USB_CTRL_SET_TIMEOUT); |
39a66b8d | 403 | } else { |
ff7eb602 | 404 | result = usb_control_msg(serial->dev, |
39a66b8d | 405 | usb_sndctrlpipe(serial->dev, 0), |
32445605 | 406 | request, REQTYPE_HOST_TO_INTERFACE, data[0], |
e2ae67a3 | 407 | port_priv->bInterfaceNumber, NULL, 0, |
2d5733fc | 408 | USB_CTRL_SET_TIMEOUT); |
1da177e4 LT |
409 | } |
410 | ||
39a66b8d CS |
411 | kfree(buf); |
412 | ||
413 | if ((size > 2 && result != size) || result < 0) { | |
660f3b14 GKH |
414 | dev_dbg(&port->dev, "%s - Unable to send request, request=0x%x size=%d result=%d\n", |
415 | __func__, request, size, result); | |
2479e2a9 JH |
416 | if (result > 0) |
417 | result = -EPROTO; | |
418 | ||
419 | return result; | |
39a66b8d | 420 | } |
1da177e4 LT |
421 | |
422 | return 0; | |
423 | } | |
424 | ||
39a66b8d | 425 | /* |
19165b2b KS |
426 | * Reads a variable-sized block of CP210X_ registers, identified by req. |
427 | * Returns data into buf in native USB byte order. | |
39a66b8d | 428 | */ |
19165b2b KS |
429 | static int cp210x_read_reg_block(struct usb_serial_port *port, u8 req, |
430 | void *buf, int bufsize) | |
39a66b8d | 431 | { |
19165b2b KS |
432 | struct usb_serial *serial = port->serial; |
433 | struct cp210x_port_private *port_priv = usb_get_serial_port_data(port); | |
434 | void *dmabuf; | |
435 | int result; | |
436 | ||
437 | dmabuf = kmalloc(bufsize, GFP_KERNEL); | |
438 | if (!dmabuf) { | |
439 | /* | |
440 | * FIXME Some callers don't bother to check for error, | |
441 | * at least give them consistent junk until they are fixed | |
442 | */ | |
443 | memset(buf, 0, bufsize); | |
444 | return -ENOMEM; | |
445 | } | |
446 | ||
447 | result = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0), | |
448 | req, REQTYPE_INTERFACE_TO_HOST, 0, | |
449 | port_priv->bInterfaceNumber, dmabuf, bufsize, | |
450 | USB_CTRL_SET_TIMEOUT); | |
451 | if (result == bufsize) { | |
452 | memcpy(buf, dmabuf, bufsize); | |
453 | result = 0; | |
454 | } else { | |
455 | dev_err(&port->dev, "failed get req 0x%x size %d status: %d\n", | |
456 | req, bufsize, result); | |
457 | if (result >= 0) | |
458 | result = -EPROTO; | |
459 | ||
460 | /* | |
461 | * FIXME Some callers don't bother to check for error, | |
462 | * at least give them consistent junk until they are fixed | |
463 | */ | |
464 | memset(buf, 0, bufsize); | |
465 | } | |
466 | ||
467 | kfree(dmabuf); | |
468 | ||
469 | return result; | |
470 | } | |
471 | ||
fe1b07e9 KS |
472 | /* |
473 | * Reads any 32-bit CP210X_ register identified by req. | |
474 | */ | |
475 | static int cp210x_read_u32_reg(struct usb_serial_port *port, u8 req, u32 *val) | |
476 | { | |
477 | __le32 le32_val; | |
478 | int err; | |
479 | ||
480 | err = cp210x_read_reg_block(port, req, &le32_val, sizeof(le32_val)); | |
481 | if (err) { | |
482 | /* | |
483 | * FIXME Some callers don't bother to check for error, | |
484 | * at least give them consistent junk until they are fixed | |
485 | */ | |
486 | *val = 0; | |
487 | return err; | |
488 | } | |
489 | ||
490 | *val = le32_to_cpu(le32_val); | |
491 | ||
492 | return 0; | |
493 | } | |
494 | ||
19165b2b KS |
495 | /* |
496 | * Reads any 16-bit CP210X_ register identified by req. | |
497 | */ | |
498 | static int cp210x_read_u16_reg(struct usb_serial_port *port, u8 req, u16 *val) | |
499 | { | |
500 | __le16 le16_val; | |
501 | int err; | |
502 | ||
503 | err = cp210x_read_reg_block(port, req, &le16_val, sizeof(le16_val)); | |
504 | if (err) | |
505 | return err; | |
506 | ||
507 | *val = le16_to_cpu(le16_val); | |
fe1b07e9 | 508 | |
19165b2b KS |
509 | return 0; |
510 | } | |
511 | ||
fe1b07e9 KS |
512 | /* |
513 | * Reads any 8-bit CP210X_ register identified by req. | |
514 | */ | |
515 | static int cp210x_read_u8_reg(struct usb_serial_port *port, u8 req, u8 *val) | |
516 | { | |
517 | return cp210x_read_reg_block(port, req, val, sizeof(*val)); | |
518 | } | |
519 | ||
19165b2b KS |
520 | /* |
521 | * Writes any 16-bit CP210X_ register (req) whose value is passed | |
522 | * entirely in the wValue field of the USB request. | |
523 | */ | |
524 | static int cp210x_write_u16_reg(struct usb_serial_port *port, u8 req, u16 val) | |
525 | { | |
526 | struct usb_serial *serial = port->serial; | |
527 | struct cp210x_port_private *port_priv = usb_get_serial_port_data(port); | |
528 | int result; | |
529 | ||
530 | result = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | |
531 | req, REQTYPE_HOST_TO_INTERFACE, val, | |
532 | port_priv->bInterfaceNumber, NULL, 0, | |
533 | USB_CTRL_SET_TIMEOUT); | |
534 | if (result < 0) { | |
535 | dev_err(&port->dev, "failed set request 0x%x status: %d\n", | |
536 | req, result); | |
537 | } | |
538 | ||
539 | return result; | |
39a66b8d CS |
540 | } |
541 | ||
fe1b07e9 KS |
542 | /* |
543 | * Writes a variable-sized block of CP210X_ registers, identified by req. | |
544 | * Data in buf must be in native USB byte order. | |
545 | */ | |
546 | static int cp210x_write_reg_block(struct usb_serial_port *port, u8 req, | |
547 | void *buf, int bufsize) | |
548 | { | |
549 | struct usb_serial *serial = port->serial; | |
550 | struct cp210x_port_private *port_priv = usb_get_serial_port_data(port); | |
551 | void *dmabuf; | |
552 | int result; | |
553 | ||
554 | dmabuf = kmalloc(bufsize, GFP_KERNEL); | |
555 | if (!dmabuf) | |
556 | return -ENOMEM; | |
557 | ||
558 | memcpy(dmabuf, buf, bufsize); | |
559 | ||
560 | result = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | |
561 | req, REQTYPE_HOST_TO_INTERFACE, 0, | |
562 | port_priv->bInterfaceNumber, dmabuf, bufsize, | |
563 | USB_CTRL_SET_TIMEOUT); | |
564 | ||
565 | kfree(dmabuf); | |
566 | ||
567 | if (result == bufsize) { | |
568 | result = 0; | |
569 | } else { | |
570 | dev_err(&port->dev, "failed set req 0x%x size %d status: %d\n", | |
571 | req, bufsize, result); | |
572 | if (result >= 0) | |
573 | result = -EPROTO; | |
574 | } | |
575 | ||
576 | return result; | |
577 | } | |
578 | ||
579 | /* | |
580 | * Writes any 32-bit CP210X_ register identified by req. | |
581 | */ | |
582 | static int cp210x_write_u32_reg(struct usb_serial_port *port, u8 req, u32 val) | |
583 | { | |
584 | __le32 le32_val; | |
585 | ||
586 | le32_val = cpu_to_le32(val); | |
587 | ||
588 | return cp210x_write_reg_block(port, req, &le32_val, sizeof(le32_val)); | |
589 | } | |
590 | ||
d0bf1ff0 KS |
591 | /* |
592 | * Detect CP2108 GET_LINE_CTL bug and activate workaround. | |
593 | * Write a known good value 0x800, read it back. | |
594 | * If it comes back swapped the bug is detected. | |
595 | * Preserve the original register value. | |
596 | */ | |
597 | static int cp210x_detect_swapped_line_ctl(struct usb_serial_port *port) | |
598 | { | |
599 | struct cp210x_port_private *port_priv = usb_get_serial_port_data(port); | |
19165b2b KS |
600 | u16 line_ctl_save; |
601 | u16 line_ctl_test; | |
d0bf1ff0 KS |
602 | int err; |
603 | ||
19165b2b | 604 | err = cp210x_read_u16_reg(port, CP210X_GET_LINE_CTL, &line_ctl_save); |
d0bf1ff0 KS |
605 | if (err) |
606 | return err; | |
607 | ||
19165b2b | 608 | err = cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, 0x800); |
d0bf1ff0 KS |
609 | if (err) |
610 | return err; | |
611 | ||
19165b2b | 612 | err = cp210x_read_u16_reg(port, CP210X_GET_LINE_CTL, &line_ctl_test); |
d0bf1ff0 KS |
613 | if (err) |
614 | return err; | |
615 | ||
616 | if (line_ctl_test == 8) { | |
617 | port_priv->has_swapped_line_ctl = true; | |
19165b2b | 618 | line_ctl_save = swab16(line_ctl_save); |
d0bf1ff0 KS |
619 | } |
620 | ||
19165b2b | 621 | return cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, line_ctl_save); |
d0bf1ff0 KS |
622 | } |
623 | ||
624 | /* | |
19165b2b | 625 | * Must always be called instead of cp210x_read_u16_reg(CP210X_GET_LINE_CTL) |
d0bf1ff0 KS |
626 | * to workaround cp2108 bug and get correct value. |
627 | */ | |
19165b2b | 628 | static int cp210x_get_line_ctl(struct usb_serial_port *port, u16 *ctl) |
d0bf1ff0 KS |
629 | { |
630 | struct cp210x_port_private *port_priv = usb_get_serial_port_data(port); | |
631 | int err; | |
632 | ||
19165b2b | 633 | err = cp210x_read_u16_reg(port, CP210X_GET_LINE_CTL, ctl); |
d0bf1ff0 KS |
634 | if (err) |
635 | return err; | |
636 | ||
637 | /* Workaround swapped bytes in 16-bit value from CP210X_GET_LINE_CTL */ | |
638 | if (port_priv->has_swapped_line_ctl) | |
19165b2b | 639 | *ctl = swab16(*ctl); |
d0bf1ff0 KS |
640 | |
641 | return 0; | |
642 | } | |
643 | ||
ef8b6bcb | 644 | /* |
4cc27bd6 | 645 | * cp210x_quantise_baudrate |
ef8b6bcb CS |
646 | * Quantises the baud rate as per AN205 Table 1 |
647 | */ | |
4f2ab888 JH |
648 | static unsigned int cp210x_quantise_baudrate(unsigned int baud) |
649 | { | |
be125d9c JH |
650 | if (baud <= 300) |
651 | baud = 300; | |
ef8b6bcb CS |
652 | else if (baud <= 600) baud = 600; |
653 | else if (baud <= 1200) baud = 1200; | |
654 | else if (baud <= 1800) baud = 1800; | |
655 | else if (baud <= 2400) baud = 2400; | |
656 | else if (baud <= 4000) baud = 4000; | |
657 | else if (baud <= 4803) baud = 4800; | |
658 | else if (baud <= 7207) baud = 7200; | |
659 | else if (baud <= 9612) baud = 9600; | |
660 | else if (baud <= 14428) baud = 14400; | |
661 | else if (baud <= 16062) baud = 16000; | |
662 | else if (baud <= 19250) baud = 19200; | |
663 | else if (baud <= 28912) baud = 28800; | |
664 | else if (baud <= 38601) baud = 38400; | |
665 | else if (baud <= 51558) baud = 51200; | |
666 | else if (baud <= 56280) baud = 56000; | |
667 | else if (baud <= 58053) baud = 57600; | |
668 | else if (baud <= 64111) baud = 64000; | |
669 | else if (baud <= 77608) baud = 76800; | |
670 | else if (baud <= 117028) baud = 115200; | |
671 | else if (baud <= 129347) baud = 128000; | |
672 | else if (baud <= 156868) baud = 153600; | |
673 | else if (baud <= 237832) baud = 230400; | |
674 | else if (baud <= 254234) baud = 250000; | |
675 | else if (baud <= 273066) baud = 256000; | |
676 | else if (baud <= 491520) baud = 460800; | |
677 | else if (baud <= 567138) baud = 500000; | |
678 | else if (baud <= 670254) baud = 576000; | |
d1620ca9 JH |
679 | else if (baud < 1000000) |
680 | baud = 921600; | |
681 | else if (baud > 2000000) | |
682 | baud = 2000000; | |
ef8b6bcb CS |
683 | return baud; |
684 | } | |
685 | ||
a509a7e4 | 686 | static int cp210x_open(struct tty_struct *tty, struct usb_serial_port *port) |
1da177e4 | 687 | { |
1da177e4 LT |
688 | int result; |
689 | ||
19165b2b | 690 | result = cp210x_write_u16_reg(port, CP210X_IFC_ENABLE, UART_ENABLE); |
2479e2a9 JH |
691 | if (result) { |
692 | dev_err(&port->dev, "%s - Unable to enable UART\n", __func__); | |
693 | return result; | |
1da177e4 LT |
694 | } |
695 | ||
39a66b8d | 696 | /* Configure the termios structure */ |
4cc27bd6 | 697 | cp210x_get_termios(tty, port); |
55b2afbb | 698 | |
cdc32fd6 JH |
699 | /* The baud rate must be initialised on cp2104 */ |
700 | if (tty) | |
701 | cp210x_change_speed(tty, port, NULL); | |
702 | ||
55b2afbb | 703 | return usb_serial_generic_open(tty, port); |
1da177e4 LT |
704 | } |
705 | ||
4cc27bd6 | 706 | static void cp210x_close(struct usb_serial_port *port) |
1da177e4 | 707 | { |
f26788da | 708 | usb_serial_generic_close(port); |
ebfb319b KS |
709 | |
710 | /* Clear both queues; cp2108 needs this to avoid an occasional hang */ | |
19165b2b | 711 | cp210x_write_u16_reg(port, CP210X_PURGE, PURGE_ALL); |
ebfb319b | 712 | |
19165b2b | 713 | cp210x_write_u16_reg(port, CP210X_IFC_ENABLE, UART_DISABLE); |
1da177e4 LT |
714 | } |
715 | ||
6f923a01 KS |
716 | /* |
717 | * Read how many bytes are waiting in the TX queue. | |
718 | */ | |
719 | static int cp210x_get_tx_queue_byte_count(struct usb_serial_port *port, | |
720 | u32 *count) | |
721 | { | |
722 | struct usb_serial *serial = port->serial; | |
723 | struct cp210x_port_private *port_priv = usb_get_serial_port_data(port); | |
724 | struct cp210x_comm_status *sts; | |
725 | int result; | |
726 | ||
727 | sts = kmalloc(sizeof(*sts), GFP_KERNEL); | |
728 | if (!sts) | |
729 | return -ENOMEM; | |
730 | ||
731 | result = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0), | |
732 | CP210X_GET_COMM_STATUS, REQTYPE_INTERFACE_TO_HOST, | |
733 | 0, port_priv->bInterfaceNumber, sts, sizeof(*sts), | |
734 | USB_CTRL_GET_TIMEOUT); | |
735 | if (result == sizeof(*sts)) { | |
736 | *count = le32_to_cpu(sts->ulAmountInOutQueue); | |
737 | result = 0; | |
738 | } else { | |
739 | dev_err(&port->dev, "failed to get comm status: %d\n", result); | |
740 | if (result >= 0) | |
741 | result = -EPROTO; | |
742 | } | |
743 | ||
744 | kfree(sts); | |
745 | ||
746 | return result; | |
747 | } | |
748 | ||
749 | static bool cp210x_tx_empty(struct usb_serial_port *port) | |
750 | { | |
751 | int err; | |
752 | u32 count; | |
753 | ||
754 | err = cp210x_get_tx_queue_byte_count(port, &count); | |
755 | if (err) | |
756 | return true; | |
757 | ||
758 | return !count; | |
759 | } | |
760 | ||
39a66b8d | 761 | /* |
4cc27bd6 | 762 | * cp210x_get_termios |
39a66b8d CS |
763 | * Reads the baud rate, data bits, parity, stop bits and flow control mode |
764 | * from the device, corrects any unsupported values, and configures the | |
765 | * termios structure to reflect the state of the device | |
766 | */ | |
4cc27bd6 | 767 | static void cp210x_get_termios(struct tty_struct *tty, |
d2ad67b3 V |
768 | struct usb_serial_port *port) |
769 | { | |
770 | unsigned int baud; | |
771 | ||
772 | if (tty) { | |
4cc27bd6 | 773 | cp210x_get_termios_port(tty->driver_data, |
adc8d746 | 774 | &tty->termios.c_cflag, &baud); |
d2ad67b3 | 775 | tty_encode_baud_rate(tty, baud, baud); |
4f2ab888 | 776 | } else { |
d2ad67b3 V |
777 | unsigned int cflag; |
778 | cflag = 0; | |
4cc27bd6 | 779 | cp210x_get_termios_port(port, &cflag, &baud); |
d2ad67b3 V |
780 | } |
781 | } | |
782 | ||
783 | /* | |
4cc27bd6 CS |
784 | * cp210x_get_termios_port |
785 | * This is the heart of cp210x_get_termios which always uses a &usb_serial_port. | |
d2ad67b3 | 786 | */ |
4cc27bd6 | 787 | static void cp210x_get_termios_port(struct usb_serial_port *port, |
d2ad67b3 | 788 | unsigned int *cflagp, unsigned int *baudp) |
1da177e4 | 789 | { |
660f3b14 | 790 | struct device *dev = &port->dev; |
39a66b8d | 791 | unsigned int cflag, modem_ctl[4]; |
fe1b07e9 | 792 | u32 baud; |
19165b2b | 793 | u16 bits; |
1da177e4 | 794 | |
fe1b07e9 | 795 | cp210x_read_u32_reg(port, CP210X_GET_BAUDRATE, &baud); |
1da177e4 | 796 | |
660f3b14 | 797 | dev_dbg(dev, "%s - baud rate = %d\n", __func__, baud); |
d2ad67b3 | 798 | *baudp = baud; |
9ab0f202 | 799 | |
d2ad67b3 | 800 | cflag = *cflagp; |
1da177e4 | 801 | |
d0bf1ff0 | 802 | cp210x_get_line_ctl(port, &bits); |
1da177e4 | 803 | cflag &= ~CSIZE; |
ff7eb602 AC |
804 | switch (bits & BITS_DATA_MASK) { |
805 | case BITS_DATA_5: | |
660f3b14 | 806 | dev_dbg(dev, "%s - data bits = 5\n", __func__); |
ff7eb602 AC |
807 | cflag |= CS5; |
808 | break; | |
809 | case BITS_DATA_6: | |
660f3b14 | 810 | dev_dbg(dev, "%s - data bits = 6\n", __func__); |
ff7eb602 AC |
811 | cflag |= CS6; |
812 | break; | |
813 | case BITS_DATA_7: | |
660f3b14 | 814 | dev_dbg(dev, "%s - data bits = 7\n", __func__); |
ff7eb602 AC |
815 | cflag |= CS7; |
816 | break; | |
817 | case BITS_DATA_8: | |
660f3b14 | 818 | dev_dbg(dev, "%s - data bits = 8\n", __func__); |
ff7eb602 AC |
819 | cflag |= CS8; |
820 | break; | |
821 | case BITS_DATA_9: | |
660f3b14 | 822 | dev_dbg(dev, "%s - data bits = 9 (not supported, using 8 data bits)\n", __func__); |
ff7eb602 AC |
823 | cflag |= CS8; |
824 | bits &= ~BITS_DATA_MASK; | |
825 | bits |= BITS_DATA_8; | |
19165b2b | 826 | cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, bits); |
ff7eb602 AC |
827 | break; |
828 | default: | |
660f3b14 | 829 | dev_dbg(dev, "%s - Unknown number of data bits, using 8\n", __func__); |
ff7eb602 AC |
830 | cflag |= CS8; |
831 | bits &= ~BITS_DATA_MASK; | |
832 | bits |= BITS_DATA_8; | |
19165b2b | 833 | cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, bits); |
ff7eb602 | 834 | break; |
1da177e4 LT |
835 | } |
836 | ||
ff7eb602 AC |
837 | switch (bits & BITS_PARITY_MASK) { |
838 | case BITS_PARITY_NONE: | |
660f3b14 | 839 | dev_dbg(dev, "%s - parity = NONE\n", __func__); |
ff7eb602 AC |
840 | cflag &= ~PARENB; |
841 | break; | |
842 | case BITS_PARITY_ODD: | |
660f3b14 | 843 | dev_dbg(dev, "%s - parity = ODD\n", __func__); |
ff7eb602 AC |
844 | cflag |= (PARENB|PARODD); |
845 | break; | |
846 | case BITS_PARITY_EVEN: | |
660f3b14 | 847 | dev_dbg(dev, "%s - parity = EVEN\n", __func__); |
ff7eb602 AC |
848 | cflag &= ~PARODD; |
849 | cflag |= PARENB; | |
850 | break; | |
851 | case BITS_PARITY_MARK: | |
660f3b14 | 852 | dev_dbg(dev, "%s - parity = MARK\n", __func__); |
4b6181ca | 853 | cflag |= (PARENB|PARODD|CMSPAR); |
ff7eb602 AC |
854 | break; |
855 | case BITS_PARITY_SPACE: | |
660f3b14 | 856 | dev_dbg(dev, "%s - parity = SPACE\n", __func__); |
4b6181ca RK |
857 | cflag &= ~PARODD; |
858 | cflag |= (PARENB|CMSPAR); | |
ff7eb602 AC |
859 | break; |
860 | default: | |
660f3b14 | 861 | dev_dbg(dev, "%s - Unknown parity mode, disabling parity\n", __func__); |
ff7eb602 AC |
862 | cflag &= ~PARENB; |
863 | bits &= ~BITS_PARITY_MASK; | |
19165b2b | 864 | cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, bits); |
ff7eb602 | 865 | break; |
1da177e4 LT |
866 | } |
867 | ||
868 | cflag &= ~CSTOPB; | |
ff7eb602 AC |
869 | switch (bits & BITS_STOP_MASK) { |
870 | case BITS_STOP_1: | |
660f3b14 | 871 | dev_dbg(dev, "%s - stop bits = 1\n", __func__); |
ff7eb602 AC |
872 | break; |
873 | case BITS_STOP_1_5: | |
660f3b14 | 874 | dev_dbg(dev, "%s - stop bits = 1.5 (not supported, using 1 stop bit)\n", __func__); |
ff7eb602 | 875 | bits &= ~BITS_STOP_MASK; |
19165b2b | 876 | cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, bits); |
ff7eb602 AC |
877 | break; |
878 | case BITS_STOP_2: | |
660f3b14 | 879 | dev_dbg(dev, "%s - stop bits = 2\n", __func__); |
ff7eb602 AC |
880 | cflag |= CSTOPB; |
881 | break; | |
882 | default: | |
660f3b14 | 883 | dev_dbg(dev, "%s - Unknown number of stop bits, using 1 stop bit\n", __func__); |
ff7eb602 | 884 | bits &= ~BITS_STOP_MASK; |
19165b2b | 885 | cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, bits); |
ff7eb602 | 886 | break; |
1da177e4 LT |
887 | } |
888 | ||
4cc27bd6 | 889 | cp210x_get_config(port, CP210X_GET_FLOW, modem_ctl, 16); |
39a66b8d | 890 | if (modem_ctl[0] & 0x0008) { |
660f3b14 | 891 | dev_dbg(dev, "%s - flow control = CRTSCTS\n", __func__); |
39a66b8d CS |
892 | cflag |= CRTSCTS; |
893 | } else { | |
660f3b14 | 894 | dev_dbg(dev, "%s - flow control = NONE\n", __func__); |
39a66b8d CS |
895 | cflag &= ~CRTSCTS; |
896 | } | |
897 | ||
d2ad67b3 | 898 | *cflagp = cflag; |
1da177e4 LT |
899 | } |
900 | ||
e5990874 JH |
901 | /* |
902 | * CP2101 supports the following baud rates: | |
903 | * | |
904 | * 300, 600, 1200, 1800, 2400, 4800, 7200, 9600, 14400, 19200, 28800, | |
905 | * 38400, 56000, 57600, 115200, 128000, 230400, 460800, 921600 | |
906 | * | |
907 | * CP2102 and CP2103 support the following additional rates: | |
908 | * | |
909 | * 4000, 16000, 51200, 64000, 76800, 153600, 250000, 256000, 500000, | |
910 | * 576000 | |
911 | * | |
912 | * The device will map a requested rate to a supported one, but the result | |
913 | * of requests for rates greater than 1053257 is undefined (see AN205). | |
914 | * | |
915 | * CP2104, CP2105 and CP2110 support most rates up to 2M, 921k and 1M baud, | |
916 | * respectively, with an error less than 1%. The actual rates are determined | |
917 | * by | |
918 | * | |
919 | * div = round(freq / (2 x prescale x request)) | |
920 | * actual = freq / (2 x prescale x div) | |
921 | * | |
922 | * For CP2104 and CP2105 freq is 48Mhz and prescale is 4 for request <= 365bps | |
923 | * or 1 otherwise. | |
924 | * For CP2110 freq is 24Mhz and prescale is 4 for request <= 300bps or 1 | |
925 | * otherwise. | |
926 | */ | |
927 | static void cp210x_change_speed(struct tty_struct *tty, | |
928 | struct usb_serial_port *port, struct ktermios *old_termios) | |
929 | { | |
930 | u32 baud; | |
931 | ||
adc8d746 | 932 | baud = tty->termios.c_ospeed; |
e5990874 | 933 | |
d1620ca9 JH |
934 | /* This maps the requested rate to a rate valid on cp2102 or cp2103, |
935 | * or to an arbitrary rate in [1M,2M]. | |
e5990874 JH |
936 | * |
937 | * NOTE: B0 is not implemented. | |
938 | */ | |
939 | baud = cp210x_quantise_baudrate(baud); | |
940 | ||
660f3b14 | 941 | dev_dbg(&port->dev, "%s - setting baud rate to %u\n", __func__, baud); |
fe1b07e9 | 942 | if (cp210x_write_u32_reg(port, CP210X_SET_BAUDRATE, baud)) { |
e5990874 JH |
943 | dev_warn(&port->dev, "failed to set baud rate to %u\n", baud); |
944 | if (old_termios) | |
945 | baud = old_termios->c_ospeed; | |
946 | else | |
947 | baud = 9600; | |
948 | } | |
949 | ||
950 | tty_encode_baud_rate(tty, baud, baud); | |
951 | } | |
952 | ||
4cc27bd6 | 953 | static void cp210x_set_termios(struct tty_struct *tty, |
95da310e | 954 | struct usb_serial_port *port, struct ktermios *old_termios) |
1da177e4 | 955 | { |
660f3b14 | 956 | struct device *dev = &port->dev; |
9ab0f202 | 957 | unsigned int cflag, old_cflag; |
19165b2b | 958 | u16 bits; |
39a66b8d | 959 | unsigned int modem_ctl[4]; |
1da177e4 | 960 | |
adc8d746 | 961 | cflag = tty->termios.c_cflag; |
01e96d28 | 962 | old_cflag = old_termios->c_cflag; |
e5990874 | 963 | |
adc8d746 | 964 | if (tty->termios.c_ospeed != old_termios->c_ospeed) |
e5990874 | 965 | cp210x_change_speed(tty, port, old_termios); |
1da177e4 | 966 | |
39a66b8d | 967 | /* If the number of data bits is to be updated */ |
1da177e4 | 968 | if ((cflag & CSIZE) != (old_cflag & CSIZE)) { |
d0bf1ff0 | 969 | cp210x_get_line_ctl(port, &bits); |
1da177e4 LT |
970 | bits &= ~BITS_DATA_MASK; |
971 | switch (cflag & CSIZE) { | |
ff7eb602 AC |
972 | case CS5: |
973 | bits |= BITS_DATA_5; | |
660f3b14 | 974 | dev_dbg(dev, "%s - data bits = 5\n", __func__); |
ff7eb602 AC |
975 | break; |
976 | case CS6: | |
977 | bits |= BITS_DATA_6; | |
660f3b14 | 978 | dev_dbg(dev, "%s - data bits = 6\n", __func__); |
ff7eb602 AC |
979 | break; |
980 | case CS7: | |
981 | bits |= BITS_DATA_7; | |
660f3b14 | 982 | dev_dbg(dev, "%s - data bits = 7\n", __func__); |
ff7eb602 AC |
983 | break; |
984 | case CS8: | |
985 | bits |= BITS_DATA_8; | |
660f3b14 | 986 | dev_dbg(dev, "%s - data bits = 8\n", __func__); |
ff7eb602 AC |
987 | break; |
988 | /*case CS9: | |
989 | bits |= BITS_DATA_9; | |
660f3b14 | 990 | dev_dbg(dev, "%s - data bits = 9\n", __func__); |
ff7eb602 AC |
991 | break;*/ |
992 | default: | |
660f3b14 | 993 | dev_dbg(dev, "cp210x driver does not support the number of bits requested, using 8 bit mode\n"); |
4f2ab888 JH |
994 | bits |= BITS_DATA_8; |
995 | break; | |
1da177e4 | 996 | } |
19165b2b | 997 | if (cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, bits)) |
660f3b14 | 998 | dev_dbg(dev, "Number of data bits requested not supported by device\n"); |
1da177e4 LT |
999 | } |
1000 | ||
4b6181ca RK |
1001 | if ((cflag & (PARENB|PARODD|CMSPAR)) != |
1002 | (old_cflag & (PARENB|PARODD|CMSPAR))) { | |
d0bf1ff0 | 1003 | cp210x_get_line_ctl(port, &bits); |
1da177e4 LT |
1004 | bits &= ~BITS_PARITY_MASK; |
1005 | if (cflag & PARENB) { | |
4b6181ca | 1006 | if (cflag & CMSPAR) { |
660f3b14 GKH |
1007 | if (cflag & PARODD) { |
1008 | bits |= BITS_PARITY_MARK; | |
1009 | dev_dbg(dev, "%s - parity = MARK\n", __func__); | |
1010 | } else { | |
1011 | bits |= BITS_PARITY_SPACE; | |
1012 | dev_dbg(dev, "%s - parity = SPACE\n", __func__); | |
1013 | } | |
1da177e4 | 1014 | } else { |
660f3b14 GKH |
1015 | if (cflag & PARODD) { |
1016 | bits |= BITS_PARITY_ODD; | |
1017 | dev_dbg(dev, "%s - parity = ODD\n", __func__); | |
1018 | } else { | |
1019 | bits |= BITS_PARITY_EVEN; | |
1020 | dev_dbg(dev, "%s - parity = EVEN\n", __func__); | |
1021 | } | |
1da177e4 LT |
1022 | } |
1023 | } | |
19165b2b | 1024 | if (cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, bits)) |
660f3b14 | 1025 | dev_dbg(dev, "Parity mode not supported by device\n"); |
1da177e4 LT |
1026 | } |
1027 | ||
1028 | if ((cflag & CSTOPB) != (old_cflag & CSTOPB)) { | |
d0bf1ff0 | 1029 | cp210x_get_line_ctl(port, &bits); |
1da177e4 LT |
1030 | bits &= ~BITS_STOP_MASK; |
1031 | if (cflag & CSTOPB) { | |
1032 | bits |= BITS_STOP_2; | |
660f3b14 | 1033 | dev_dbg(dev, "%s - stop bits = 2\n", __func__); |
1da177e4 LT |
1034 | } else { |
1035 | bits |= BITS_STOP_1; | |
660f3b14 | 1036 | dev_dbg(dev, "%s - stop bits = 1\n", __func__); |
1da177e4 | 1037 | } |
19165b2b | 1038 | if (cp210x_write_u16_reg(port, CP210X_SET_LINE_CTL, bits)) |
660f3b14 | 1039 | dev_dbg(dev, "Number of stop bits requested not supported by device\n"); |
1da177e4 | 1040 | } |
39a66b8d CS |
1041 | |
1042 | if ((cflag & CRTSCTS) != (old_cflag & CRTSCTS)) { | |
4cc27bd6 | 1043 | cp210x_get_config(port, CP210X_GET_FLOW, modem_ctl, 16); |
660f3b14 GKH |
1044 | dev_dbg(dev, "%s - read modem controls = 0x%.4x 0x%.4x 0x%.4x 0x%.4x\n", |
1045 | __func__, modem_ctl[0], modem_ctl[1], | |
1046 | modem_ctl[2], modem_ctl[3]); | |
39a66b8d CS |
1047 | |
1048 | if (cflag & CRTSCTS) { | |
1049 | modem_ctl[0] &= ~0x7B; | |
1050 | modem_ctl[0] |= 0x09; | |
1051 | modem_ctl[1] = 0x80; | |
660f3b14 | 1052 | dev_dbg(dev, "%s - flow control = CRTSCTS\n", __func__); |
39a66b8d CS |
1053 | } else { |
1054 | modem_ctl[0] &= ~0x7B; | |
1055 | modem_ctl[0] |= 0x01; | |
1056 | modem_ctl[1] |= 0x40; | |
660f3b14 | 1057 | dev_dbg(dev, "%s - flow control = NONE\n", __func__); |
39a66b8d CS |
1058 | } |
1059 | ||
660f3b14 GKH |
1060 | dev_dbg(dev, "%s - write modem controls = 0x%.4x 0x%.4x 0x%.4x 0x%.4x\n", |
1061 | __func__, modem_ctl[0], modem_ctl[1], | |
1062 | modem_ctl[2], modem_ctl[3]); | |
4cc27bd6 | 1063 | cp210x_set_config(port, CP210X_SET_FLOW, modem_ctl, 16); |
39a66b8d CS |
1064 | } |
1065 | ||
1066 | } | |
1067 | ||
4f2ab888 | 1068 | static int cp210x_tiocmset(struct tty_struct *tty, |
39a66b8d CS |
1069 | unsigned int set, unsigned int clear) |
1070 | { | |
95da310e | 1071 | struct usb_serial_port *port = tty->driver_data; |
20b9d177 | 1072 | return cp210x_tiocmset_port(port, set, clear); |
d2ad67b3 V |
1073 | } |
1074 | ||
20b9d177 | 1075 | static int cp210x_tiocmset_port(struct usb_serial_port *port, |
d2ad67b3 V |
1076 | unsigned int set, unsigned int clear) |
1077 | { | |
19165b2b | 1078 | u16 control = 0; |
39a66b8d | 1079 | |
39a66b8d CS |
1080 | if (set & TIOCM_RTS) { |
1081 | control |= CONTROL_RTS; | |
1082 | control |= CONTROL_WRITE_RTS; | |
1083 | } | |
1084 | if (set & TIOCM_DTR) { | |
1085 | control |= CONTROL_DTR; | |
1086 | control |= CONTROL_WRITE_DTR; | |
1087 | } | |
1088 | if (clear & TIOCM_RTS) { | |
1089 | control &= ~CONTROL_RTS; | |
1090 | control |= CONTROL_WRITE_RTS; | |
1091 | } | |
1092 | if (clear & TIOCM_DTR) { | |
1093 | control &= ~CONTROL_DTR; | |
1094 | control |= CONTROL_WRITE_DTR; | |
1095 | } | |
1096 | ||
660f3b14 | 1097 | dev_dbg(&port->dev, "%s - control = 0x%.4x\n", __func__, control); |
39a66b8d | 1098 | |
19165b2b | 1099 | return cp210x_write_u16_reg(port, CP210X_SET_MHS, control); |
39a66b8d CS |
1100 | } |
1101 | ||
d94c7bd4 AC |
1102 | static void cp210x_dtr_rts(struct usb_serial_port *p, int on) |
1103 | { | |
1104 | if (on) | |
20b9d177 | 1105 | cp210x_tiocmset_port(p, TIOCM_DTR|TIOCM_RTS, 0); |
d94c7bd4 | 1106 | else |
20b9d177 | 1107 | cp210x_tiocmset_port(p, 0, TIOCM_DTR|TIOCM_RTS); |
d94c7bd4 AC |
1108 | } |
1109 | ||
4f2ab888 | 1110 | static int cp210x_tiocmget(struct tty_struct *tty) |
39a66b8d | 1111 | { |
95da310e | 1112 | struct usb_serial_port *port = tty->driver_data; |
fe1b07e9 | 1113 | u8 control; |
b2bdd1f5 | 1114 | int result; |
39a66b8d | 1115 | |
fe1b07e9 | 1116 | cp210x_read_u8_reg(port, CP210X_GET_MDMSTS, &control); |
39a66b8d CS |
1117 | |
1118 | result = ((control & CONTROL_DTR) ? TIOCM_DTR : 0) | |
1119 | |((control & CONTROL_RTS) ? TIOCM_RTS : 0) | |
1120 | |((control & CONTROL_CTS) ? TIOCM_CTS : 0) | |
1121 | |((control & CONTROL_DSR) ? TIOCM_DSR : 0) | |
1122 | |((control & CONTROL_RING)? TIOCM_RI : 0) | |
1123 | |((control & CONTROL_DCD) ? TIOCM_CD : 0); | |
1124 | ||
660f3b14 | 1125 | dev_dbg(&port->dev, "%s - control = 0x%.2x\n", __func__, control); |
39a66b8d CS |
1126 | |
1127 | return result; | |
1da177e4 LT |
1128 | } |
1129 | ||
4f2ab888 | 1130 | static void cp210x_break_ctl(struct tty_struct *tty, int break_state) |
1da177e4 | 1131 | { |
95da310e | 1132 | struct usb_serial_port *port = tty->driver_data; |
19165b2b | 1133 | u16 state; |
1da177e4 | 1134 | |
1da177e4 LT |
1135 | if (break_state == 0) |
1136 | state = BREAK_OFF; | |
1137 | else | |
1138 | state = BREAK_ON; | |
660f3b14 GKH |
1139 | dev_dbg(&port->dev, "%s - turning break %s\n", __func__, |
1140 | state == BREAK_OFF ? "off" : "on"); | |
19165b2b | 1141 | cp210x_write_u16_reg(port, CP210X_SET_BREAK, state); |
1da177e4 LT |
1142 | } |
1143 | ||
e2ae67a3 | 1144 | static int cp210x_port_probe(struct usb_serial_port *port) |
1da177e4 | 1145 | { |
e2ae67a3 | 1146 | struct usb_serial *serial = port->serial; |
4295fe77 | 1147 | struct usb_host_interface *cur_altsetting; |
e2ae67a3 | 1148 | struct cp210x_port_private *port_priv; |
d0bf1ff0 | 1149 | int ret; |
a5360a53 | 1150 | |
e2ae67a3 KS |
1151 | port_priv = kzalloc(sizeof(*port_priv), GFP_KERNEL); |
1152 | if (!port_priv) | |
4295fe77 | 1153 | return -ENOMEM; |
a5360a53 | 1154 | |
4295fe77 | 1155 | cur_altsetting = serial->interface->cur_altsetting; |
e2ae67a3 | 1156 | port_priv->bInterfaceNumber = cur_altsetting->desc.bInterfaceNumber; |
a5360a53 | 1157 | |
e2ae67a3 | 1158 | usb_set_serial_port_data(port, port_priv); |
a5360a53 | 1159 | |
d0bf1ff0 KS |
1160 | ret = cp210x_detect_swapped_line_ctl(port); |
1161 | if (ret) { | |
1162 | kfree(port_priv); | |
1163 | return ret; | |
1164 | } | |
a5360a53 | 1165 | |
1da177e4 LT |
1166 | return 0; |
1167 | } | |
1168 | ||
e2ae67a3 | 1169 | static int cp210x_port_remove(struct usb_serial_port *port) |
a5360a53 | 1170 | { |
e2ae67a3 KS |
1171 | struct cp210x_port_private *port_priv; |
1172 | ||
1173 | port_priv = usb_get_serial_port_data(port); | |
1174 | kfree(port_priv); | |
a5360a53 | 1175 | |
e2ae67a3 | 1176 | return 0; |
a5360a53 PF |
1177 | } |
1178 | ||
68e24113 | 1179 | module_usb_serial_driver(serial_drivers, id_table); |
1da177e4 LT |
1180 | |
1181 | MODULE_DESCRIPTION(DRIVER_DESC); | |
1da177e4 | 1182 | MODULE_LICENSE("GPL"); |