blob: 3f84dd8f1757d8b645af7bf6b3088b7ce084d320 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* $Id: elsa_ser.c,v 2.14.2.3 2004/02/11 13:21:33 keil Exp $
2 *
3 * stuff for the serial modem on ELSA cards
4 *
5 * This software may be used and distributed according to the terms
6 * of the GNU General Public License, incorporated herein by reference.
7 *
8 */
9
Linus Torvalds1da177e2005-04-16 15:20:36 -070010#include <linux/serial.h>
11#include <linux/serial_reg.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090012#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070013
14#define MAX_MODEM_BUF 256
Joe Perches475be4d2012-02-19 19:52:38 -080015#define WAKEUP_CHARS (MAX_MODEM_BUF / 2)
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#define RS_ISR_PASS_LIMIT 256
Joe Perches475be4d2012-02-19 19:52:38 -080017#define BASE_BAUD (1843200 / 16)
Linus Torvalds1da177e2005-04-16 15:20:36 -070018
19//#define SERIAL_DEBUG_OPEN 1
20//#define SERIAL_DEBUG_INTR 1
21//#define SERIAL_DEBUG_FLOW 1
22#undef SERIAL_DEBUG_OPEN
23#undef SERIAL_DEBUG_INTR
24#undef SERIAL_DEBUG_FLOW
25#undef SERIAL_DEBUG_REG
26//#define SERIAL_DEBUG_REG 1
27
28#ifdef SERIAL_DEBUG_REG
29static u_char deb[32];
Joe Perches475be4d2012-02-19 19:52:38 -080030const char *ModemIn[] = {"RBR", "IER", "IIR", "LCR", "MCR", "LSR", "MSR", "SCR"};
31const char *ModemOut[] = {"THR", "IER", "FCR", "LCR", "MCR", "LSR", "MSR", "SCR"};
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#endif
33
34static char *MInit_1 = "AT&F&C1E0&D2\r\0";
35static char *MInit_2 = "ATL2M1S64=13\r\0";
36static char *MInit_3 = "AT+FCLASS=0\r\0";
37static char *MInit_4 = "ATV1S2=128X1\r\0";
38static char *MInit_5 = "AT\\V8\\N3\r\0";
39static char *MInit_6 = "ATL0M0&G0%E1\r\0";
40static char *MInit_7 = "AT%L1%M0%C3\r\0";
41
42static char *MInit_speed28800 = "AT%G0%B28800\r\0";
43
44static char *MInit_dialout = "ATs7=60 x1 d\r\0";
45static char *MInit_dialin = "ATs7=60 x1 a\r\0";
46
47
48static inline unsigned int serial_in(struct IsdnCardState *cs, int offset)
49{
50#ifdef SERIAL_DEBUG_REG
51 u_int val = inb(cs->hw.elsa.base + 8 + offset);
Joe Perches475be4d2012-02-19 19:52:38 -080052 debugl1(cs, "in %s %02x", ModemIn[offset], val);
53 return (val);
Linus Torvalds1da177e2005-04-16 15:20:36 -070054#else
55 return inb(cs->hw.elsa.base + 8 + offset);
56#endif
57}
58
59static inline unsigned int serial_inp(struct IsdnCardState *cs, int offset)
60{
61#ifdef SERIAL_DEBUG_REG
Robert P. J. Daye3c07b92007-02-12 00:53:21 -080062#ifdef ELSA_SERIAL_NOPAUSE_IO
Linus Torvalds1da177e2005-04-16 15:20:36 -070063 u_int val = inb(cs->hw.elsa.base + 8 + offset);
Joe Perches475be4d2012-02-19 19:52:38 -080064 debugl1(cs, "inp %s %02x", ModemIn[offset], val);
Linus Torvalds1da177e2005-04-16 15:20:36 -070065#else
66 u_int val = inb_p(cs->hw.elsa.base + 8 + offset);
Joe Perches475be4d2012-02-19 19:52:38 -080067 debugl1(cs, "inP %s %02x", ModemIn[offset], val);
Linus Torvalds1da177e2005-04-16 15:20:36 -070068#endif
Joe Perches475be4d2012-02-19 19:52:38 -080069 return (val);
Linus Torvalds1da177e2005-04-16 15:20:36 -070070#else
Robert P. J. Daye3c07b92007-02-12 00:53:21 -080071#ifdef ELSA_SERIAL_NOPAUSE_IO
Linus Torvalds1da177e2005-04-16 15:20:36 -070072 return inb(cs->hw.elsa.base + 8 + offset);
73#else
74 return inb_p(cs->hw.elsa.base + 8 + offset);
75#endif
76#endif
77}
78
79static inline void serial_out(struct IsdnCardState *cs, int offset, int value)
80{
81#ifdef SERIAL_DEBUG_REG
Joe Perches475be4d2012-02-19 19:52:38 -080082 debugl1(cs, "out %s %02x", ModemOut[offset], value);
Linus Torvalds1da177e2005-04-16 15:20:36 -070083#endif
84 outb(value, cs->hw.elsa.base + 8 + offset);
85}
86
87static inline void serial_outp(struct IsdnCardState *cs, int offset,
88 int value)
89{
90#ifdef SERIAL_DEBUG_REG
Robert P. J. Daye3c07b92007-02-12 00:53:21 -080091#ifdef ELSA_SERIAL_NOPAUSE_IO
Joe Perches475be4d2012-02-19 19:52:38 -080092 debugl1(cs, "outp %s %02x", ModemOut[offset], value);
Linus Torvalds1da177e2005-04-16 15:20:36 -070093#else
Joe Perches475be4d2012-02-19 19:52:38 -080094 debugl1(cs, "outP %s %02x", ModemOut[offset], value);
Linus Torvalds1da177e2005-04-16 15:20:36 -070095#endif
96#endif
Robert P. J. Daye3c07b92007-02-12 00:53:21 -080097#ifdef ELSA_SERIAL_NOPAUSE_IO
Linus Torvalds1da177e2005-04-16 15:20:36 -070098 outb(value, cs->hw.elsa.base + 8 + offset);
99#else
Joe Perches475be4d2012-02-19 19:52:38 -0800100 outb_p(value, cs->hw.elsa.base + 8 + offset);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700101#endif
102}
103
104/*
105 * This routine is called to set the UART divisor registers to match
106 * the specified baud rate for a serial port.
107 */
108static void change_speed(struct IsdnCardState *cs, int baud)
109{
110 int quot = 0, baud_base;
111 unsigned cval, fcr = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112
113
114 /* byte size and parity */
David S. Millerdb473672011-04-17 16:38:33 -0700115 cval = 0x03;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116 /* Determine divisor based on baud rate */
117 baud_base = BASE_BAUD;
118 quot = baud_base / baud;
119 /* If the quotient is ever zero, default to 9600 bps */
120 if (!quot)
121 quot = baud_base / 9600;
122
123 /* Set up FIFO's */
124 if ((baud_base / quot) < 2400)
125 fcr = UART_FCR_ENABLE_FIFO | UART_FCR_TRIGGER_1;
126 else
127 fcr = UART_FCR_ENABLE_FIFO | UART_FCR_TRIGGER_8;
128 serial_outp(cs, UART_FCR, fcr);
129 /* CTS flow control flag and modem status interrupts */
130 cs->hw.elsa.IER &= ~UART_IER_MSI;
131 cs->hw.elsa.IER |= UART_IER_MSI;
132 serial_outp(cs, UART_IER, cs->hw.elsa.IER);
133
Joe Perches475be4d2012-02-19 19:52:38 -0800134 debugl1(cs, "modem quot=0x%x", quot);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 serial_outp(cs, UART_LCR, cval | UART_LCR_DLAB);/* set DLAB */
136 serial_outp(cs, UART_DLL, quot & 0xff); /* LS of divisor */
137 serial_outp(cs, UART_DLM, quot >> 8); /* MS of divisor */
138 serial_outp(cs, UART_LCR, cval); /* reset DLAB */
139 serial_inp(cs, UART_RX);
140}
141
142static int mstartup(struct IsdnCardState *cs)
143{
Joe Perches475be4d2012-02-19 19:52:38 -0800144 int retval = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145
146 /*
147 * Clear the FIFO buffers and disable them
148 * (they will be reenabled in change_speed())
149 */
150 serial_outp(cs, UART_FCR, (UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT));
151
152 /*
153 * At this point there's no way the LSR could still be 0xFF;
154 * if it is, then bail out, because there's likely no UART
155 * here.
156 */
157 if (serial_inp(cs, UART_LSR) == 0xff) {
158 retval = -ENODEV;
159 goto errout;
160 }
Joe Perches475be4d2012-02-19 19:52:38 -0800161
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162 /*
163 * Clear the interrupt registers.
164 */
165 (void) serial_inp(cs, UART_RX);
166 (void) serial_inp(cs, UART_IIR);
167 (void) serial_inp(cs, UART_MSR);
168
169 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800170 * Now, initialize the UART
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 */
172 serial_outp(cs, UART_LCR, UART_LCR_WLEN8); /* reset DLAB */
173
174 cs->hw.elsa.MCR = 0;
175 cs->hw.elsa.MCR = UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2;
176 serial_outp(cs, UART_MCR, cs->hw.elsa.MCR);
Joe Perches475be4d2012-02-19 19:52:38 -0800177
Linus Torvalds1da177e2005-04-16 15:20:36 -0700178 /*
179 * Finally, enable interrupts
180 */
181 cs->hw.elsa.IER = UART_IER_MSI | UART_IER_RLSI | UART_IER_RDI;
182 serial_outp(cs, UART_IER, cs->hw.elsa.IER); /* enable interrupts */
Joe Perches475be4d2012-02-19 19:52:38 -0800183
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184 /*
185 * And clear the interrupt registers again for luck.
186 */
187 (void)serial_inp(cs, UART_LSR);
188 (void)serial_inp(cs, UART_RX);
189 (void)serial_inp(cs, UART_IIR);
190 (void)serial_inp(cs, UART_MSR);
191
192 cs->hw.elsa.transcnt = cs->hw.elsa.transp = 0;
Joe Perches475be4d2012-02-19 19:52:38 -0800193 cs->hw.elsa.rcvcnt = cs->hw.elsa.rcvp = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194
195 /*
196 * and set the speed of the serial port
197 */
198 change_speed(cs, BASE_BAUD);
199 cs->hw.elsa.MFlag = 1;
200errout:
201 return retval;
202}
203
204/*
205 * This routine will shutdown a serial port; interrupts are disabled, and
206 * DTR is dropped if the hangup on close termio flag is on.
207 */
208static void mshutdown(struct IsdnCardState *cs)
209{
210
211#ifdef SERIAL_DEBUG_OPEN
212 printk(KERN_DEBUG"Shutting down serial ....");
213#endif
Joe Perches475be4d2012-02-19 19:52:38 -0800214
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215 /*
216 * clear delta_msr_wait queue to avoid mem leaks: we may free the irq
217 * here so the queue might never be waken up
218 */
219
220 cs->hw.elsa.IER = 0;
221 serial_outp(cs, UART_IER, 0x00); /* disable all intrs */
222 cs->hw.elsa.MCR &= ~UART_MCR_OUT2;
Joe Perches475be4d2012-02-19 19:52:38 -0800223
Linus Torvalds1da177e2005-04-16 15:20:36 -0700224 /* disable break condition */
225 serial_outp(cs, UART_LCR, serial_inp(cs, UART_LCR) & ~UART_LCR_SBC);
Joe Perches475be4d2012-02-19 19:52:38 -0800226
227 cs->hw.elsa.MCR &= ~(UART_MCR_DTR | UART_MCR_RTS);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 serial_outp(cs, UART_MCR, cs->hw.elsa.MCR);
229
Joe Perches475be4d2012-02-19 19:52:38 -0800230 /* disable FIFO's */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231 serial_outp(cs, UART_FCR, (UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT));
232 serial_inp(cs, UART_RX); /* read data port to reset things */
Joe Perches475be4d2012-02-19 19:52:38 -0800233
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234#ifdef SERIAL_DEBUG_OPEN
235 printk(" done\n");
236#endif
237}
238
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700239static inline int
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240write_modem(struct BCState *bcs) {
Joe Perches475be4d2012-02-19 19:52:38 -0800241 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700242 struct IsdnCardState *cs = bcs->cs;
243 int count, len, fp;
Joe Perches475be4d2012-02-19 19:52:38 -0800244
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 if (!bcs->tx_skb)
246 return 0;
247 if (bcs->tx_skb->len <= 0)
248 return 0;
249 len = bcs->tx_skb->len;
250 if (len > MAX_MODEM_BUF - cs->hw.elsa.transcnt)
251 len = MAX_MODEM_BUF - cs->hw.elsa.transcnt;
252 fp = cs->hw.elsa.transcnt + cs->hw.elsa.transp;
Joe Perches475be4d2012-02-19 19:52:38 -0800253 fp &= (MAX_MODEM_BUF - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700254 count = len;
255 if (count > MAX_MODEM_BUF - fp) {
256 count = MAX_MODEM_BUF - fp;
Arnaldo Carvalho de Melod626f622007-03-27 18:55:52 -0300257 skb_copy_from_linear_data(bcs->tx_skb,
258 cs->hw.elsa.transbuf + fp, count);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700259 skb_pull(bcs->tx_skb, count);
260 cs->hw.elsa.transcnt += count;
261 ret = count;
262 count = len - count;
263 fp = 0;
264 }
Arnaldo Carvalho de Melod626f622007-03-27 18:55:52 -0300265 skb_copy_from_linear_data(bcs->tx_skb,
266 cs->hw.elsa.transbuf + fp, count);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267 skb_pull(bcs->tx_skb, count);
268 cs->hw.elsa.transcnt += count;
269 ret += count;
Joe Perches475be4d2012-02-19 19:52:38 -0800270
271 if (cs->hw.elsa.transcnt &&
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272 !(cs->hw.elsa.IER & UART_IER_THRI)) {
Joe Perches475be4d2012-02-19 19:52:38 -0800273 cs->hw.elsa.IER |= UART_IER_THRI;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 serial_outp(cs, UART_IER, cs->hw.elsa.IER);
275 }
Joe Perches475be4d2012-02-19 19:52:38 -0800276 return (ret);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277}
278
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700279static inline void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280modem_fill(struct BCState *bcs) {
Joe Perches475be4d2012-02-19 19:52:38 -0800281
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282 if (bcs->tx_skb) {
283 if (bcs->tx_skb->len) {
284 write_modem(bcs);
285 return;
286 } else {
Joe Perches475be4d2012-02-19 19:52:38 -0800287 if (test_bit(FLG_LLI_L1WAKEUP, &bcs->st->lli.flag) &&
288 (PACKET_NOACK != bcs->tx_skb->pkt_type)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700289 u_long flags;
290 spin_lock_irqsave(&bcs->aclock, flags);
291 bcs->ackcnt += bcs->hw.hscx.count;
292 spin_unlock_irqrestore(&bcs->aclock, flags);
293 schedule_event(bcs, B_ACKPENDING);
294 }
295 dev_kfree_skb_any(bcs->tx_skb);
296 bcs->tx_skb = NULL;
297 }
298 }
299 if ((bcs->tx_skb = skb_dequeue(&bcs->squeue))) {
300 bcs->hw.hscx.count = 0;
301 test_and_set_bit(BC_FLG_BUSY, &bcs->Flag);
302 write_modem(bcs);
303 } else {
304 test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
305 schedule_event(bcs, B_XMTBUFREADY);
306 }
307}
308
309static inline void receive_chars(struct IsdnCardState *cs,
310 int *status)
311{
312 unsigned char ch;
313 struct sk_buff *skb;
314
315 do {
316 ch = serial_in(cs, UART_RX);
317 if (cs->hw.elsa.rcvcnt >= MAX_MODEM_BUF)
318 break;
319 cs->hw.elsa.rcvbuf[cs->hw.elsa.rcvcnt++] = ch;
320#ifdef SERIAL_DEBUG_INTR
321 printk("DR%02x:%02x...", ch, *status);
322#endif
323 if (*status & (UART_LSR_BI | UART_LSR_PE |
324 UART_LSR_FE | UART_LSR_OE)) {
Joe Perches475be4d2012-02-19 19:52:38 -0800325
Linus Torvalds1da177e2005-04-16 15:20:36 -0700326#ifdef SERIAL_DEBUG_INTR
327 printk("handling exept....");
328#endif
329 }
330 *status = serial_inp(cs, UART_LSR);
331 } while (*status & UART_LSR_DR);
332 if (cs->hw.elsa.MFlag == 2) {
333 if (!(skb = dev_alloc_skb(cs->hw.elsa.rcvcnt)))
334 printk(KERN_WARNING "ElsaSER: receive out of memory\n");
335 else {
Joe Perches475be4d2012-02-19 19:52:38 -0800336 memcpy(skb_put(skb, cs->hw.elsa.rcvcnt), cs->hw.elsa.rcvbuf,
337 cs->hw.elsa.rcvcnt);
338 skb_queue_tail(&cs->hw.elsa.bcs->rqueue, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339 }
340 schedule_event(cs->hw.elsa.bcs, B_RCVBUFREADY);
341 } else {
342 char tmp[128];
343 char *t = tmp;
344
345 t += sprintf(t, "modem read cnt %d", cs->hw.elsa.rcvcnt);
346 QuickHex(t, cs->hw.elsa.rcvbuf, cs->hw.elsa.rcvcnt);
Kees Cook35a4a572013-09-13 14:52:04 -0700347 debugl1(cs, "%s", tmp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348 }
349 cs->hw.elsa.rcvcnt = 0;
350}
351
352static inline void transmit_chars(struct IsdnCardState *cs, int *intr_done)
353{
354 int count;
Joe Perches475be4d2012-02-19 19:52:38 -0800355
356 debugl1(cs, "transmit_chars: p(%x) cnt(%x)", cs->hw.elsa.transp,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357 cs->hw.elsa.transcnt);
Joe Perches475be4d2012-02-19 19:52:38 -0800358
Linus Torvalds1da177e2005-04-16 15:20:36 -0700359 if (cs->hw.elsa.transcnt <= 0) {
360 cs->hw.elsa.IER &= ~UART_IER_THRI;
361 serial_out(cs, UART_IER, cs->hw.elsa.IER);
362 return;
363 }
364 count = 16;
365 do {
366 serial_outp(cs, UART_TX, cs->hw.elsa.transbuf[cs->hw.elsa.transp++]);
367 if (cs->hw.elsa.transp >= MAX_MODEM_BUF)
Joe Perches475be4d2012-02-19 19:52:38 -0800368 cs->hw.elsa.transp = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369 if (--cs->hw.elsa.transcnt <= 0)
370 break;
371 } while (--count > 0);
Joe Perches475be4d2012-02-19 19:52:38 -0800372 if ((cs->hw.elsa.transcnt < WAKEUP_CHARS) && (cs->hw.elsa.MFlag == 2))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373 modem_fill(cs->hw.elsa.bcs);
374
375#ifdef SERIAL_DEBUG_INTR
376 printk("THRE...");
377#endif
378 if (intr_done)
379 *intr_done = 0;
380 if (cs->hw.elsa.transcnt <= 0) {
381 cs->hw.elsa.IER &= ~UART_IER_THRI;
382 serial_outp(cs, UART_IER, cs->hw.elsa.IER);
383 }
384}
385
386
Jeff Garzik896c6fa2007-10-31 05:42:50 -0400387static void rs_interrupt_elsa(struct IsdnCardState *cs)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388{
389 int status, iir, msr;
390 int pass_counter = 0;
Joe Perches475be4d2012-02-19 19:52:38 -0800391
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392#ifdef SERIAL_DEBUG_INTR
Jeff Garzik896c6fa2007-10-31 05:42:50 -0400393 printk(KERN_DEBUG "rs_interrupt_single(%d)...", cs->irq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394#endif
395
396 do {
397 status = serial_inp(cs, UART_LSR);
Joe Perches475be4d2012-02-19 19:52:38 -0800398 debugl1(cs, "rs LSR %02x", status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399#ifdef SERIAL_DEBUG_INTR
400 printk("status = %x...", status);
401#endif
402 if (status & UART_LSR_DR)
403 receive_chars(cs, &status);
404 if (status & UART_LSR_THRE)
405 transmit_chars(cs, NULL);
406 if (pass_counter++ > RS_ISR_PASS_LIMIT) {
407 printk("rs_single loop break.\n");
408 break;
409 }
410 iir = serial_inp(cs, UART_IIR);
Joe Perches475be4d2012-02-19 19:52:38 -0800411 debugl1(cs, "rs IIR %02x", iir);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412 if ((iir & 0xf) == 0) {
413 msr = serial_inp(cs, UART_MSR);
Joe Perches475be4d2012-02-19 19:52:38 -0800414 debugl1(cs, "rs MSR %02x", msr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415 }
416 } while (!(iir & UART_IIR_NO_INT));
417#ifdef SERIAL_DEBUG_INTR
418 printk("end.\n");
419#endif
420}
421
422extern int open_hscxstate(struct IsdnCardState *cs, struct BCState *bcs);
423extern void modehscx(struct BCState *bcs, int mode, int bc);
424extern void hscx_l2l1(struct PStack *st, int pr, void *arg);
425
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700426static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427close_elsastate(struct BCState *bcs)
428{
429 modehscx(bcs, 0, bcs->channel);
430 if (test_and_clear_bit(BC_FLG_INIT, &bcs->Flag)) {
431 if (bcs->hw.hscx.rcvbuf) {
432 if (bcs->mode != L1_MODE_MODEM)
433 kfree(bcs->hw.hscx.rcvbuf);
434 bcs->hw.hscx.rcvbuf = NULL;
435 }
436 skb_queue_purge(&bcs->rqueue);
437 skb_queue_purge(&bcs->squeue);
438 if (bcs->tx_skb) {
439 dev_kfree_skb_any(bcs->tx_skb);
440 bcs->tx_skb = NULL;
441 test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
442 }
443 }
444}
445
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700446static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447modem_write_cmd(struct IsdnCardState *cs, u_char *buf, int len) {
448 int count, fp;
449 u_char *msg = buf;
Joe Perches475be4d2012-02-19 19:52:38 -0800450
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 if (!len)
452 return;
453 if (len > (MAX_MODEM_BUF - cs->hw.elsa.transcnt)) {
454 return;
455 }
456 fp = cs->hw.elsa.transcnt + cs->hw.elsa.transp;
Joe Perches475be4d2012-02-19 19:52:38 -0800457 fp &= (MAX_MODEM_BUF - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700458 count = len;
459 if (count > MAX_MODEM_BUF - fp) {
460 count = MAX_MODEM_BUF - fp;
461 memcpy(cs->hw.elsa.transbuf + fp, msg, count);
462 cs->hw.elsa.transcnt += count;
463 msg += count;
464 count = len - count;
465 fp = 0;
466 }
467 memcpy(cs->hw.elsa.transbuf + fp, msg, count);
468 cs->hw.elsa.transcnt += count;
Joe Perches475be4d2012-02-19 19:52:38 -0800469 if (cs->hw.elsa.transcnt &&
Linus Torvalds1da177e2005-04-16 15:20:36 -0700470 !(cs->hw.elsa.IER & UART_IER_THRI)) {
471 cs->hw.elsa.IER |= UART_IER_THRI;
472 serial_outp(cs, UART_IER, cs->hw.elsa.IER);
473 }
474}
475
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700476static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700477modem_set_init(struct IsdnCardState *cs) {
478 int timeout;
479
Martin Michlmayrcc053682009-11-06 14:52:34 +0000480#define RCV_DELAY 20
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 modem_write_cmd(cs, MInit_1, strlen(MInit_1));
482 timeout = 1000;
Joe Perches475be4d2012-02-19 19:52:38 -0800483 while (timeout-- && cs->hw.elsa.transcnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484 udelay(1000);
485 debugl1(cs, "msi tout=%d", timeout);
Martin Michlmayrcc053682009-11-06 14:52:34 +0000486 mdelay(RCV_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487 modem_write_cmd(cs, MInit_2, strlen(MInit_2));
488 timeout = 1000;
Joe Perches475be4d2012-02-19 19:52:38 -0800489 while (timeout-- && cs->hw.elsa.transcnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700490 udelay(1000);
491 debugl1(cs, "msi tout=%d", timeout);
Martin Michlmayrcc053682009-11-06 14:52:34 +0000492 mdelay(RCV_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 modem_write_cmd(cs, MInit_3, strlen(MInit_3));
494 timeout = 1000;
Joe Perches475be4d2012-02-19 19:52:38 -0800495 while (timeout-- && cs->hw.elsa.transcnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496 udelay(1000);
497 debugl1(cs, "msi tout=%d", timeout);
Martin Michlmayrcc053682009-11-06 14:52:34 +0000498 mdelay(RCV_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700499 modem_write_cmd(cs, MInit_4, strlen(MInit_4));
500 timeout = 1000;
Joe Perches475be4d2012-02-19 19:52:38 -0800501 while (timeout-- && cs->hw.elsa.transcnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502 udelay(1000);
503 debugl1(cs, "msi tout=%d", timeout);
Martin Michlmayrcc053682009-11-06 14:52:34 +0000504 mdelay(RCV_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505 modem_write_cmd(cs, MInit_5, strlen(MInit_5));
506 timeout = 1000;
Joe Perches475be4d2012-02-19 19:52:38 -0800507 while (timeout-- && cs->hw.elsa.transcnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 udelay(1000);
509 debugl1(cs, "msi tout=%d", timeout);
Martin Michlmayrcc053682009-11-06 14:52:34 +0000510 mdelay(RCV_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511 modem_write_cmd(cs, MInit_6, strlen(MInit_6));
512 timeout = 1000;
Joe Perches475be4d2012-02-19 19:52:38 -0800513 while (timeout-- && cs->hw.elsa.transcnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 udelay(1000);
515 debugl1(cs, "msi tout=%d", timeout);
Martin Michlmayrcc053682009-11-06 14:52:34 +0000516 mdelay(RCV_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517 modem_write_cmd(cs, MInit_7, strlen(MInit_7));
518 timeout = 1000;
Joe Perches475be4d2012-02-19 19:52:38 -0800519 while (timeout-- && cs->hw.elsa.transcnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520 udelay(1000);
521 debugl1(cs, "msi tout=%d", timeout);
Martin Michlmayrcc053682009-11-06 14:52:34 +0000522 mdelay(RCV_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523}
524
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700525static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526modem_set_dial(struct IsdnCardState *cs, int outgoing) {
527 int timeout;
Martin Michlmayrcc053682009-11-06 14:52:34 +0000528#define RCV_DELAY 20
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529
530 modem_write_cmd(cs, MInit_speed28800, strlen(MInit_speed28800));
531 timeout = 1000;
Joe Perches475be4d2012-02-19 19:52:38 -0800532 while (timeout-- && cs->hw.elsa.transcnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533 udelay(1000);
534 debugl1(cs, "msi tout=%d", timeout);
Martin Michlmayrcc053682009-11-06 14:52:34 +0000535 mdelay(RCV_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 if (outgoing)
537 modem_write_cmd(cs, MInit_dialout, strlen(MInit_dialout));
538 else
539 modem_write_cmd(cs, MInit_dialin, strlen(MInit_dialin));
540 timeout = 1000;
Joe Perches475be4d2012-02-19 19:52:38 -0800541 while (timeout-- && cs->hw.elsa.transcnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542 udelay(1000);
543 debugl1(cs, "msi tout=%d", timeout);
Martin Michlmayrcc053682009-11-06 14:52:34 +0000544 mdelay(RCV_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545}
546
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700547static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700548modem_l2l1(struct PStack *st, int pr, void *arg)
549{
550 struct BCState *bcs = st->l1.bcs;
551 struct sk_buff *skb = arg;
552 u_long flags;
553
554 if (pr == (PH_DATA | REQUEST)) {
555 spin_lock_irqsave(&bcs->cs->lock, flags);
556 if (bcs->tx_skb) {
557 skb_queue_tail(&bcs->squeue, skb);
558 } else {
559 bcs->tx_skb = skb;
560 test_and_set_bit(BC_FLG_BUSY, &bcs->Flag);
561 bcs->hw.hscx.count = 0;
562 write_modem(bcs);
563 }
564 spin_unlock_irqrestore(&bcs->cs->lock, flags);
565 } else if (pr == (PH_ACTIVATE | REQUEST)) {
566 test_and_set_bit(BC_FLG_ACTIV, &bcs->Flag);
567 st->l1.l1l2(st, PH_ACTIVATE | CONFIRM, NULL);
568 set_arcofi(bcs->cs, st->l1.bc);
569 mstartup(bcs->cs);
570 modem_set_dial(bcs->cs, test_bit(FLG_ORIG, &st->l2.flag));
Joe Perches475be4d2012-02-19 19:52:38 -0800571 bcs->cs->hw.elsa.MFlag = 2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 } else if (pr == (PH_DEACTIVATE | REQUEST)) {
573 test_and_clear_bit(BC_FLG_ACTIV, &bcs->Flag);
574 bcs->cs->dc.isac.arcofi_bc = st->l1.bc;
575 arcofi_fsm(bcs->cs, ARCOFI_START, &ARCOFI_XOP_0);
576 interruptible_sleep_on(&bcs->cs->dc.isac.arcofi_wait);
Joe Perches475be4d2012-02-19 19:52:38 -0800577 bcs->cs->hw.elsa.MFlag = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578 } else {
Joe Perches475be4d2012-02-19 19:52:38 -0800579 printk(KERN_WARNING "ElsaSer: unknown pr %x\n", pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580 }
581}
582
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700583static int
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584setstack_elsa(struct PStack *st, struct BCState *bcs)
585{
586
587 bcs->channel = st->l1.bc;
588 switch (st->l1.mode) {
Joe Perches475be4d2012-02-19 19:52:38 -0800589 case L1_MODE_HDLC:
590 case L1_MODE_TRANS:
591 if (open_hscxstate(st->l1.hardware, bcs))
592 return (-1);
593 st->l2.l2l1 = hscx_l2l1;
594 break;
595 case L1_MODE_MODEM:
596 bcs->mode = L1_MODE_MODEM;
597 if (!test_and_set_bit(BC_FLG_INIT, &bcs->Flag)) {
598 bcs->hw.hscx.rcvbuf = bcs->cs->hw.elsa.rcvbuf;
599 skb_queue_head_init(&bcs->rqueue);
600 skb_queue_head_init(&bcs->squeue);
601 }
602 bcs->tx_skb = NULL;
603 test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
604 bcs->event = 0;
605 bcs->hw.hscx.rcvidx = 0;
606 bcs->tx_cnt = 0;
607 bcs->cs->hw.elsa.bcs = bcs;
608 st->l2.l2l1 = modem_l2l1;
609 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700610 }
611 st->l1.bcs = bcs;
612 setstack_manager(st);
613 bcs->st = st;
614 setstack_l1_B(st);
615 return (0);
616}
617
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700618static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700619init_modem(struct IsdnCardState *cs) {
620
621 cs->bcs[0].BC_SetStack = setstack_elsa;
622 cs->bcs[1].BC_SetStack = setstack_elsa;
623 cs->bcs[0].BC_Close = close_elsastate;
624 cs->bcs[1].BC_Close = close_elsastate;
625 if (!(cs->hw.elsa.rcvbuf = kmalloc(MAX_MODEM_BUF,
Joe Perches475be4d2012-02-19 19:52:38 -0800626 GFP_ATOMIC))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700627 printk(KERN_WARNING
Joe Perches475be4d2012-02-19 19:52:38 -0800628 "Elsa: No modem mem hw.elsa.rcvbuf\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629 return;
630 }
631 if (!(cs->hw.elsa.transbuf = kmalloc(MAX_MODEM_BUF,
Joe Perches475be4d2012-02-19 19:52:38 -0800632 GFP_ATOMIC))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700633 printk(KERN_WARNING
Joe Perches475be4d2012-02-19 19:52:38 -0800634 "Elsa: No modem mem hw.elsa.transbuf\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635 kfree(cs->hw.elsa.rcvbuf);
636 cs->hw.elsa.rcvbuf = NULL;
637 return;
638 }
639 if (mstartup(cs)) {
640 printk(KERN_WARNING "Elsa: problem startup modem\n");
641 }
642 modem_set_init(cs);
643}
644
Adrian Bunk672c3fd2005-06-25 14:59:18 -0700645static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646release_modem(struct IsdnCardState *cs) {
647
648 cs->hw.elsa.MFlag = 0;
649 if (cs->hw.elsa.transbuf) {
650 if (cs->hw.elsa.rcvbuf) {
651 mshutdown(cs);
652 kfree(cs->hw.elsa.rcvbuf);
653 cs->hw.elsa.rcvbuf = NULL;
654 }
655 kfree(cs->hw.elsa.transbuf);
656 cs->hw.elsa.transbuf = NULL;
657 }
658}