cp210x.c 29.7 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1
/*
2
 * Silicon Laboratories CP210x USB to RS232 serial adaptor driver
Linus Torvalds's avatar
Linus Torvalds committed
3
4
5
6
7
8
9
 *
 * Copyright (C) 2005 Craig Shelley (craig@microtron.org.uk)
 *
 *	This program is free software; you can redistribute it and/or
 *	modify it under the terms of the GNU General Public License version
 *	2 as published by the Free Software Foundation.
 *
10
11
12
13
 * Support to set flow control line levels using TIOCMGET and TIOCMSET
 * thanks to Karl Hiramoto karl@hiramoto.org. RTSCTS hardware flow
 * control thanks to Munir Nassar nassarmu@real-time.com
 *
Linus Torvalds's avatar
Linus Torvalds committed
14
15
16
17
18
19
20
21
22
23
 */

#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/slab.h>
#include <linux/tty.h>
#include <linux/tty_flip.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/usb.h>
Alan Cox's avatar
Alan Cox committed
24
#include <linux/uaccess.h>
25
#include <linux/usb/serial.h>
Linus Torvalds's avatar
Linus Torvalds committed
26

27
#define DRIVER_DESC "Silicon Labs CP210x RS232 serial adaptor driver"
Linus Torvalds's avatar
Linus Torvalds committed
28
29
30
31

/*
 * Function Prototypes
 */
32
static int cp210x_open(struct tty_struct *tty, struct usb_serial_port *);
33
static void cp210x_close(struct usb_serial_port *);
34
static void cp210x_get_termios(struct tty_struct *, struct usb_serial_port *);
35
static void cp210x_get_termios_port(struct usb_serial_port *port,
36
	unsigned int *cflagp, unsigned int *baudp);
37
38
static void cp210x_change_speed(struct tty_struct *, struct usb_serial_port *,
							struct ktermios *);
39
static void cp210x_set_termios(struct tty_struct *, struct usb_serial_port *,
Alan Cox's avatar
Alan Cox committed
40
							struct ktermios*);
41
static int cp210x_tiocmget(struct tty_struct *);
42
43
static int cp210x_tiocmset(struct tty_struct *, unsigned int, unsigned int);
static int cp210x_tiocmset_port(struct usb_serial_port *port,
44
		unsigned int, unsigned int);
45
46
static void cp210x_break_ctl(struct tty_struct *, int);
static int cp210x_startup(struct usb_serial *);
47
static void cp210x_release(struct usb_serial *);
Alan Cox's avatar
Alan Cox committed
48
static void cp210x_dtr_rts(struct usb_serial_port *p, int on);
Linus Torvalds's avatar
Linus Torvalds committed
49

50
static const struct usb_device_id id_table[] = {
51
	{ USB_DEVICE(0x045B, 0x0053) }, /* Renesas RX610 RX-Stick */
M Kondrin's avatar
M Kondrin committed
52
	{ USB_DEVICE(0x0471, 0x066A) }, /* AKTAKOM ACE-1001 cable */
Craig Shelley's avatar
Craig Shelley committed
53
	{ USB_DEVICE(0x0489, 0xE000) }, /* Pirelli Broadband S.p.A, DP-L10 SIP/GSM Mobile */
54
	{ USB_DEVICE(0x0489, 0xE003) }, /* Pirelli Broadband S.p.A, DP-L10 SIP/GSM Mobile */
Craig Shelley's avatar
Craig Shelley committed
55
	{ USB_DEVICE(0x0745, 0x1000) }, /* CipherLab USB CCD Barcode Scanner 1000 */
56
	{ USB_DEVICE(0x0846, 0x1100) }, /* NetGear Managed Switch M4100 series, M5300 series, M7100 series */
57
	{ USB_DEVICE(0x08e6, 0x5501) }, /* Gemalto Prox-PU/CU contactless smartcard reader */
Craig Shelley's avatar
Craig Shelley committed
58
	{ USB_DEVICE(0x08FD, 0x000A) }, /* Digianswer A/S , ZigBee/802.15.4 MAC Device */
59
60
	{ USB_DEVICE(0x0BED, 0x1100) }, /* MEI (TM) Cashflow-SC Bill/Voucher Acceptor */
	{ USB_DEVICE(0x0BED, 0x1101) }, /* MEI series 2000 Combo Acceptor */
61
	{ USB_DEVICE(0x0FCF, 0x1003) }, /* Dynastream ANT development board */
62
	{ USB_DEVICE(0x0FCF, 0x1004) }, /* Dynastream ANT2USB */
Craig Shelley's avatar
Craig Shelley committed
63
	{ USB_DEVICE(0x0FCF, 0x1006) }, /* Dynastream ANT development board */
64
	{ USB_DEVICE(0x0FDE, 0xCA05) }, /* OWL Wireless Electricity Monitor CM-160 */
65
	{ USB_DEVICE(0x10A6, 0xAA26) }, /* Knock-off DCU-11 cable */
66
67
	{ USB_DEVICE(0x10AB, 0x10C5) }, /* Siemens MC60 Cable */
	{ USB_DEVICE(0x10B5, 0xAC70) }, /* Nokia CA-42 USB */
Craig Shelley's avatar
Craig Shelley committed
68
	{ USB_DEVICE(0x10C4, 0x0F91) }, /* Vstabi */
69
70
	{ USB_DEVICE(0x10C4, 0x1101) }, /* Arkham Technology DS101 Bus Monitor */
	{ USB_DEVICE(0x10C4, 0x1601) }, /* Arkham Technology DS101 Adapter */
Craig Shelley's avatar
Craig Shelley committed
71
	{ USB_DEVICE(0x10C4, 0x800A) }, /* SPORTident BSM7-D-USB main station */
72
	{ USB_DEVICE(0x10C4, 0x803B) }, /* Pololu USB-serial converter */
73
74
	{ USB_DEVICE(0x10C4, 0x8044) }, /* Cygnal Debug Adapter */
	{ USB_DEVICE(0x10C4, 0x804E) }, /* Software Bisque Paramount ME build-in converter */
Craig Shelley's avatar
Craig Shelley committed
75
	{ USB_DEVICE(0x10C4, 0x8053) }, /* Enfora EDG1228 */
76
	{ USB_DEVICE(0x10C4, 0x8054) }, /* Enfora GSM2228 */
Vitja Makarov's avatar
Vitja Makarov committed
77
	{ USB_DEVICE(0x10C4, 0x8066) }, /* Argussoft In-System Programmer */
78
	{ USB_DEVICE(0x10C4, 0x806F) }, /* IMS USB to RS422 Converter Cable */
79
	{ USB_DEVICE(0x10C4, 0x807A) }, /* Crumb128 board */
80
	{ USB_DEVICE(0x10C4, 0x80C4) }, /* Cygnal Integrated Products, Inc., Optris infrared thermometer */
81
	{ USB_DEVICE(0x10C4, 0x80CA) }, /* Degree Controls Inc */
Craig Shelley's avatar
Craig Shelley committed
82
	{ USB_DEVICE(0x10C4, 0x80DD) }, /* Tracient RFID */
83
	{ USB_DEVICE(0x10C4, 0x80F6) }, /* Suunto sports instrument */
84
	{ USB_DEVICE(0x10C4, 0x8115) }, /* Arygon NFC/Mifare Reader */
85
	{ USB_DEVICE(0x10C4, 0x813D) }, /* Burnside Telecom Deskmobile */
Craig Shelley's avatar
Craig Shelley committed
86
	{ USB_DEVICE(0x10C4, 0x813F) }, /* Tams Master Easy Control */
87
88
	{ USB_DEVICE(0x10C4, 0x814A) }, /* West Mountain Radio RIGblaster P&P */
	{ USB_DEVICE(0x10C4, 0x814B) }, /* West Mountain Radio RIGtalk */
89
	{ USB_DEVICE(0x2405, 0x0003) }, /* West Mountain Radio RIGblaster Advantage */
90
	{ USB_DEVICE(0x10C4, 0x8156) }, /* B&G H3000 link cable */
91
	{ USB_DEVICE(0x10C4, 0x815E) }, /* Helicomm IP-Link 1220-DVM */
Craig Shelley's avatar
Craig Shelley committed
92
	{ USB_DEVICE(0x10C4, 0x815F) }, /* Timewave HamLinkUSB */
93
	{ USB_DEVICE(0x10C4, 0x818B) }, /* AVIT Research USB to TTL */
94
	{ USB_DEVICE(0x10C4, 0x819F) }, /* MJS USB Toslink Switcher */
95
	{ USB_DEVICE(0x10C4, 0x81A6) }, /* ThinkOptics WavIt */
96
	{ USB_DEVICE(0x10C4, 0x81A9) }, /* Multiplex RC Interface */
Craig Shelley's avatar
Craig Shelley committed
97
	{ USB_DEVICE(0x10C4, 0x81AC) }, /* MSD Dash Hawk */
98
	{ USB_DEVICE(0x10C4, 0x81AD) }, /* INSYS USB Modem */
99
100
	{ USB_DEVICE(0x10C4, 0x81C8) }, /* Lipowsky Industrie Elektronik GmbH, Baby-JTAG */
	{ USB_DEVICE(0x10C4, 0x81E2) }, /* Lipowsky Industrie Elektronik GmbH, Baby-LIN */
Jeff Long's avatar
Jeff Long committed
101
	{ USB_DEVICE(0x10C4, 0x81E7) }, /* Aerocomm Radio */
102
	{ USB_DEVICE(0x10C4, 0x81E8) }, /* Zephyr Bioharness */
Craig Shelley's avatar
Craig Shelley committed
103
	{ USB_DEVICE(0x10C4, 0x81F2) }, /* C1007 HF band RFID controller */
104
	{ USB_DEVICE(0x10C4, 0x8218) }, /* Lipowsky Industrie Elektronik GmbH, HARP-1 */
Tomasz K's avatar
Tomasz K committed
105
	{ USB_DEVICE(0x10C4, 0x822B) }, /* Modem EDGE(GSM) Comander 2 */
Lucas De Marchi's avatar
Lucas De Marchi committed
106
	{ USB_DEVICE(0x10C4, 0x826B) }, /* Cygnal Integrated Products, Inc., Fasttrax GPS demonstration module */
107
	{ USB_DEVICE(0x10C4, 0x8281) }, /* Nanotec Plug & Drive */
108
	{ USB_DEVICE(0x10C4, 0x8293) }, /* Telegesis ETRX2USB */
Craig Shelley's avatar
Craig Shelley committed
109
	{ USB_DEVICE(0x10C4, 0x82F9) }, /* Procyon AVS */
110
	{ USB_DEVICE(0x10C4, 0x8341) }, /* Siemens MC35PU GPRS Modem */
Craig Shelley's avatar
Craig Shelley committed
111
	{ USB_DEVICE(0x10C4, 0x8382) }, /* Cygnal Integrated Products, Inc. */
112
	{ USB_DEVICE(0x10C4, 0x83A8) }, /* Amber Wireless AMB2560 */
Craig Shelley's avatar
Craig Shelley committed
113
	{ USB_DEVICE(0x10C4, 0x83D8) }, /* DekTec DTA Plus VHF/UHF Booster/Attenuator */
Craig Shelley's avatar
Craig Shelley committed
114
	{ USB_DEVICE(0x10C4, 0x8411) }, /* Kyocera GPS Module */
Craig Shelley's avatar
Craig Shelley committed
115
	{ USB_DEVICE(0x10C4, 0x8418) }, /* IRZ Automation Teleport SG-10 GSM/GPRS Modem */
Alex Stephens's avatar
Alex Stephens committed
116
	{ USB_DEVICE(0x10C4, 0x846E) }, /* BEI USB Sensor Interface (VCP) */
Craig Shelley's avatar
Craig Shelley committed
117
	{ USB_DEVICE(0x10C4, 0x8477) }, /* Balluff RFID */
118
119
	{ USB_DEVICE(0x10C4, 0x85EA) }, /* AC-Services IBUS-IF */
	{ USB_DEVICE(0x10C4, 0x85EB) }, /* AC-Services CIS-IBUS */
120
	{ USB_DEVICE(0x10C4, 0x85F8) }, /* Virtenio Preon32 */
121
122
	{ USB_DEVICE(0x10C4, 0x8664) }, /* AC-Services CAN-IF */
	{ USB_DEVICE(0x10C4, 0x8665) }, /* AC-Services OBD-IF */
123
124
	{ USB_DEVICE(0x10C4, 0x88A4) }, /* MMB Networks ZigBee USB Device */
	{ USB_DEVICE(0x10C4, 0x88A5) }, /* Planet Innovation Ingeni ZigBee USB Device */
125
	{ USB_DEVICE(0x10C4, 0xEA60) }, /* Silicon Labs factory default */
126
	{ USB_DEVICE(0x10C4, 0xEA61) }, /* Silicon Labs factory default */
127
128
	{ USB_DEVICE(0x10C4, 0xEA70) }, /* Silicon Labs factory default */
	{ USB_DEVICE(0x10C4, 0xEA80) }, /* Silicon Labs factory default */
129
	{ USB_DEVICE(0x10C4, 0xEA71) }, /* Infinity GPS-MIC-1 Radio Monophone */
Craig Shelley's avatar
Craig Shelley committed
130
131
132
133
	{ USB_DEVICE(0x10C4, 0xF001) }, /* Elan Digital Systems USBscope50 */
	{ USB_DEVICE(0x10C4, 0xF002) }, /* Elan Digital Systems USBwave12 */
	{ USB_DEVICE(0x10C4, 0xF003) }, /* Elan Digital Systems USBpulse100 */
	{ USB_DEVICE(0x10C4, 0xF004) }, /* Elan Digital Systems USBcount50 */
134
	{ USB_DEVICE(0x10C5, 0xEA61) }, /* Silicon Labs MobiData GPRS USB Modem */
Craig Shelley's avatar
Craig Shelley committed
135
	{ USB_DEVICE(0x10CE, 0xEA6A) }, /* Silicon Labs MobiData GPRS USB Modem 100EU */
136
	{ USB_DEVICE(0x13AD, 0x9999) }, /* Baltech card reader */
Craig Shelley's avatar
Craig Shelley committed
137
	{ USB_DEVICE(0x1555, 0x0004) }, /* Owen AC4 USB-RS485 Converter */
Craig Shelley's avatar
Craig Shelley committed
138
139
	{ USB_DEVICE(0x166A, 0x0201) }, /* Clipsal 5500PACA C-Bus Pascal Automation Controller */
	{ USB_DEVICE(0x166A, 0x0301) }, /* Clipsal 5800PC C-Bus Wireless PC Interface */
Craig Shelley's avatar
Craig Shelley committed
140
	{ USB_DEVICE(0x166A, 0x0303) }, /* Clipsal 5500PCU C-Bus USB interface */
Craig Shelley's avatar
Craig Shelley committed
141
142
143
144
	{ USB_DEVICE(0x166A, 0x0304) }, /* Clipsal 5000CT2 C-Bus Black and White Touchscreen */
	{ USB_DEVICE(0x166A, 0x0305) }, /* Clipsal C-5000CT2 C-Bus Spectrum Colour Touchscreen */
	{ USB_DEVICE(0x166A, 0x0401) }, /* Clipsal L51xx C-Bus Architectural Dimmer */
	{ USB_DEVICE(0x166A, 0x0101) }, /* Clipsal 5560884 C-Bus Multi-room Audio Matrix Switcher */
145
	{ USB_DEVICE(0x16D6, 0x0001) }, /* Jablotron serial interface */
146
147
148
149
	{ USB_DEVICE(0x16DC, 0x0010) }, /* W-IE-NE-R Plein & Baus GmbH PL512 Power Supply */
	{ USB_DEVICE(0x16DC, 0x0011) }, /* W-IE-NE-R Plein & Baus GmbH RCM Remote Control for MARATON Power Supply */
	{ USB_DEVICE(0x16DC, 0x0012) }, /* W-IE-NE-R Plein & Baus GmbH MPOD Multi Channel Power Supply */
	{ USB_DEVICE(0x16DC, 0x0015) }, /* W-IE-NE-R Plein & Baus GmbH CML Control, Monitoring and Data Logger */
150
151
	{ USB_DEVICE(0x17A8, 0x0001) }, /* Kamstrup Optical Eye/3-wire */
	{ USB_DEVICE(0x17A8, 0x0005) }, /* Kamstrup M-Bus Master MultiPort 250D */
Craig Shelley's avatar
Craig Shelley committed
152
153
154
	{ USB_DEVICE(0x17F4, 0xAAAA) }, /* Wavesense Jazz blood glucose meter */
	{ USB_DEVICE(0x1843, 0x0200) }, /* Vaisala USB Instrument Cable */
	{ USB_DEVICE(0x18EF, 0xE00F) }, /* ELV USB-I2C-Interface */
155
	{ USB_DEVICE(0x1ADB, 0x0001) }, /* Schweitzer Engineering C662 Cable */
156
	{ USB_DEVICE(0x1B1C, 0x1C00) }, /* Corsair USB Dongle */
157
	{ USB_DEVICE(0x1BE3, 0x07A6) }, /* WAGO 750-923 USB Service Cable */
Craig Shelley's avatar
Craig Shelley committed
158
159
	{ USB_DEVICE(0x1E29, 0x0102) }, /* Festo CPX-USB */
	{ USB_DEVICE(0x1E29, 0x0501) }, /* Festo CMSP */
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
	{ USB_DEVICE(0x1FB9, 0x0100) }, /* Lake Shore Model 121 Current Source */
	{ USB_DEVICE(0x1FB9, 0x0200) }, /* Lake Shore Model 218A Temperature Monitor */
	{ USB_DEVICE(0x1FB9, 0x0201) }, /* Lake Shore Model 219 Temperature Monitor */
	{ USB_DEVICE(0x1FB9, 0x0202) }, /* Lake Shore Model 233 Temperature Transmitter */
	{ USB_DEVICE(0x1FB9, 0x0203) }, /* Lake Shore Model 235 Temperature Transmitter */
	{ USB_DEVICE(0x1FB9, 0x0300) }, /* Lake Shore Model 335 Temperature Controller */
	{ USB_DEVICE(0x1FB9, 0x0301) }, /* Lake Shore Model 336 Temperature Controller */
	{ USB_DEVICE(0x1FB9, 0x0302) }, /* Lake Shore Model 350 Temperature Controller */
	{ USB_DEVICE(0x1FB9, 0x0303) }, /* Lake Shore Model 371 AC Bridge */
	{ USB_DEVICE(0x1FB9, 0x0400) }, /* Lake Shore Model 411 Handheld Gaussmeter */
	{ USB_DEVICE(0x1FB9, 0x0401) }, /* Lake Shore Model 425 Gaussmeter */
	{ USB_DEVICE(0x1FB9, 0x0402) }, /* Lake Shore Model 455A Gaussmeter */
	{ USB_DEVICE(0x1FB9, 0x0403) }, /* Lake Shore Model 475A Gaussmeter */
	{ USB_DEVICE(0x1FB9, 0x0404) }, /* Lake Shore Model 465 Three Axis Gaussmeter */
	{ USB_DEVICE(0x1FB9, 0x0600) }, /* Lake Shore Model 625A Superconducting MPS */
	{ USB_DEVICE(0x1FB9, 0x0601) }, /* Lake Shore Model 642A Magnet Power Supply */
	{ USB_DEVICE(0x1FB9, 0x0602) }, /* Lake Shore Model 648 Magnet Power Supply */
	{ USB_DEVICE(0x1FB9, 0x0700) }, /* Lake Shore Model 737 VSM Controller */
	{ USB_DEVICE(0x1FB9, 0x0701) }, /* Lake Shore Model 776 Hall Matrix */
179
	{ USB_DEVICE(0x3195, 0xF190) }, /* Link Instruments MSO-19 */
Craig Shelley's avatar
Craig Shelley committed
180
181
	{ USB_DEVICE(0x3195, 0xF280) }, /* Link Instruments MSO-28 */
	{ USB_DEVICE(0x3195, 0xF281) }, /* Link Instruments MSO-28 */
Craig Shelley's avatar
Craig Shelley committed
182
	{ USB_DEVICE(0x413C, 0x9500) }, /* DW700 GPS USB interface */
183
	{ } /* Terminating Entry */
Linus Torvalds's avatar
Linus Torvalds committed
184
185
};

Alan Cox's avatar
Alan Cox committed
186
MODULE_DEVICE_TABLE(usb, id_table);
Linus Torvalds's avatar
Linus Torvalds committed
187

188
struct cp210x_serial_private {
189
190
191
	__u8			bInterfaceNumber;
};

192
static struct usb_serial_driver cp210x_device = {
193
194
	.driver = {
		.owner =	THIS_MODULE,
195
		.name =		"cp210x",
196
	},
Linus Torvalds's avatar
Linus Torvalds committed
197
198
	.id_table		= id_table,
	.num_ports		= 1,
199
	.bulk_in_size		= 256,
200
	.bulk_out_size		= 256,
201
202
203
204
	.open			= cp210x_open,
	.close			= cp210x_close,
	.break_ctl		= cp210x_break_ctl,
	.set_termios		= cp210x_set_termios,
205
	.tiocmget		= cp210x_tiocmget,
206
207
	.tiocmset		= cp210x_tiocmset,
	.attach			= cp210x_startup,
208
	.release		= cp210x_release,
209
	.dtr_rts		= cp210x_dtr_rts
Linus Torvalds's avatar
Linus Torvalds committed
210
211
};

212
213
214
215
static struct usb_serial_driver * const serial_drivers[] = {
	&cp210x_device, NULL
};

216
/* Config request types */
217
218
219
220
#define REQTYPE_HOST_TO_INTERFACE	0x41
#define REQTYPE_INTERFACE_TO_HOST	0xc1
#define REQTYPE_HOST_TO_DEVICE	0x40
#define REQTYPE_DEVICE_TO_HOST	0xc0
Linus Torvalds's avatar
Linus Torvalds committed
221

222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
/* Config request codes */
#define CP210X_IFC_ENABLE	0x00
#define CP210X_SET_BAUDDIV	0x01
#define CP210X_GET_BAUDDIV	0x02
#define CP210X_SET_LINE_CTL	0x03
#define CP210X_GET_LINE_CTL	0x04
#define CP210X_SET_BREAK	0x05
#define CP210X_IMM_CHAR		0x06
#define CP210X_SET_MHS		0x07
#define CP210X_GET_MDMSTS	0x08
#define CP210X_SET_XON		0x09
#define CP210X_SET_XOFF		0x0A
#define CP210X_SET_EVENTMASK	0x0B
#define CP210X_GET_EVENTMASK	0x0C
#define CP210X_SET_CHAR		0x0D
#define CP210X_GET_CHARS	0x0E
#define CP210X_GET_PROPS	0x0F
#define CP210X_GET_COMM_STATUS	0x10
#define CP210X_RESET		0x11
#define CP210X_PURGE		0x12
#define CP210X_SET_FLOW		0x13
#define CP210X_GET_FLOW		0x14
#define CP210X_EMBED_EVENTS	0x15
#define CP210X_GET_EVENTSTATE	0x16
#define CP210X_SET_CHARS	0x19
247
248
#define CP210X_GET_BAUDRATE	0x1D
#define CP210X_SET_BAUDRATE	0x1E
249
250

/* CP210X_IFC_ENABLE */
Linus Torvalds's avatar
Linus Torvalds committed
251
252
253
#define UART_ENABLE		0x0001
#define UART_DISABLE		0x0000

254
/* CP210X_(SET|GET)_BAUDDIV */
Linus Torvalds's avatar
Linus Torvalds committed
255
256
#define BAUD_RATE_GEN_FREQ	0x384000

257
/* CP210X_(SET|GET)_LINE_CTL */
Linus Torvalds's avatar
Linus Torvalds committed
258
#define BITS_DATA_MASK		0X0f00
259
#define BITS_DATA_5		0X0500
Linus Torvalds's avatar
Linus Torvalds committed
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
#define BITS_DATA_6		0X0600
#define BITS_DATA_7		0X0700
#define BITS_DATA_8		0X0800
#define BITS_DATA_9		0X0900

#define BITS_PARITY_MASK	0x00f0
#define BITS_PARITY_NONE	0x0000
#define BITS_PARITY_ODD		0x0010
#define BITS_PARITY_EVEN	0x0020
#define BITS_PARITY_MARK	0x0030
#define BITS_PARITY_SPACE	0x0040

#define BITS_STOP_MASK		0x000f
#define BITS_STOP_1		0x0000
#define BITS_STOP_1_5		0x0001
#define BITS_STOP_2		0x0002
276

277
/* CP210X_SET_BREAK */
Craig Shelley's avatar
Craig Shelley committed
278
279
#define BREAK_ON		0x0001
#define BREAK_OFF		0x0000
Linus Torvalds's avatar
Linus Torvalds committed
280

281
/* CP210X_(SET_MHS|GET_MDMSTS) */
282
283
284
285
286
287
288
289
#define CONTROL_DTR		0x0001
#define CONTROL_RTS		0x0002
#define CONTROL_CTS		0x0010
#define CONTROL_DSR		0x0020
#define CONTROL_RING		0x0040
#define CONTROL_DCD		0x0080
#define CONTROL_WRITE_DTR	0x0100
#define CONTROL_WRITE_RTS	0x0200
Linus Torvalds's avatar
Linus Torvalds committed
290

291
/*
292
293
 * cp210x_get_config
 * Reads from the CP210x configuration registers
294
295
296
297
 * 'size' is specified in bytes.
 * 'data' is a pointer to a pre-allocated array of integers large
 * enough to hold 'size' bytes (with 4 bytes to each integer)
 */
298
static int cp210x_get_config(struct usb_serial_port *port, u8 request,
299
		unsigned int *data, int size)
Linus Torvalds's avatar
Linus Torvalds committed
300
301
{
	struct usb_serial *serial = port->serial;
302
	struct cp210x_serial_private *spriv = usb_get_serial_data(serial);
303
	__le32 *buf;
304
305
306
	int result, i, length;

	/* Number of integers required to contain the array */
307
	length = (((size - 1) | 3) + 1) / 4;
308

309
	buf = kcalloc(length, sizeof(__le32), GFP_KERNEL);
310
	if (!buf)
311
		return -ENOMEM;
Linus Torvalds's avatar
Linus Torvalds committed
312

313
	/* Issue the request, attempting to read 'size' bytes */
Alan Cox's avatar
Alan Cox committed
314
	result = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
315
				request, REQTYPE_INTERFACE_TO_HOST, 0x0000,
316
				spriv->bInterfaceNumber, buf, size,
317
				USB_CTRL_GET_TIMEOUT);
Linus Torvalds's avatar
Linus Torvalds committed
318

319
	/* Convert data into an array of integers */
Alan Cox's avatar
Alan Cox committed
320
	for (i = 0; i < length; i++)
321
		data[i] = le32_to_cpu(buf[i]);
Linus Torvalds's avatar
Linus Torvalds committed
322

323
	kfree(buf);
Linus Torvalds's avatar
Linus Torvalds committed
324

325
	if (result != size) {
326
327
		dev_dbg(&port->dev, "%s - Unable to send config request, request=0x%x size=%d result=%d\n",
			__func__, request, size, result);
328
329
330
331
		if (result > 0)
			result = -EPROTO;

		return result;
332
	}
Linus Torvalds's avatar
Linus Torvalds committed
333

334
	return 0;
Linus Torvalds's avatar
Linus Torvalds committed
335
336
}

337
/*
338
339
 * cp210x_set_config
 * Writes to the CP210x configuration registers
340
341
342
 * Values less than 16 bits wide are sent directly
 * 'size' is specified in bytes.
 */
343
static int cp210x_set_config(struct usb_serial_port *port, u8 request,
344
		unsigned int *data, int size)
Linus Torvalds's avatar
Linus Torvalds committed
345
346
{
	struct usb_serial *serial = port->serial;
347
	struct cp210x_serial_private *spriv = usb_get_serial_data(serial);
348
	__le32 *buf;
349
	int result, i, length;
Linus Torvalds's avatar
Linus Torvalds committed
350

351
	/* Number of integers required to contain the array */
352
	length = (((size - 1) | 3) + 1) / 4;
353

354
	buf = kmalloc(length * sizeof(__le32), GFP_KERNEL);
355
	if (!buf)
356
357
358
359
360
361
362
		return -ENOMEM;

	/* Array of integers into bytes */
	for (i = 0; i < length; i++)
		buf[i] = cpu_to_le32(data[i]);

	if (size > 2) {
Alan Cox's avatar
Alan Cox committed
363
		result = usb_control_msg(serial->dev,
364
				usb_sndctrlpipe(serial->dev, 0),
365
				request, REQTYPE_HOST_TO_INTERFACE, 0x0000,
366
				spriv->bInterfaceNumber, buf, size,
367
				USB_CTRL_SET_TIMEOUT);
368
	} else {
Alan Cox's avatar
Alan Cox committed
369
		result = usb_control_msg(serial->dev,
370
				usb_sndctrlpipe(serial->dev, 0),
371
				request, REQTYPE_HOST_TO_INTERFACE, data[0],
372
				spriv->bInterfaceNumber, NULL, 0,
373
				USB_CTRL_SET_TIMEOUT);
Linus Torvalds's avatar
Linus Torvalds committed
374
375
	}

376
377
378
	kfree(buf);

	if ((size > 2 && result != size) || result < 0) {
379
380
		dev_dbg(&port->dev, "%s - Unable to send request, request=0x%x size=%d result=%d\n",
			__func__, request, size, result);
381
382
383
384
		if (result > 0)
			result = -EPROTO;

		return result;
385
	}
Linus Torvalds's avatar
Linus Torvalds committed
386
387
388
389

	return 0;
}

390
/*
391
392
 * cp210x_set_config_single
 * Convenience function for calling cp210x_set_config on single data values
393
394
 * without requiring an integer pointer
 */
395
static inline int cp210x_set_config_single(struct usb_serial_port *port,
396
397
		u8 request, unsigned int data)
{
398
	return cp210x_set_config(port, request, &data, 2);
399
400
}

401
/*
402
 * cp210x_quantise_baudrate
403
404
 * Quantises the baud rate as per AN205 Table 1
 */
405
406
static unsigned int cp210x_quantise_baudrate(unsigned int baud)
{
407
408
	if (baud <= 300)
		baud = 300;
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
	else if (baud <= 600)      baud = 600;
	else if (baud <= 1200)     baud = 1200;
	else if (baud <= 1800)     baud = 1800;
	else if (baud <= 2400)     baud = 2400;
	else if (baud <= 4000)     baud = 4000;
	else if (baud <= 4803)     baud = 4800;
	else if (baud <= 7207)     baud = 7200;
	else if (baud <= 9612)     baud = 9600;
	else if (baud <= 14428)    baud = 14400;
	else if (baud <= 16062)    baud = 16000;
	else if (baud <= 19250)    baud = 19200;
	else if (baud <= 28912)    baud = 28800;
	else if (baud <= 38601)    baud = 38400;
	else if (baud <= 51558)    baud = 51200;
	else if (baud <= 56280)    baud = 56000;
	else if (baud <= 58053)    baud = 57600;
	else if (baud <= 64111)    baud = 64000;
	else if (baud <= 77608)    baud = 76800;
	else if (baud <= 117028)   baud = 115200;
	else if (baud <= 129347)   baud = 128000;
	else if (baud <= 156868)   baud = 153600;
	else if (baud <= 237832)   baud = 230400;
	else if (baud <= 254234)   baud = 250000;
	else if (baud <= 273066)   baud = 256000;
	else if (baud <= 491520)   baud = 460800;
	else if (baud <= 567138)   baud = 500000;
	else if (baud <= 670254)   baud = 576000;
436
437
438
439
	else if (baud < 1000000)
		baud = 921600;
	else if (baud > 2000000)
		baud = 2000000;
440
441
442
	return baud;
}

443
static int cp210x_open(struct tty_struct *tty, struct usb_serial_port *port)
Linus Torvalds's avatar
Linus Torvalds committed
444
445
446
{
	int result;

447
448
449
450
451
	result = cp210x_set_config_single(port, CP210X_IFC_ENABLE,
								UART_ENABLE);
	if (result) {
		dev_err(&port->dev, "%s - Unable to enable UART\n", __func__);
		return result;
Linus Torvalds's avatar
Linus Torvalds committed
452
453
	}

454
	/* Configure the termios structure */
455
	cp210x_get_termios(tty, port);
456

457
458
459
460
	/* The baud rate must be initialised on cp2104 */
	if (tty)
		cp210x_change_speed(tty, port, NULL);

461
	return usb_serial_generic_open(tty, port);
Linus Torvalds's avatar
Linus Torvalds committed
462
463
}

464
static void cp210x_close(struct usb_serial_port *port)
Linus Torvalds's avatar
Linus Torvalds committed
465
{
466
	usb_serial_generic_close(port);
467
	cp210x_set_config_single(port, CP210X_IFC_ENABLE, UART_DISABLE);
Linus Torvalds's avatar
Linus Torvalds committed
468
469
}

470
/*
471
 * cp210x_get_termios
472
473
474
475
 * Reads the baud rate, data bits, parity, stop bits and flow control mode
 * from the device, corrects any unsupported values, and configures the
 * termios structure to reflect the state of the device
 */
476
static void cp210x_get_termios(struct tty_struct *tty,
477
478
479
480
481
	struct usb_serial_port *port)
{
	unsigned int baud;

	if (tty) {
482
		cp210x_get_termios_port(tty->driver_data,
483
			&tty->termios.c_cflag, &baud);
484
		tty_encode_baud_rate(tty, baud, baud);
485
	} else {
486
487
		unsigned int cflag;
		cflag = 0;
488
		cp210x_get_termios_port(port, &cflag, &baud);
489
490
491
492
	}
}

/*
493
494
 * cp210x_get_termios_port
 * This is the heart of cp210x_get_termios which always uses a &usb_serial_port.
495
 */
496
static void cp210x_get_termios_port(struct usb_serial_port *port,
497
	unsigned int *cflagp, unsigned int *baudp)
Linus Torvalds's avatar
Linus Torvalds committed
498
{
499
	struct device *dev = &port->dev;
500
	unsigned int cflag, modem_ctl[4];
501
502
	unsigned int baud;
	unsigned int bits;
Linus Torvalds's avatar
Linus Torvalds committed
503

504
	cp210x_get_config(port, CP210X_GET_BAUDRATE, &baud, 4);
Linus Torvalds's avatar
Linus Torvalds committed
505

506
	dev_dbg(dev, "%s - baud rate = %d\n", __func__, baud);
507
	*baudp = baud;
Alan Cox's avatar
Alan Cox committed
508

509
	cflag = *cflagp;
Linus Torvalds's avatar
Linus Torvalds committed
510

511
	cp210x_get_config(port, CP210X_GET_LINE_CTL, &bits, 2);
Linus Torvalds's avatar
Linus Torvalds committed
512
	cflag &= ~CSIZE;
Alan Cox's avatar
Alan Cox committed
513
514
	switch (bits & BITS_DATA_MASK) {
	case BITS_DATA_5:
515
		dev_dbg(dev, "%s - data bits = 5\n", __func__);
Alan Cox's avatar
Alan Cox committed
516
517
518
		cflag |= CS5;
		break;
	case BITS_DATA_6:
519
		dev_dbg(dev, "%s - data bits = 6\n", __func__);
Alan Cox's avatar
Alan Cox committed
520
521
522
		cflag |= CS6;
		break;
	case BITS_DATA_7:
523
		dev_dbg(dev, "%s - data bits = 7\n", __func__);
Alan Cox's avatar
Alan Cox committed
524
525
526
		cflag |= CS7;
		break;
	case BITS_DATA_8:
527
		dev_dbg(dev, "%s - data bits = 8\n", __func__);
Alan Cox's avatar
Alan Cox committed
528
529
530
		cflag |= CS8;
		break;
	case BITS_DATA_9:
531
		dev_dbg(dev, "%s - data bits = 9 (not supported, using 8 data bits)\n", __func__);
Alan Cox's avatar
Alan Cox committed
532
533
534
		cflag |= CS8;
		bits &= ~BITS_DATA_MASK;
		bits |= BITS_DATA_8;
535
		cp210x_set_config(port, CP210X_SET_LINE_CTL, &bits, 2);
Alan Cox's avatar
Alan Cox committed
536
537
		break;
	default:
538
		dev_dbg(dev, "%s - Unknown number of data bits, using 8\n", __func__);
Alan Cox's avatar
Alan Cox committed
539
540
541
		cflag |= CS8;
		bits &= ~BITS_DATA_MASK;
		bits |= BITS_DATA_8;
542
		cp210x_set_config(port, CP210X_SET_LINE_CTL, &bits, 2);
Alan Cox's avatar
Alan Cox committed
543
		break;
Linus Torvalds's avatar
Linus Torvalds committed
544
545
	}

Alan Cox's avatar
Alan Cox committed
546
547
	switch (bits & BITS_PARITY_MASK) {
	case BITS_PARITY_NONE:
548
		dev_dbg(dev, "%s - parity = NONE\n", __func__);
Alan Cox's avatar
Alan Cox committed
549
550
551
		cflag &= ~PARENB;
		break;
	case BITS_PARITY_ODD:
552
		dev_dbg(dev, "%s - parity = ODD\n", __func__);
Alan Cox's avatar
Alan Cox committed
553
554
555
		cflag |= (PARENB|PARODD);
		break;
	case BITS_PARITY_EVEN:
556
		dev_dbg(dev, "%s - parity = EVEN\n", __func__);
Alan Cox's avatar
Alan Cox committed
557
558
559
560
		cflag &= ~PARODD;
		cflag |= PARENB;
		break;
	case BITS_PARITY_MARK:
561
		dev_dbg(dev, "%s - parity = MARK\n", __func__);
562
		cflag |= (PARENB|PARODD|CMSPAR);
Alan Cox's avatar
Alan Cox committed
563
564
		break;
	case BITS_PARITY_SPACE:
565
		dev_dbg(dev, "%s - parity = SPACE\n", __func__);
566
567
		cflag &= ~PARODD;
		cflag |= (PARENB|CMSPAR);
Alan Cox's avatar
Alan Cox committed
568
569
		break;
	default:
570
		dev_dbg(dev, "%s - Unknown parity mode, disabling parity\n", __func__);
Alan Cox's avatar
Alan Cox committed
571
572
		cflag &= ~PARENB;
		bits &= ~BITS_PARITY_MASK;
573
		cp210x_set_config(port, CP210X_SET_LINE_CTL, &bits, 2);
Alan Cox's avatar
Alan Cox committed
574
		break;
Linus Torvalds's avatar
Linus Torvalds committed
575
576
577
	}

	cflag &= ~CSTOPB;
Alan Cox's avatar
Alan Cox committed
578
579
	switch (bits & BITS_STOP_MASK) {
	case BITS_STOP_1:
580
		dev_dbg(dev, "%s - stop bits = 1\n", __func__);
Alan Cox's avatar
Alan Cox committed
581
582
		break;
	case BITS_STOP_1_5:
583
		dev_dbg(dev, "%s - stop bits = 1.5 (not supported, using 1 stop bit)\n", __func__);
Alan Cox's avatar
Alan Cox committed
584
		bits &= ~BITS_STOP_MASK;
585
		cp210x_set_config(port, CP210X_SET_LINE_CTL, &bits, 2);
Alan Cox's avatar
Alan Cox committed
586
587
		break;
	case BITS_STOP_2:
588
		dev_dbg(dev, "%s - stop bits = 2\n", __func__);
Alan Cox's avatar
Alan Cox committed
589
590
591
		cflag |= CSTOPB;
		break;
	default:
592
		dev_dbg(dev, "%s - Unknown number of stop bits, using 1 stop bit\n", __func__);
Alan Cox's avatar
Alan Cox committed
593
		bits &= ~BITS_STOP_MASK;
594
		cp210x_set_config(port, CP210X_SET_LINE_CTL, &bits, 2);
Alan Cox's avatar
Alan Cox committed
595
		break;
Linus Torvalds's avatar
Linus Torvalds committed
596
597
	}

598
	cp210x_get_config(port, CP210X_GET_FLOW, modem_ctl, 16);
599
	if (modem_ctl[0] & 0x0008) {
600
		dev_dbg(dev, "%s - flow control = CRTSCTS\n", __func__);
601
602
		cflag |= CRTSCTS;
	} else {
603
		dev_dbg(dev, "%s - flow control = NONE\n", __func__);
604
605
606
		cflag &= ~CRTSCTS;
	}

607
	*cflagp = cflag;
Linus Torvalds's avatar
Linus Torvalds committed
608
609
}

610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
/*
 * CP2101 supports the following baud rates:
 *
 *	300, 600, 1200, 1800, 2400, 4800, 7200, 9600, 14400, 19200, 28800,
 *	38400, 56000, 57600, 115200, 128000, 230400, 460800, 921600
 *
 * CP2102 and CP2103 support the following additional rates:
 *
 *	4000, 16000, 51200, 64000, 76800, 153600, 250000, 256000, 500000,
 *	576000
 *
 * The device will map a requested rate to a supported one, but the result
 * of requests for rates greater than 1053257 is undefined (see AN205).
 *
 * CP2104, CP2105 and CP2110 support most rates up to 2M, 921k and 1M baud,
 * respectively, with an error less than 1%. The actual rates are determined
 * by
 *
 *	div = round(freq / (2 x prescale x request))
 *	actual = freq / (2 x prescale x div)
 *
 * For CP2104 and CP2105 freq is 48Mhz and prescale is 4 for request <= 365bps
 * or 1 otherwise.
 * For CP2110 freq is 24Mhz and prescale is 4 for request <= 300bps or 1
 * otherwise.
 */
static void cp210x_change_speed(struct tty_struct *tty,
		struct usb_serial_port *port, struct ktermios *old_termios)
{
	u32 baud;

641
	baud = tty->termios.c_ospeed;
642

643
644
	/* This maps the requested rate to a rate valid on cp2102 or cp2103,
	 * or to an arbitrary rate in [1M,2M].
645
646
647
648
649
	 *
	 * NOTE: B0 is not implemented.
	 */
	baud = cp210x_quantise_baudrate(baud);

650
	dev_dbg(&port->dev, "%s - setting baud rate to %u\n", __func__, baud);
651
652
653
654
655
656
657
658
659
660
661
662
	if (cp210x_set_config(port, CP210X_SET_BAUDRATE, &baud,
							sizeof(baud))) {
		dev_warn(&port->dev, "failed to set baud rate to %u\n", baud);
		if (old_termios)
			baud = old_termios->c_ospeed;
		else
			baud = 9600;
	}

	tty_encode_baud_rate(tty, baud, baud);
}

663
static void cp210x_set_termios(struct tty_struct *tty,
Alan Cox's avatar
Alan Cox committed
664
		struct usb_serial_port *port, struct ktermios *old_termios)
Linus Torvalds's avatar
Linus Torvalds committed
665
{
666
	struct device *dev = &port->dev;
Alan Cox's avatar
Alan Cox committed
667
	unsigned int cflag, old_cflag;
668
	unsigned int bits;
669
	unsigned int modem_ctl[4];
Linus Torvalds's avatar
Linus Torvalds committed
670

671
	cflag = tty->termios.c_cflag;
672
	old_cflag = old_termios->c_cflag;
673

674
	if (tty->termios.c_ospeed != old_termios->c_ospeed)
675
		cp210x_change_speed(tty, port, old_termios);
Linus Torvalds's avatar
Linus Torvalds committed
676

677
	/* If the number of data bits is to be updated */
Linus Torvalds's avatar
Linus Torvalds committed
678
	if ((cflag & CSIZE) != (old_cflag & CSIZE)) {
679
		cp210x_get_config(port, CP210X_GET_LINE_CTL, &bits, 2);
Linus Torvalds's avatar
Linus Torvalds committed
680
681
		bits &= ~BITS_DATA_MASK;
		switch (cflag & CSIZE) {
Alan Cox's avatar
Alan Cox committed
682
683
		case CS5:
			bits |= BITS_DATA_5;
684
			dev_dbg(dev, "%s - data bits = 5\n", __func__);
Alan Cox's avatar
Alan Cox committed
685
686
687
			break;
		case CS6:
			bits |= BITS_DATA_6;
688
			dev_dbg(dev, "%s - data bits = 6\n", __func__);
Alan Cox's avatar
Alan Cox committed
689
690
691
			break;
		case CS7:
			bits |= BITS_DATA_7;
692
			dev_dbg(dev, "%s - data bits = 7\n", __func__);
Alan Cox's avatar
Alan Cox committed
693
694
695
			break;
		case CS8:
			bits |= BITS_DATA_8;
696
			dev_dbg(dev, "%s - data bits = 8\n", __func__);
Alan Cox's avatar
Alan Cox committed
697
698
699
			break;
		/*case CS9:
			bits |= BITS_DATA_9;
700
			dev_dbg(dev, "%s - data bits = 9\n", __func__);
Alan Cox's avatar
Alan Cox committed
701
702
			break;*/
		default:
703
			dev_dbg(dev, "cp210x driver does not support the number of bits requested, using 8 bit mode\n");
704
705
			bits |= BITS_DATA_8;
			break;
Linus Torvalds's avatar
Linus Torvalds committed
706
		}
707
		if (cp210x_set_config(port, CP210X_SET_LINE_CTL, &bits, 2))
708
			dev_dbg(dev, "Number of data bits requested not supported by device\n");
Linus Torvalds's avatar
Linus Torvalds committed
709
710
	}

711
712
	if ((cflag     & (PARENB|PARODD|CMSPAR)) !=
	    (old_cflag & (PARENB|PARODD|CMSPAR))) {
713
		cp210x_get_config(port, CP210X_GET_LINE_CTL, &bits, 2);
Linus Torvalds's avatar
Linus Torvalds committed
714
715
		bits &= ~BITS_PARITY_MASK;
		if (cflag & PARENB) {
716
			if (cflag & CMSPAR) {
717
718
719
720
721
722
723
				if (cflag & PARODD) {
					bits |= BITS_PARITY_MARK;
					dev_dbg(dev, "%s - parity = MARK\n", __func__);
				} else {
					bits |= BITS_PARITY_SPACE;
					dev_dbg(dev, "%s - parity = SPACE\n", __func__);
				}
Linus Torvalds's avatar
Linus Torvalds committed
724
			} else {
725
726
727
728
729
730
731
				if (cflag & PARODD) {
					bits |= BITS_PARITY_ODD;
					dev_dbg(dev, "%s - parity = ODD\n", __func__);
				} else {
					bits |= BITS_PARITY_EVEN;
					dev_dbg(dev, "%s - parity = EVEN\n", __func__);
				}
Linus Torvalds's avatar
Linus Torvalds committed
732
733
			}
		}
734
		if (cp210x_set_config(port, CP210X_SET_LINE_CTL, &bits, 2))
735
			dev_dbg(dev, "Parity mode not supported by device\n");
Linus Torvalds's avatar
Linus Torvalds committed
736
737
738
	}

	if ((cflag & CSTOPB) != (old_cflag & CSTOPB)) {
739
		cp210x_get_config(port, CP210X_GET_LINE_CTL, &bits, 2);
Linus Torvalds's avatar
Linus Torvalds committed
740
741
742
		bits &= ~BITS_STOP_MASK;
		if (cflag & CSTOPB) {
			bits |= BITS_STOP_2;
743
			dev_dbg(dev, "%s - stop bits = 2\n", __func__);
Linus Torvalds's avatar
Linus Torvalds committed
744
745
		} else {
			bits |= BITS_STOP_1;
746
			dev_dbg(dev, "%s - stop bits = 1\n", __func__);
Linus Torvalds's avatar
Linus Torvalds committed
747
		}
748
		if (cp210x_set_config(port, CP210X_SET_LINE_CTL, &bits, 2))
749
			dev_dbg(dev, "Number of stop bits requested not supported by device\n");
Linus Torvalds's avatar
Linus Torvalds committed
750
	}
751
752

	if ((cflag & CRTSCTS) != (old_cflag & CRTSCTS)) {
753
		cp210x_get_config(port, CP210X_GET_FLOW, modem_ctl, 16);
754
755
756
		dev_dbg(dev, "%s - read modem controls = 0x%.4x 0x%.4x 0x%.4x 0x%.4x\n",
			__func__, modem_ctl[0], modem_ctl[1],
			modem_ctl[2], modem_ctl[3]);
757
758
759
760
761

		if (cflag & CRTSCTS) {
			modem_ctl[0] &= ~0x7B;
			modem_ctl[0] |= 0x09;
			modem_ctl[1] = 0x80;
762
			dev_dbg(dev, "%s - flow control = CRTSCTS\n", __func__);
763
764
765
766
		} else {
			modem_ctl[0] &= ~0x7B;
			modem_ctl[0] |= 0x01;
			modem_ctl[1] |= 0x40;
767
			dev_dbg(dev, "%s - flow control = NONE\n", __func__);
768
769
		}

770
771
772
		dev_dbg(dev, "%s - write modem controls = 0x%.4x 0x%.4x 0x%.4x 0x%.4x\n",
			__func__, modem_ctl[0], modem_ctl[1],
			modem_ctl[2], modem_ctl[3]);
773
		cp210x_set_config(port, CP210X_SET_FLOW, modem_ctl, 16);
774
775
776
777
	}

}

778
static int cp210x_tiocmset(struct tty_struct *tty,
779
780
		unsigned int set, unsigned int clear)
{
Alan Cox's avatar
Alan Cox committed
781
	struct usb_serial_port *port = tty->driver_data;
782
	return cp210x_tiocmset_port(port, set, clear);
783
784
}

785
static int cp210x_tiocmset_port(struct usb_serial_port *port,
786
787
		unsigned int set, unsigned int clear)
{
788
	unsigned int control = 0;
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806

	if (set & TIOCM_RTS) {
		control |= CONTROL_RTS;
		control |= CONTROL_WRITE_RTS;
	}
	if (set & TIOCM_DTR) {
		control |= CONTROL_DTR;
		control |= CONTROL_WRITE_DTR;
	}
	if (clear & TIOCM_RTS) {
		control &= ~CONTROL_RTS;
		control |= CONTROL_WRITE_RTS;
	}
	if (clear & TIOCM_DTR) {
		control &= ~CONTROL_DTR;
		control |= CONTROL_WRITE_DTR;
	}

807
	dev_dbg(&port->dev, "%s - control = 0x%.4x\n", __func__, control);
808

809
	return cp210x_set_config(port, CP210X_SET_MHS, &control, 2);
810
811
}

Alan Cox's avatar
Alan Cox committed
812
813
814
static void cp210x_dtr_rts(struct usb_serial_port *p, int on)
{
	if (on)
815
		cp210x_tiocmset_port(p, TIOCM_DTR|TIOCM_RTS, 0);
Alan Cox's avatar
Alan Cox committed
816
	else
817
		cp210x_tiocmset_port(p, 0, TIOCM_DTR|TIOCM_RTS);
Alan Cox's avatar
Alan Cox committed
818
819
}

820
static int cp210x_tiocmget(struct tty_struct *tty)
821
{
Alan Cox's avatar
Alan Cox committed
822
	struct usb_serial_port *port = tty->driver_data;
823
824
	unsigned int control;
	int result;
825

826
	cp210x_get_config(port, CP210X_GET_MDMSTS, &control, 1);
827
828
829
830
831
832
833
834

	result = ((control & CONTROL_DTR) ? TIOCM_DTR : 0)
		|((control & CONTROL_RTS) ? TIOCM_RTS : 0)
		|((control & CONTROL_CTS) ? TIOCM_CTS : 0)
		|((control & CONTROL_DSR) ? TIOCM_DSR : 0)
		|((control & CONTROL_RING)? TIOCM_RI  : 0)
		|((control & CONTROL_DCD) ? TIOCM_CD  : 0);

835
	dev_dbg(&port->dev, "%s - control = 0x%.2x\n", __func__, control);
836
837

	return result;
Linus Torvalds's avatar
Linus Torvalds committed
838
839
}

840
static void cp210x_break_ctl(struct tty_struct *tty, int break_state)
Linus Torvalds's avatar
Linus Torvalds committed
841
{
Alan Cox's avatar
Alan Cox committed
842
	struct usb_serial_port *port = tty->driver_data;
843
	unsigned int state;
Linus Torvalds's avatar
Linus Torvalds committed
844
845
846
847
848

	if (break_state == 0)
		state = BREAK_OFF;
	else
		state = BREAK_ON;
849
850
	dev_dbg(&port->dev, "%s - turning break %s\n", __func__,
		state == BREAK_OFF ? "off" : "on");
851
	cp210x_set_config(port, CP210X_SET_BREAK, &state, 2);
Linus Torvalds's avatar
Linus Torvalds committed
852
853
}

854
static int cp210x_startup(struct usb_serial *serial)
Linus Torvalds's avatar
Linus Torvalds committed
855
{
856
857
	struct usb_host_interface *cur_altsetting;
	struct cp210x_serial_private *spriv;
858

859
860
861
	spriv = kzalloc(sizeof(*spriv), GFP_KERNEL);
	if (!spriv)
		return -ENOMEM;
862

863
864
	cur_altsetting = serial->interface->cur_altsetting;
	spriv->bInterfaceNumber = cur_altsetting->desc.bInterfaceNumber;
865

866
	usb_set_serial_data(serial, spriv);
867

Linus Torvalds's avatar
Linus Torvalds committed
868
869
870
	return 0;
}

871
872
static void cp210x_release(struct usb_serial *serial)
{
873
	struct cp210x_serial_private *spriv;
874

875
876
	spriv = usb_get_serial_data(serial);
	kfree(spriv);
877
878
}

879
module_usb_serial_driver(serial_drivers, id_table);
Linus Torvalds's avatar
Linus Torvalds committed
880
881
882

MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");