blob: 94ec66372508016eab8fd3fad286f3f8017fe47c [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/************************************************************************
2 * Copyright 2003 Digi International (www.digi.com)
3 *
4 * Copyright (C) 2004 IBM Corporation. All rights reserved.
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2, or (at your option)
9 * any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY, EXPRESS OR IMPLIED; without even the
13 * implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
14 * PURPOSE. See the GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 * Temple Place - Suite 330, Boston,
19 * MA 02111-1307, USA.
20 *
21 * Contact Information:
22 * Scott H Kilau <Scott_Kilau@digi.com>
V. Ananda Krishnan0a577ce2006-02-03 03:04:30 -080023 * Ananda Venkatarman <mansarov@us.ibm.com>
24 * Modifications:
25 * 01/19/06: changed jsm_input routine to use the dynamically allocated
26 * tty_buffer changes. Contributors: Scott Kilau and Ananda V.
Linus Torvalds1da177e2005-04-16 15:20:36 -070027 ***********************************************************************/
28#include <linux/tty.h>
29#include <linux/tty_flip.h>
30#include <linux/serial_reg.h>
31#include <linux/delay.h> /* For udelay */
32#include <linux/pci.h>
33
34#include "jsm.h"
35
Adrian Bunk408b6642005-05-01 08:59:29 -070036static void jsm_carrier(struct jsm_channel *ch);
37
Linus Torvalds1da177e2005-04-16 15:20:36 -070038static inline int jsm_get_mstat(struct jsm_channel *ch)
39{
40 unsigned char mstat;
41 unsigned result;
42
43 jsm_printk(IOCTL, INFO, &ch->ch_bd->pci_dev, "start\n");
44
45 mstat = (ch->ch_mostat | ch->ch_mistat);
46
47 result = 0;
48
49 if (mstat & UART_MCR_DTR)
50 result |= TIOCM_DTR;
51 if (mstat & UART_MCR_RTS)
52 result |= TIOCM_RTS;
53 if (mstat & UART_MSR_CTS)
54 result |= TIOCM_CTS;
55 if (mstat & UART_MSR_DSR)
56 result |= TIOCM_DSR;
57 if (mstat & UART_MSR_RI)
58 result |= TIOCM_RI;
59 if (mstat & UART_MSR_DCD)
60 result |= TIOCM_CD;
61
62 jsm_printk(IOCTL, INFO, &ch->ch_bd->pci_dev, "finish\n");
63 return result;
64}
65
66static unsigned int jsm_tty_tx_empty(struct uart_port *port)
67{
68 return TIOCSER_TEMT;
69}
70
71/*
72 * Return modem signals to ld.
73 */
74static unsigned int jsm_tty_get_mctrl(struct uart_port *port)
75{
76 int result;
77 struct jsm_channel *channel = (struct jsm_channel *)port;
78
79 jsm_printk(IOCTL, INFO, &channel->ch_bd->pci_dev, "start\n");
80
81 result = jsm_get_mstat(channel);
82
83 if (result < 0)
84 return -ENXIO;
85
86 jsm_printk(IOCTL, INFO, &channel->ch_bd->pci_dev, "finish\n");
87
88 return result;
89}
90
91/*
92 * jsm_set_modem_info()
93 *
94 * Set modem signals, called by ld.
95 */
96static void jsm_tty_set_mctrl(struct uart_port *port, unsigned int mctrl)
97{
98 struct jsm_channel *channel = (struct jsm_channel *)port;
99
100 jsm_printk(IOCTL, INFO, &channel->ch_bd->pci_dev, "start\n");
101
102 if (mctrl & TIOCM_RTS)
103 channel->ch_mostat |= UART_MCR_RTS;
104 else
105 channel->ch_mostat &= ~UART_MCR_RTS;
106
107 if (mctrl & TIOCM_DTR)
108 channel->ch_mostat |= UART_MCR_DTR;
109 else
110 channel->ch_mostat &= ~UART_MCR_DTR;
111
112 channel->ch_bd->bd_ops->assert_modem_signals(channel);
113
114 jsm_printk(IOCTL, INFO, &channel->ch_bd->pci_dev, "finish\n");
115 udelay(10);
116}
117
Russell Kingb129a8c2005-08-31 10:12:14 +0100118static void jsm_tty_start_tx(struct uart_port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119{
120 struct jsm_channel *channel = (struct jsm_channel *)port;
121
122 jsm_printk(IOCTL, INFO, &channel->ch_bd->pci_dev, "start\n");
123
124 channel->ch_flags &= ~(CH_STOP);
125 jsm_tty_write(port);
126
127 jsm_printk(IOCTL, INFO, &channel->ch_bd->pci_dev, "finish\n");
128}
129
Russell Kingb129a8c2005-08-31 10:12:14 +0100130static void jsm_tty_stop_tx(struct uart_port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131{
132 struct jsm_channel *channel = (struct jsm_channel *)port;
133
134 jsm_printk(IOCTL, INFO, &channel->ch_bd->pci_dev, "start\n");
135
136 channel->ch_flags |= (CH_STOP);
137
138 jsm_printk(IOCTL, INFO, &channel->ch_bd->pci_dev, "finish\n");
139}
140
141static void jsm_tty_send_xchar(struct uart_port *port, char ch)
142{
143 unsigned long lock_flags;
144 struct jsm_channel *channel = (struct jsm_channel *)port;
Alan Cox606d0992006-12-08 02:38:45 -0800145 struct ktermios *termios;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146
147 spin_lock_irqsave(&port->lock, lock_flags);
Jesper Juhla58e00e2006-03-31 02:32:12 -0800148 termios = port->info->tty->termios;
149 if (ch == termios->c_cc[VSTART])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150 channel->ch_bd->bd_ops->send_start_character(channel);
151
Jesper Juhla58e00e2006-03-31 02:32:12 -0800152 if (ch == termios->c_cc[VSTOP])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153 channel->ch_bd->bd_ops->send_stop_character(channel);
154 spin_unlock_irqrestore(&port->lock, lock_flags);
155}
156
157static void jsm_tty_stop_rx(struct uart_port *port)
158{
159 struct jsm_channel *channel = (struct jsm_channel *)port;
160
161 channel->ch_bd->bd_ops->disable_receiver(channel);
162}
163
164static void jsm_tty_break(struct uart_port *port, int break_state)
165{
166 unsigned long lock_flags;
167 struct jsm_channel *channel = (struct jsm_channel *)port;
168
169 spin_lock_irqsave(&port->lock, lock_flags);
170 if (break_state == -1)
171 channel->ch_bd->bd_ops->send_break(channel);
172 else
173 channel->ch_bd->bd_ops->clear_break(channel, 0);
174
175 spin_unlock_irqrestore(&port->lock, lock_flags);
176}
177
178static int jsm_tty_open(struct uart_port *port)
179{
180 struct jsm_board *brd;
181 int rc = 0;
182 struct jsm_channel *channel = (struct jsm_channel *)port;
Alan Cox606d0992006-12-08 02:38:45 -0800183 struct ktermios *termios;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184
185 /* Get board pointer from our array of majors we have allocated */
186 brd = channel->ch_bd;
187
188 /*
189 * Allocate channel buffers for read/write/error.
190 * Set flag, so we don't get trounced on.
191 */
192 channel->ch_flags |= (CH_OPENING);
193
194 /* Drop locks, as malloc with GFP_KERNEL can sleep */
195
196 if (!channel->ch_rqueue) {
Burman Yan8f31bb32007-02-14 00:33:07 -0800197 channel->ch_rqueue = kzalloc(RQUEUESIZE, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 if (!channel->ch_rqueue) {
199 jsm_printk(INIT, ERR, &channel->ch_bd->pci_dev,
200 "unable to allocate read queue buf");
201 return -ENOMEM;
202 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 }
204 if (!channel->ch_equeue) {
Burman Yan8f31bb32007-02-14 00:33:07 -0800205 channel->ch_equeue = kzalloc(EQUEUESIZE, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206 if (!channel->ch_equeue) {
207 jsm_printk(INIT, ERR, &channel->ch_bd->pci_dev,
208 "unable to allocate error queue buf");
209 return -ENOMEM;
210 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211 }
212 if (!channel->ch_wqueue) {
Burman Yan8f31bb32007-02-14 00:33:07 -0800213 channel->ch_wqueue = kzalloc(WQUEUESIZE, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214 if (!channel->ch_wqueue) {
215 jsm_printk(INIT, ERR, &channel->ch_bd->pci_dev,
216 "unable to allocate write queue buf");
217 return -ENOMEM;
218 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700219 }
220
221 channel->ch_flags &= ~(CH_OPENING);
222 /*
223 * Initialize if neither terminal is open.
224 */
225 jsm_printk(OPEN, INFO, &channel->ch_bd->pci_dev,
226 "jsm_open: initializing channel in open...\n");
227
228 /*
229 * Flush input queues.
230 */
231 channel->ch_r_head = channel->ch_r_tail = 0;
232 channel->ch_e_head = channel->ch_e_tail = 0;
233 channel->ch_w_head = channel->ch_w_tail = 0;
234
235 brd->bd_ops->flush_uart_write(channel);
236 brd->bd_ops->flush_uart_read(channel);
237
238 channel->ch_flags = 0;
239 channel->ch_cached_lsr = 0;
240 channel->ch_stops_sent = 0;
241
Jesper Juhla58e00e2006-03-31 02:32:12 -0800242 termios = port->info->tty->termios;
243 channel->ch_c_cflag = termios->c_cflag;
244 channel->ch_c_iflag = termios->c_iflag;
245 channel->ch_c_oflag = termios->c_oflag;
246 channel->ch_c_lflag = termios->c_lflag;
247 channel->ch_startc = termios->c_cc[VSTART];
248 channel->ch_stopc = termios->c_cc[VSTOP];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249
250 /* Tell UART to init itself */
251 brd->bd_ops->uart_init(channel);
252
253 /*
254 * Run param in case we changed anything
255 */
256 brd->bd_ops->param(channel);
257
258 jsm_carrier(channel);
259
260 channel->ch_open_count++;
261
262 jsm_printk(OPEN, INFO, &channel->ch_bd->pci_dev, "finish\n");
263 return rc;
264}
265
266static void jsm_tty_close(struct uart_port *port)
267{
268 struct jsm_board *bd;
Alan Cox606d0992006-12-08 02:38:45 -0800269 struct ktermios *ts;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270 struct jsm_channel *channel = (struct jsm_channel *)port;
271
272 jsm_printk(CLOSE, INFO, &channel->ch_bd->pci_dev, "start\n");
273
274 bd = channel->ch_bd;
275 ts = channel->uart_port.info->tty->termios;
276
277 channel->ch_flags &= ~(CH_STOPI);
278
279 channel->ch_open_count--;
280
281 /*
282 * If we have HUPCL set, lower DTR and RTS
283 */
284 if (channel->ch_c_cflag & HUPCL) {
285 jsm_printk(CLOSE, INFO, &channel->ch_bd->pci_dev,
286 "Close. HUPCL set, dropping DTR/RTS\n");
287
288 /* Drop RTS/DTR */
289 channel->ch_mostat &= ~(UART_MCR_DTR | UART_MCR_RTS);
290 bd->bd_ops->assert_modem_signals(channel);
291 }
292
293 channel->ch_old_baud = 0;
294
295 /* Turn off UART interrupts for this port */
296 channel->ch_bd->bd_ops->uart_off(channel);
297
298 jsm_printk(CLOSE, INFO, &channel->ch_bd->pci_dev, "finish\n");
299}
300
301static void jsm_tty_set_termios(struct uart_port *port,
Alan Cox606d0992006-12-08 02:38:45 -0800302 struct ktermios *termios,
303 struct ktermios *old_termios)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304{
305 unsigned long lock_flags;
306 struct jsm_channel *channel = (struct jsm_channel *)port;
307
308 spin_lock_irqsave(&port->lock, lock_flags);
309 channel->ch_c_cflag = termios->c_cflag;
310 channel->ch_c_iflag = termios->c_iflag;
311 channel->ch_c_oflag = termios->c_oflag;
312 channel->ch_c_lflag = termios->c_lflag;
313 channel->ch_startc = termios->c_cc[VSTART];
314 channel->ch_stopc = termios->c_cc[VSTOP];
315
316 channel->ch_bd->bd_ops->param(channel);
317 jsm_carrier(channel);
318 spin_unlock_irqrestore(&port->lock, lock_flags);
319}
320
321static const char *jsm_tty_type(struct uart_port *port)
322{
323 return "jsm";
324}
325
326static void jsm_tty_release_port(struct uart_port *port)
327{
328}
329
330static int jsm_tty_request_port(struct uart_port *port)
331{
332 return 0;
333}
334
335static void jsm_config_port(struct uart_port *port, int flags)
336{
337 port->type = PORT_JSM;
338}
339
340static struct uart_ops jsm_ops = {
341 .tx_empty = jsm_tty_tx_empty,
342 .set_mctrl = jsm_tty_set_mctrl,
343 .get_mctrl = jsm_tty_get_mctrl,
344 .stop_tx = jsm_tty_stop_tx,
345 .start_tx = jsm_tty_start_tx,
346 .send_xchar = jsm_tty_send_xchar,
347 .stop_rx = jsm_tty_stop_rx,
348 .break_ctl = jsm_tty_break,
349 .startup = jsm_tty_open,
350 .shutdown = jsm_tty_close,
351 .set_termios = jsm_tty_set_termios,
352 .type = jsm_tty_type,
353 .release_port = jsm_tty_release_port,
354 .request_port = jsm_tty_request_port,
355 .config_port = jsm_config_port,
356};
357
358/*
359 * jsm_tty_init()
360 *
361 * Init the tty subsystem. Called once per board after board has been
362 * downloaded and init'ed.
363 */
364int jsm_tty_init(struct jsm_board *brd)
365{
366 int i;
367 void __iomem *vaddr;
368 struct jsm_channel *ch;
369
370 if (!brd)
371 return -ENXIO;
372
373 jsm_printk(INIT, INFO, &brd->pci_dev, "start\n");
374
375 /*
376 * Initialize board structure elements.
377 */
378
379 brd->nasync = brd->maxports;
380
381 /*
382 * Allocate channel memory that might not have been allocated
383 * when the driver was first loaded.
384 */
385 for (i = 0; i < brd->nasync; i++) {
386 if (!brd->channels[i]) {
387
388 /*
389 * Okay to malloc with GFP_KERNEL, we are not at
390 * interrupt context, and there are no locks held.
391 */
Burman Yan8f31bb32007-02-14 00:33:07 -0800392 brd->channels[i] = kzalloc(sizeof(struct jsm_channel), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393 if (!brd->channels[i]) {
394 jsm_printk(CORE, ERR, &brd->pci_dev,
395 "%s:%d Unable to allocate memory for channel struct\n",
396 __FILE__, __LINE__);
397 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700398 }
399 }
400
401 ch = brd->channels[0];
402 vaddr = brd->re_map_membase;
403
404 /* Set up channel variables */
405 for (i = 0; i < brd->nasync; i++, ch = brd->channels[i]) {
406
407 if (!brd->channels[i])
408 continue;
409
410 spin_lock_init(&ch->ch_lock);
411
412 if (brd->bd_uart_offset == 0x200)
413 ch->ch_neo_uart = vaddr + (brd->bd_uart_offset * i);
414
415 ch->ch_bd = brd;
416 ch->ch_portnum = i;
417
418 /* .25 second delay */
419 ch->ch_close_delay = 250;
420
421 init_waitqueue_head(&ch->ch_flags_wait);
422 }
423
424 jsm_printk(INIT, INFO, &brd->pci_dev, "finish\n");
425 return 0;
426}
427
428int jsm_uart_port_init(struct jsm_board *brd)
429{
430 int i;
431 struct jsm_channel *ch;
432
433 if (!brd)
434 return -ENXIO;
435
436 jsm_printk(INIT, INFO, &brd->pci_dev, "start\n");
437
438 /*
439 * Initialize board structure elements.
440 */
441
442 brd->nasync = brd->maxports;
443
444 /* Set up channel variables */
445 for (i = 0; i < brd->nasync; i++, ch = brd->channels[i]) {
446
447 if (!brd->channels[i])
448 continue;
449
450 brd->channels[i]->uart_port.irq = brd->irq;
Len Sorensen3c04c272007-05-08 00:26:30 -0700451 brd->channels[i]->uart_port.uartclk = 14745600;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452 brd->channels[i]->uart_port.type = PORT_JSM;
453 brd->channels[i]->uart_port.iotype = UPIO_MEM;
454 brd->channels[i]->uart_port.membase = brd->re_map_membase;
455 brd->channels[i]->uart_port.fifosize = 16;
456 brd->channels[i]->uart_port.ops = &jsm_ops;
457 brd->channels[i]->uart_port.line = brd->channels[i]->ch_portnum + brd->boardnum * 2;
458 if (uart_add_one_port (&jsm_uart_driver, &brd->channels[i]->uart_port))
459 printk(KERN_INFO "Added device failed\n");
460 else
461 printk(KERN_INFO "Added device \n");
462 }
463
464 jsm_printk(INIT, INFO, &brd->pci_dev, "finish\n");
465 return 0;
466}
467
468int jsm_remove_uart_port(struct jsm_board *brd)
469{
470 int i;
471 struct jsm_channel *ch;
472
473 if (!brd)
474 return -ENXIO;
475
476 jsm_printk(INIT, INFO, &brd->pci_dev, "start\n");
477
478 /*
479 * Initialize board structure elements.
480 */
481
482 brd->nasync = brd->maxports;
483
484 /* Set up channel variables */
485 for (i = 0; i < brd->nasync; i++) {
486
487 if (!brd->channels[i])
488 continue;
489
490 ch = brd->channels[i];
491
492 uart_remove_one_port(&jsm_uart_driver, &brd->channels[i]->uart_port);
493 }
494
495 jsm_printk(INIT, INFO, &brd->pci_dev, "finish\n");
496 return 0;
497}
498
499void jsm_input(struct jsm_channel *ch)
500{
501 struct jsm_board *bd;
502 struct tty_struct *tp;
503 u32 rmask;
504 u16 head;
505 u16 tail;
506 int data_len;
507 unsigned long lock_flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 int len = 0;
509 int n = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510 int s = 0;
511 int i = 0;
512
513 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, "start\n");
514
515 if (!ch)
516 return;
517
518 tp = ch->uart_port.info->tty;
519
520 bd = ch->ch_bd;
521 if(!bd)
522 return;
523
524 spin_lock_irqsave(&ch->ch_lock, lock_flags);
525
526 /*
527 *Figure the number of characters in the buffer.
528 *Exit immediately if none.
529 */
530
531 rmask = RQUEUEMASK;
532
533 head = ch->ch_r_head & rmask;
534 tail = ch->ch_r_tail & rmask;
535
536 data_len = (head - tail) & rmask;
537 if (data_len == 0) {
538 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
539 return;
540 }
541
542 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, "start\n");
543
544 /*
545 *If the device is not open, or CREAD is off, flush
546 *input data and return immediately.
547 */
548 if (!tp ||
549 !(tp->termios->c_cflag & CREAD) ) {
550
551 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev,
552 "input. dropping %d bytes on port %d...\n", data_len, ch->ch_portnum);
553 ch->ch_r_head = tail;
554
555 /* Force queue flow control to be released, if needed */
556 jsm_check_queue_flow_control(ch);
557
558 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
559 return;
560 }
561
562 /*
563 * If we are throttled, simply don't read any data.
564 */
565 if (ch->ch_flags & CH_STOPI) {
566 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
567 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev,
568 "Port %d throttled, not reading any data. head: %x tail: %x\n",
569 ch->ch_portnum, head, tail);
570 return;
571 }
572
573 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, "start 2\n");
574
Alan Cox7ba4b922007-10-16 23:27:05 -0700575 if (data_len <= 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
577 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, "jsm_input 1\n");
578 return;
579 }
580
Alan Cox7ba4b922007-10-16 23:27:05 -0700581 len = tty_buffer_request_room(tp, data_len);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700582 n = len;
583
584 /*
585 * n now contains the most amount of data we can copy,
586 * bounded either by the flip buffer size or the amount
587 * of data the card actually has pending...
588 */
589 while (n) {
590 s = ((head >= tail) ? head : RQUEUESIZE) - tail;
591 s = min(s, n);
592
593 if (s <= 0)
594 break;
595
V. Ananda Krishnan0a577ce2006-02-03 03:04:30 -0800596 /*
597 * If conditions are such that ld needs to see all
598 * UART errors, we will have to walk each character
599 * and error byte and send them to the buffer one at
600 * a time.
601 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602
V. Ananda Krishnan0a577ce2006-02-03 03:04:30 -0800603 if (I_PARMRK(tp) || I_BRKINT(tp) || I_INPCK(tp)) {
604 for (i = 0; i < s; i++) {
605 /*
606 * Give the Linux ld the flags in the
607 * format it likes.
608 */
609 if (*(ch->ch_equeue +tail +i) & UART_LSR_BI)
610 tty_insert_flip_char(tp, *(ch->ch_rqueue +tail +i), TTY_BREAK);
611 else if (*(ch->ch_equeue +tail +i) & UART_LSR_PE)
612 tty_insert_flip_char(tp, *(ch->ch_rqueue +tail +i), TTY_PARITY);
613 else if (*(ch->ch_equeue +tail +i) & UART_LSR_FE)
614 tty_insert_flip_char(tp, *(ch->ch_rqueue +tail +i), TTY_FRAME);
615 else
Alan Cox7ba4b922007-10-16 23:27:05 -0700616 tty_insert_flip_char(tp, *(ch->ch_rqueue +tail +i), TTY_NORMAL);
V. Ananda Krishnan0a577ce2006-02-03 03:04:30 -0800617 }
618 } else {
619 tty_insert_flip_string(tp, ch->ch_rqueue + tail, s) ;
620 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621 tail += s;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700622 n -= s;
623 /* Flip queue if needed */
624 tail &= rmask;
625 }
626
V. Ananda Krishnan0a577ce2006-02-03 03:04:30 -0800627 ch->ch_r_tail = tail & rmask;
628 ch->ch_e_tail = tail & rmask;
629 jsm_check_queue_flow_control(ch);
630 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700631
V. Ananda Krishnan0a577ce2006-02-03 03:04:30 -0800632 /* Tell the tty layer its okay to "eat" the data now */
633 tty_flip_buffer_push(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700634
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635 jsm_printk(IOCTL, INFO, &ch->ch_bd->pci_dev, "finish\n");
636}
637
Adrian Bunk408b6642005-05-01 08:59:29 -0700638static void jsm_carrier(struct jsm_channel *ch)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639{
640 struct jsm_board *bd;
641
642 int virt_carrier = 0;
643 int phys_carrier = 0;
644
645 jsm_printk(CARR, INFO, &ch->ch_bd->pci_dev, "start\n");
646 if (!ch)
647 return;
648
649 bd = ch->ch_bd;
650
651 if (!bd)
652 return;
653
654 if (ch->ch_mistat & UART_MSR_DCD) {
655 jsm_printk(CARR, INFO, &ch->ch_bd->pci_dev,
656 "mistat: %x D_CD: %x\n", ch->ch_mistat, ch->ch_mistat & UART_MSR_DCD);
657 phys_carrier = 1;
658 }
659
660 if (ch->ch_c_cflag & CLOCAL)
661 virt_carrier = 1;
662
663 jsm_printk(CARR, INFO, &ch->ch_bd->pci_dev,
664 "DCD: physical: %d virt: %d\n", phys_carrier, virt_carrier);
665
666 /*
667 * Test for a VIRTUAL carrier transition to HIGH.
668 */
669 if (((ch->ch_flags & CH_FCAR) == 0) && (virt_carrier == 1)) {
670
671 /*
672 * When carrier rises, wake any threads waiting
673 * for carrier in the open routine.
674 */
675
676 jsm_printk(CARR, INFO, &ch->ch_bd->pci_dev,
677 "carrier: virt DCD rose\n");
678
679 if (waitqueue_active(&(ch->ch_flags_wait)))
680 wake_up_interruptible(&ch->ch_flags_wait);
681 }
682
683 /*
684 * Test for a PHYSICAL carrier transition to HIGH.
685 */
686 if (((ch->ch_flags & CH_CD) == 0) && (phys_carrier == 1)) {
687
688 /*
689 * When carrier rises, wake any threads waiting
690 * for carrier in the open routine.
691 */
692
693 jsm_printk(CARR, INFO, &ch->ch_bd->pci_dev,
694 "carrier: physical DCD rose\n");
695
696 if (waitqueue_active(&(ch->ch_flags_wait)))
697 wake_up_interruptible(&ch->ch_flags_wait);
698 }
699
700 /*
701 * Test for a PHYSICAL transition to low, so long as we aren't
702 * currently ignoring physical transitions (which is what "virtual
703 * carrier" indicates).
704 *
705 * The transition of the virtual carrier to low really doesn't
706 * matter... it really only means "ignore carrier state", not
707 * "make pretend that carrier is there".
708 */
709 if ((virt_carrier == 0) && ((ch->ch_flags & CH_CD) != 0)
710 && (phys_carrier == 0)) {
711 /*
712 * When carrier drops:
713 *
714 * Drop carrier on all open units.
715 *
716 * Flush queues, waking up any task waiting in the
717 * line discipline.
718 *
719 * Send a hangup to the control terminal.
720 *
721 * Enable all select calls.
722 */
723 if (waitqueue_active(&(ch->ch_flags_wait)))
724 wake_up_interruptible(&ch->ch_flags_wait);
725 }
726
727 /*
728 * Make sure that our cached values reflect the current reality.
729 */
730 if (virt_carrier == 1)
731 ch->ch_flags |= CH_FCAR;
732 else
733 ch->ch_flags &= ~CH_FCAR;
734
735 if (phys_carrier == 1)
736 ch->ch_flags |= CH_CD;
737 else
738 ch->ch_flags &= ~CH_CD;
739}
740
741
742void jsm_check_queue_flow_control(struct jsm_channel *ch)
743{
Jesper Juhla58e00e2006-03-31 02:32:12 -0800744 struct board_ops *bd_ops = ch->ch_bd->bd_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700745 int qleft = 0;
746
747 /* Store how much space we have left in the queue */
748 if ((qleft = ch->ch_r_tail - ch->ch_r_head - 1) < 0)
749 qleft += RQUEUEMASK + 1;
750
751 /*
752 * Check to see if we should enforce flow control on our queue because
753 * the ld (or user) isn't reading data out of our queue fast enuf.
754 *
755 * NOTE: This is done based on what the current flow control of the
756 * port is set for.
757 *
758 * 1) HWFLOW (RTS) - Turn off the UART's Receive interrupt.
759 * This will cause the UART's FIFO to back up, and force
760 * the RTS signal to be dropped.
761 * 2) SWFLOW (IXOFF) - Keep trying to send a stop character to
762 * the other side, in hopes it will stop sending data to us.
763 * 3) NONE - Nothing we can do. We will simply drop any extra data
764 * that gets sent into us when the queue fills up.
765 */
766 if (qleft < 256) {
767 /* HWFLOW */
768 if (ch->ch_c_cflag & CRTSCTS) {
769 if(!(ch->ch_flags & CH_RECEIVER_OFF)) {
Jesper Juhla58e00e2006-03-31 02:32:12 -0800770 bd_ops->disable_receiver(ch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771 ch->ch_flags |= (CH_RECEIVER_OFF);
772 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev,
773 "Internal queue hit hilevel mark (%d)! Turning off interrupts.\n",
774 qleft);
775 }
776 }
777 /* SWFLOW */
778 else if (ch->ch_c_iflag & IXOFF) {
779 if (ch->ch_stops_sent <= MAX_STOPS_SENT) {
Jesper Juhla58e00e2006-03-31 02:32:12 -0800780 bd_ops->send_stop_character(ch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781 ch->ch_stops_sent++;
782 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev,
783 "Sending stop char! Times sent: %x\n", ch->ch_stops_sent);
784 }
785 }
786 }
787
788 /*
789 * Check to see if we should unenforce flow control because
790 * ld (or user) finally read enuf data out of our queue.
791 *
792 * NOTE: This is done based on what the current flow control of the
793 * port is set for.
794 *
795 * 1) HWFLOW (RTS) - Turn back on the UART's Receive interrupt.
796 * This will cause the UART's FIFO to raise RTS back up,
797 * which will allow the other side to start sending data again.
798 * 2) SWFLOW (IXOFF) - Send a start character to
799 * the other side, so it will start sending data to us again.
800 * 3) NONE - Do nothing. Since we didn't do anything to turn off the
801 * other side, we don't need to do anything now.
802 */
803 if (qleft > (RQUEUESIZE / 2)) {
804 /* HWFLOW */
805 if (ch->ch_c_cflag & CRTSCTS) {
806 if (ch->ch_flags & CH_RECEIVER_OFF) {
Jesper Juhla58e00e2006-03-31 02:32:12 -0800807 bd_ops->enable_receiver(ch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700808 ch->ch_flags &= ~(CH_RECEIVER_OFF);
809 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev,
810 "Internal queue hit lowlevel mark (%d)! Turning on interrupts.\n",
811 qleft);
812 }
813 }
814 /* SWFLOW */
815 else if (ch->ch_c_iflag & IXOFF && ch->ch_stops_sent) {
816 ch->ch_stops_sent = 0;
Jesper Juhla58e00e2006-03-31 02:32:12 -0800817 bd_ops->send_start_character(ch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700818 jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, "Sending start char!\n");
819 }
820 }
821}
822
823/*
824 * jsm_tty_write()
825 *
826 * Take data from the user or kernel and send it out to the FEP.
827 * In here exists all the Transparent Print magic as well.
828 */
829int jsm_tty_write(struct uart_port *port)
830{
831 int bufcount = 0, n = 0;
832 int data_count = 0,data_count1 =0;
833 u16 head;
834 u16 tail;
835 u16 tmask;
836 u32 remain;
837 int temp_tail = port->info->xmit.tail;
838 struct jsm_channel *channel = (struct jsm_channel *)port;
839
840 tmask = WQUEUEMASK;
841 head = (channel->ch_w_head) & tmask;
842 tail = (channel->ch_w_tail) & tmask;
843
844 if ((bufcount = tail - head - 1) < 0)
845 bufcount += WQUEUESIZE;
846
847 n = bufcount;
848
849 n = min(n, 56);
850 remain = WQUEUESIZE - head;
851
852 data_count = 0;
853 if (n >= remain) {
854 n -= remain;
855 while ((port->info->xmit.head != temp_tail) &&
856 (data_count < remain)) {
857 channel->ch_wqueue[head++] =
858 port->info->xmit.buf[temp_tail];
859
860 temp_tail++;
861 temp_tail &= (UART_XMIT_SIZE - 1);
862 data_count++;
863 }
864 if (data_count == remain) head = 0;
865 }
866
867 data_count1 = 0;
868 if (n > 0) {
869 remain = n;
870 while ((port->info->xmit.head != temp_tail) &&
871 (data_count1 < remain)) {
872 channel->ch_wqueue[head++] =
873 port->info->xmit.buf[temp_tail];
874
875 temp_tail++;
876 temp_tail &= (UART_XMIT_SIZE - 1);
877 data_count1++;
878
879 }
880 }
881
882 port->info->xmit.tail = temp_tail;
883
884 data_count += data_count1;
885 if (data_count) {
886 head &= tmask;
887 channel->ch_w_head = head;
888 }
889
890 if (data_count) {
891 channel->ch_bd->bd_ops->copy_data_from_queue_to_uart(channel);
892 }
893
894 return data_count;
895}