1 /*****************************************************************************/
3 * moxa.c -- MOXA Intellio family multiport serial driver.
5 * Copyright (C) 1999-2000 Moxa Technologies (support@moxa.com).
6 * Copyright (c) 2007 Jiri Slaby <jirislaby@gmail.com>
8 * This code is loosely based on the Linux serial driver, written by
9 * Linus Torvalds, Theodore T'so and others.
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or
14 * (at your option) any later version.
18 * MOXA Intellio Series Driver
24 #include <linux/module.h>
25 #include <linux/types.h>
27 #include <linux/ioport.h>
28 #include <linux/errno.h>
29 #include <linux/firmware.h>
30 #include <linux/signal.h>
31 #include <linux/sched.h>
32 #include <linux/timer.h>
33 #include <linux/interrupt.h>
34 #include <linux/tty.h>
35 #include <linux/tty_flip.h>
36 #include <linux/major.h>
37 #include <linux/string.h>
38 #include <linux/fcntl.h>
39 #include <linux/ptrace.h>
40 #include <linux/serial.h>
41 #include <linux/tty_driver.h>
42 #include <linux/delay.h>
43 #include <linux/pci.h>
44 #include <linux/init.h>
45 #include <linux/bitops.h>
46 #include <linux/slab.h>
47 #include <linux/ratelimit.h>
50 #include <asm/uaccess.h>
54 #define MOXA_VERSION "6.0k"
56 #define MOXA_FW_HDRLEN 32
60 #define MAX_BOARDS 4 /* Don't change this value */
61 #define MAX_PORTS_PER_BOARD 32 /* Don't change this value */
62 #define MAX_PORTS (MAX_BOARDS * MAX_PORTS_PER_BOARD)
64 #define MOXA_IS_320(brd) ((brd)->boardType == MOXA_BOARD_C320_ISA || \
65 (brd)->boardType == MOXA_BOARD_C320_PCI)
68 * Define the Moxa PCI vendor and device IDs.
70 #define MOXA_BUS_TYPE_ISA 0
71 #define MOXA_BUS_TYPE_PCI 1
74 MOXA_BOARD_C218_PCI
= 1,
81 static char *moxa_brdname
[] =
83 "C218 Turbo PCI series",
84 "C218 Turbo ISA series",
85 "C320 Turbo PCI series",
86 "C320 Turbo ISA series",
91 static struct pci_device_id moxa_pcibrds
[] = {
92 { PCI_DEVICE(PCI_VENDOR_ID_MOXA
, PCI_DEVICE_ID_MOXA_C218
),
93 .driver_data
= MOXA_BOARD_C218_PCI
},
94 { PCI_DEVICE(PCI_VENDOR_ID_MOXA
, PCI_DEVICE_ID_MOXA_C320
),
95 .driver_data
= MOXA_BOARD_C320_PCI
},
96 { PCI_DEVICE(PCI_VENDOR_ID_MOXA
, PCI_DEVICE_ID_MOXA_CP204J
),
97 .driver_data
= MOXA_BOARD_CP204J
},
100 MODULE_DEVICE_TABLE(pci
, moxa_pcibrds
);
101 #endif /* CONFIG_PCI */
105 static struct moxa_board_conf
{
112 struct moxa_port
*ports
;
114 void __iomem
*basemem
;
115 void __iomem
*intNdx
;
116 void __iomem
*intPend
;
117 void __iomem
*intTable
;
118 } moxa_boards
[MAX_BOARDS
];
120 struct mxser_mstatus
{
134 struct tty_port port
;
135 struct moxa_board_conf
*board
;
136 void __iomem
*tableAddr
;
140 unsigned long statusflags
;
142 u8 DCDState
; /* Protected by the port lock */
149 int rxcnt
[MAX_PORTS
];
150 int txcnt
[MAX_PORTS
];
158 #define SERIAL_DO_RESTART
160 #define WAKEUP_CHARS 256
162 static int ttymajor
= MOXAMAJOR
;
163 static struct mon_str moxaLog
;
164 static unsigned int moxaFuncTout
= HZ
/ 2;
165 static unsigned int moxaLowWaterChk
;
166 static DEFINE_MUTEX(moxa_openlock
);
167 static DEFINE_SPINLOCK(moxa_lock
);
169 static unsigned long baseaddr
[MAX_BOARDS
];
170 static unsigned int type
[MAX_BOARDS
];
171 static unsigned int numports
[MAX_BOARDS
];
172 static struct tty_port moxa_service_port
;
174 MODULE_AUTHOR("William Chen");
175 MODULE_DESCRIPTION("MOXA Intellio Family Multiport Board Device Driver");
176 MODULE_LICENSE("GPL");
177 MODULE_FIRMWARE("c218tunx.cod");
178 MODULE_FIRMWARE("cp204unx.cod");
179 MODULE_FIRMWARE("c320tunx.cod");
181 module_param_array(type
, uint
, NULL
, 0);
182 MODULE_PARM_DESC(type
, "card type: C218=2, C320=4");
183 module_param_array(baseaddr
, ulong
, NULL
, 0);
184 MODULE_PARM_DESC(baseaddr
, "base address");
185 module_param_array(numports
, uint
, NULL
, 0);
186 MODULE_PARM_DESC(numports
, "numports (ignored for C218)");
188 module_param(ttymajor
, int, 0);
193 static int moxa_open(struct tty_struct
*, struct file
*);
194 static void moxa_close(struct tty_struct
*, struct file
*);
195 static int moxa_write(struct tty_struct
*, const unsigned char *, int);
196 static int moxa_write_room(struct tty_struct
*);
197 static void moxa_flush_buffer(struct tty_struct
*);
198 static int moxa_chars_in_buffer(struct tty_struct
*);
199 static void moxa_set_termios(struct tty_struct
*, struct ktermios
*);
200 static void moxa_stop(struct tty_struct
*);
201 static void moxa_start(struct tty_struct
*);
202 static void moxa_hangup(struct tty_struct
*);
203 static int moxa_tiocmget(struct tty_struct
*tty
);
204 static int moxa_tiocmset(struct tty_struct
*tty
,
205 unsigned int set
, unsigned int clear
);
206 static void moxa_poll(unsigned long);
207 static void moxa_set_tty_param(struct tty_struct
*, struct ktermios
*);
208 static void moxa_shutdown(struct tty_port
*);
209 static int moxa_carrier_raised(struct tty_port
*);
210 static void moxa_dtr_rts(struct tty_port
*, int);
212 * moxa board interface functions:
214 static void MoxaPortEnable(struct moxa_port
*);
215 static void MoxaPortDisable(struct moxa_port
*);
216 static int MoxaPortSetTermio(struct moxa_port
*, struct ktermios
*, speed_t
);
217 static int MoxaPortGetLineOut(struct moxa_port
*, int *, int *);
218 static void MoxaPortLineCtrl(struct moxa_port
*, int, int);
219 static void MoxaPortFlowCtrl(struct moxa_port
*, int, int, int, int, int);
220 static int MoxaPortLineStatus(struct moxa_port
*);
221 static void MoxaPortFlushData(struct moxa_port
*, int);
222 static int MoxaPortWriteData(struct tty_struct
*, const unsigned char *, int);
223 static int MoxaPortReadData(struct moxa_port
*);
224 static int MoxaPortTxQueue(struct moxa_port
*);
225 static int MoxaPortRxQueue(struct moxa_port
*);
226 static int MoxaPortTxFree(struct moxa_port
*);
227 static void MoxaPortTxDisable(struct moxa_port
*);
228 static void MoxaPortTxEnable(struct moxa_port
*);
229 static int moxa_get_serial_info(struct moxa_port
*, struct serial_struct __user
*);
230 static int moxa_set_serial_info(struct moxa_port
*, struct serial_struct __user
*);
231 static void MoxaSetFifo(struct moxa_port
*port
, int enable
);
237 static DEFINE_SPINLOCK(moxafunc_lock
);
239 static void moxa_wait_finish(void __iomem
*ofsAddr
)
241 unsigned long end
= jiffies
+ moxaFuncTout
;
243 while (readw(ofsAddr
+ FuncCode
) != 0)
244 if (time_after(jiffies
, end
))
246 if (readw(ofsAddr
+ FuncCode
) != 0)
247 printk_ratelimited(KERN_WARNING
"moxa function expired\n");
250 static void moxafunc(void __iomem
*ofsAddr
, u16 cmd
, u16 arg
)
253 spin_lock_irqsave(&moxafunc_lock
, flags
);
254 writew(arg
, ofsAddr
+ FuncArg
);
255 writew(cmd
, ofsAddr
+ FuncCode
);
256 moxa_wait_finish(ofsAddr
);
257 spin_unlock_irqrestore(&moxafunc_lock
, flags
);
260 static int moxafuncret(void __iomem
*ofsAddr
, u16 cmd
, u16 arg
)
264 spin_lock_irqsave(&moxafunc_lock
, flags
);
265 writew(arg
, ofsAddr
+ FuncArg
);
266 writew(cmd
, ofsAddr
+ FuncCode
);
267 moxa_wait_finish(ofsAddr
);
268 ret
= readw(ofsAddr
+ FuncArg
);
269 spin_unlock_irqrestore(&moxafunc_lock
, flags
);
273 static void moxa_low_water_check(void __iomem
*ofsAddr
)
275 u16 rptr
, wptr
, mask
, len
;
277 if (readb(ofsAddr
+ FlagStat
) & Xoff_state
) {
278 rptr
= readw(ofsAddr
+ RXrptr
);
279 wptr
= readw(ofsAddr
+ RXwptr
);
280 mask
= readw(ofsAddr
+ RX_mask
);
281 len
= (wptr
- rptr
) & mask
;
282 if (len
<= Low_water
)
283 moxafunc(ofsAddr
, FC_SendXon
, 0);
291 static int moxa_ioctl(struct tty_struct
*tty
,
292 unsigned int cmd
, unsigned long arg
)
294 struct moxa_port
*ch
= tty
->driver_data
;
295 void __user
*argp
= (void __user
*)arg
;
298 if (tty
->index
== MAX_PORTS
) {
299 if (cmd
!= MOXA_GETDATACOUNT
&& cmd
!= MOXA_GET_IOQUEUE
&&
300 cmd
!= MOXA_GETMSTATUS
)
306 case MOXA_GETDATACOUNT
:
307 moxaLog
.tick
= jiffies
;
308 if (copy_to_user(argp
, &moxaLog
, sizeof(moxaLog
)))
311 case MOXA_FLUSH_QUEUE
:
312 MoxaPortFlushData(ch
, arg
);
314 case MOXA_GET_IOQUEUE
: {
315 struct moxaq_str __user
*argm
= argp
;
316 struct moxaq_str tmp
;
320 for (i
= 0; i
< MAX_BOARDS
; i
++) {
321 p
= moxa_boards
[i
].ports
;
322 for (j
= 0; j
< MAX_PORTS_PER_BOARD
; j
++, p
++, argm
++) {
323 memset(&tmp
, 0, sizeof(tmp
));
324 spin_lock_bh(&moxa_lock
);
325 if (moxa_boards
[i
].ready
) {
326 tmp
.inq
= MoxaPortRxQueue(p
);
327 tmp
.outq
= MoxaPortTxQueue(p
);
329 spin_unlock_bh(&moxa_lock
);
330 if (copy_to_user(argm
, &tmp
, sizeof(tmp
)))
335 } case MOXA_GET_OQUEUE
:
336 status
= MoxaPortTxQueue(ch
);
337 ret
= put_user(status
, (unsigned long __user
*)argp
);
339 case MOXA_GET_IQUEUE
:
340 status
= MoxaPortRxQueue(ch
);
341 ret
= put_user(status
, (unsigned long __user
*)argp
);
343 case MOXA_GETMSTATUS
: {
344 struct mxser_mstatus __user
*argm
= argp
;
345 struct mxser_mstatus tmp
;
349 for (i
= 0; i
< MAX_BOARDS
; i
++) {
350 p
= moxa_boards
[i
].ports
;
351 for (j
= 0; j
< MAX_PORTS_PER_BOARD
; j
++, p
++, argm
++) {
352 struct tty_struct
*ttyp
;
353 memset(&tmp
, 0, sizeof(tmp
));
354 spin_lock_bh(&moxa_lock
);
355 if (!moxa_boards
[i
].ready
) {
356 spin_unlock_bh(&moxa_lock
);
360 status
= MoxaPortLineStatus(p
);
361 spin_unlock_bh(&moxa_lock
);
370 ttyp
= tty_port_tty_get(&p
->port
);
372 tmp
.cflag
= p
->cflag
;
374 tmp
.cflag
= ttyp
->termios
.c_cflag
;
377 if (copy_to_user(argm
, &tmp
, sizeof(tmp
)))
384 mutex_lock(&ch
->port
.mutex
);
385 ret
= moxa_get_serial_info(ch
, argp
);
386 mutex_unlock(&ch
->port
.mutex
);
389 mutex_lock(&ch
->port
.mutex
);
390 ret
= moxa_set_serial_info(ch
, argp
);
391 mutex_unlock(&ch
->port
.mutex
);
399 static int moxa_break_ctl(struct tty_struct
*tty
, int state
)
401 struct moxa_port
*port
= tty
->driver_data
;
403 moxafunc(port
->tableAddr
, state
? FC_SendBreak
: FC_StopBreak
,
408 static const struct tty_operations moxa_ops
= {
412 .write_room
= moxa_write_room
,
413 .flush_buffer
= moxa_flush_buffer
,
414 .chars_in_buffer
= moxa_chars_in_buffer
,
416 .set_termios
= moxa_set_termios
,
419 .hangup
= moxa_hangup
,
420 .break_ctl
= moxa_break_ctl
,
421 .tiocmget
= moxa_tiocmget
,
422 .tiocmset
= moxa_tiocmset
,
425 static const struct tty_port_operations moxa_port_ops
= {
426 .carrier_raised
= moxa_carrier_raised
,
427 .dtr_rts
= moxa_dtr_rts
,
428 .shutdown
= moxa_shutdown
,
431 static struct tty_driver
*moxaDriver
;
432 static DEFINE_TIMER(moxaTimer
, moxa_poll
, 0, 0);
438 static int moxa_check_fw_model(struct moxa_board_conf
*brd
, u8 model
)
440 switch (brd
->boardType
) {
441 case MOXA_BOARD_C218_ISA
:
442 case MOXA_BOARD_C218_PCI
:
446 case MOXA_BOARD_CP204J
:
460 static int moxa_check_fw(const void *ptr
)
462 const __le16
*lptr
= ptr
;
464 if (*lptr
!= cpu_to_le16(0x7980))
470 static int moxa_load_bios(struct moxa_board_conf
*brd
, const u8
*buf
,
473 void __iomem
*baseAddr
= brd
->basemem
;
476 writeb(HW_reset
, baseAddr
+ Control_reg
); /* reset */
478 memset_io(baseAddr
, 0, 4096);
479 memcpy_toio(baseAddr
, buf
, len
); /* download BIOS */
480 writeb(0, baseAddr
+ Control_reg
); /* restart */
484 switch (brd
->boardType
) {
485 case MOXA_BOARD_C218_ISA
:
486 case MOXA_BOARD_C218_PCI
:
487 tmp
= readw(baseAddr
+ C218_key
);
488 if (tmp
!= C218_KeyCode
)
491 case MOXA_BOARD_CP204J
:
492 tmp
= readw(baseAddr
+ C218_key
);
493 if (tmp
!= CP204J_KeyCode
)
497 tmp
= readw(baseAddr
+ C320_key
);
498 if (tmp
!= C320_KeyCode
)
500 tmp
= readw(baseAddr
+ C320_status
);
501 if (tmp
!= STS_init
) {
502 printk(KERN_ERR
"MOXA: bios upload failed -- CPU/Basic "
503 "module not found\n");
511 printk(KERN_ERR
"MOXA: bios upload failed -- board not found\n");
515 static int moxa_load_320b(struct moxa_board_conf
*brd
, const u8
*ptr
,
518 void __iomem
*baseAddr
= brd
->basemem
;
521 printk(KERN_ERR
"MOXA: invalid 320 bios -- too short\n");
525 writew(len
- 7168 - 2, baseAddr
+ C320bapi_len
);
526 writeb(1, baseAddr
+ Control_reg
); /* Select Page 1 */
527 memcpy_toio(baseAddr
+ DynPage_addr
, ptr
, 7168);
528 writeb(2, baseAddr
+ Control_reg
); /* Select Page 2 */
529 memcpy_toio(baseAddr
+ DynPage_addr
, ptr
+ 7168, len
- 7168);
534 static int moxa_real_load_code(struct moxa_board_conf
*brd
, const void *ptr
,
537 void __iomem
*baseAddr
= brd
->basemem
;
538 const __le16
*uptr
= ptr
;
539 size_t wlen
, len2
, j
;
540 unsigned long key
, loadbuf
, loadlen
, checksum
, checksum_ok
;
541 unsigned int i
, retry
;
544 keycode
= (brd
->boardType
== MOXA_BOARD_CP204J
) ? CP204J_KeyCode
:
547 switch (brd
->boardType
) {
548 case MOXA_BOARD_CP204J
:
549 case MOXA_BOARD_C218_ISA
:
550 case MOXA_BOARD_C218_PCI
:
552 loadbuf
= C218_LoadBuf
;
553 loadlen
= C218DLoad_len
;
554 checksum
= C218check_sum
;
555 checksum_ok
= C218chksum_ok
;
559 keycode
= C320_KeyCode
;
560 loadbuf
= C320_LoadBuf
;
561 loadlen
= C320DLoad_len
;
562 checksum
= C320check_sum
;
563 checksum_ok
= C320chksum_ok
;
569 for (i
= 0; i
< wlen
; i
++)
570 usum
+= le16_to_cpu(uptr
[i
]);
576 len2
= (wlen
> 2048) ? 2048 : wlen
;
578 memcpy_toio(baseAddr
+ loadbuf
, ptr
+ j
, len2
<< 1);
581 writew(len2
, baseAddr
+ loadlen
);
582 writew(0, baseAddr
+ key
);
583 for (i
= 0; i
< 100; i
++) {
584 if (readw(baseAddr
+ key
) == keycode
)
588 if (readw(baseAddr
+ key
) != keycode
)
591 writew(0, baseAddr
+ loadlen
);
592 writew(usum
, baseAddr
+ checksum
);
593 writew(0, baseAddr
+ key
);
594 for (i
= 0; i
< 100; i
++) {
595 if (readw(baseAddr
+ key
) == keycode
)
600 } while ((readb(baseAddr
+ checksum_ok
) != 1) && (retry
< 3));
601 if (readb(baseAddr
+ checksum_ok
) != 1)
604 writew(0, baseAddr
+ key
);
605 for (i
= 0; i
< 600; i
++) {
606 if (readw(baseAddr
+ Magic_no
) == Magic_code
)
610 if (readw(baseAddr
+ Magic_no
) != Magic_code
)
613 if (MOXA_IS_320(brd
)) {
614 if (brd
->busType
== MOXA_BUS_TYPE_PCI
) { /* ASIC board */
615 writew(0x3800, baseAddr
+ TMS320_PORT1
);
616 writew(0x3900, baseAddr
+ TMS320_PORT2
);
617 writew(28499, baseAddr
+ TMS320_CLOCK
);
619 writew(0x3200, baseAddr
+ TMS320_PORT1
);
620 writew(0x3400, baseAddr
+ TMS320_PORT2
);
621 writew(19999, baseAddr
+ TMS320_CLOCK
);
624 writew(1, baseAddr
+ Disable_IRQ
);
625 writew(0, baseAddr
+ Magic_no
);
626 for (i
= 0; i
< 500; i
++) {
627 if (readw(baseAddr
+ Magic_no
) == Magic_code
)
631 if (readw(baseAddr
+ Magic_no
) != Magic_code
)
634 if (MOXA_IS_320(brd
)) {
635 j
= readw(baseAddr
+ Module_cnt
);
638 brd
->numPorts
= j
* 8;
639 writew(j
, baseAddr
+ Module_no
);
640 writew(0, baseAddr
+ Magic_no
);
641 for (i
= 0; i
< 600; i
++) {
642 if (readw(baseAddr
+ Magic_no
) == Magic_code
)
646 if (readw(baseAddr
+ Magic_no
) != Magic_code
)
649 brd
->intNdx
= baseAddr
+ IRQindex
;
650 brd
->intPend
= baseAddr
+ IRQpending
;
651 brd
->intTable
= baseAddr
+ IRQtable
;
656 static int moxa_load_code(struct moxa_board_conf
*brd
, const void *ptr
,
659 void __iomem
*ofsAddr
, *baseAddr
= brd
->basemem
;
660 struct moxa_port
*port
;
664 printk(KERN_ERR
"MOXA: bios length is not even\n");
668 retval
= moxa_real_load_code(brd
, ptr
, len
); /* may change numPorts */
672 switch (brd
->boardType
) {
673 case MOXA_BOARD_C218_ISA
:
674 case MOXA_BOARD_C218_PCI
:
675 case MOXA_BOARD_CP204J
:
677 for (i
= 0; i
< brd
->numPorts
; i
++, port
++) {
680 port
->tableAddr
= baseAddr
+ Extern_table
+
682 ofsAddr
= port
->tableAddr
;
683 writew(C218rx_mask
, ofsAddr
+ RX_mask
);
684 writew(C218tx_mask
, ofsAddr
+ TX_mask
);
685 writew(C218rx_spage
+ i
* C218buf_pageno
, ofsAddr
+ Page_rxb
);
686 writew(readw(ofsAddr
+ Page_rxb
) + C218rx_pageno
, ofsAddr
+ EndPage_rxb
);
688 writew(C218tx_spage
+ i
* C218buf_pageno
, ofsAddr
+ Page_txb
);
689 writew(readw(ofsAddr
+ Page_txb
) + C218tx_pageno
, ofsAddr
+ EndPage_txb
);
695 for (i
= 0; i
< brd
->numPorts
; i
++, port
++) {
698 port
->tableAddr
= baseAddr
+ Extern_table
+
700 ofsAddr
= port
->tableAddr
;
701 switch (brd
->numPorts
) {
703 writew(C320p8rx_mask
, ofsAddr
+ RX_mask
);
704 writew(C320p8tx_mask
, ofsAddr
+ TX_mask
);
705 writew(C320p8rx_spage
+ i
* C320p8buf_pgno
, ofsAddr
+ Page_rxb
);
706 writew(readw(ofsAddr
+ Page_rxb
) + C320p8rx_pgno
, ofsAddr
+ EndPage_rxb
);
707 writew(C320p8tx_spage
+ i
* C320p8buf_pgno
, ofsAddr
+ Page_txb
);
708 writew(readw(ofsAddr
+ Page_txb
) + C320p8tx_pgno
, ofsAddr
+ EndPage_txb
);
712 writew(C320p16rx_mask
, ofsAddr
+ RX_mask
);
713 writew(C320p16tx_mask
, ofsAddr
+ TX_mask
);
714 writew(C320p16rx_spage
+ i
* C320p16buf_pgno
, ofsAddr
+ Page_rxb
);
715 writew(readw(ofsAddr
+ Page_rxb
) + C320p16rx_pgno
, ofsAddr
+ EndPage_rxb
);
716 writew(C320p16tx_spage
+ i
* C320p16buf_pgno
, ofsAddr
+ Page_txb
);
717 writew(readw(ofsAddr
+ Page_txb
) + C320p16tx_pgno
, ofsAddr
+ EndPage_txb
);
721 writew(C320p24rx_mask
, ofsAddr
+ RX_mask
);
722 writew(C320p24tx_mask
, ofsAddr
+ TX_mask
);
723 writew(C320p24rx_spage
+ i
* C320p24buf_pgno
, ofsAddr
+ Page_rxb
);
724 writew(readw(ofsAddr
+ Page_rxb
) + C320p24rx_pgno
, ofsAddr
+ EndPage_rxb
);
725 writew(C320p24tx_spage
+ i
* C320p24buf_pgno
, ofsAddr
+ Page_txb
);
726 writew(readw(ofsAddr
+ Page_txb
), ofsAddr
+ EndPage_txb
);
729 writew(C320p32rx_mask
, ofsAddr
+ RX_mask
);
730 writew(C320p32tx_mask
, ofsAddr
+ TX_mask
);
731 writew(C320p32tx_ofs
, ofsAddr
+ Ofs_txb
);
732 writew(C320p32rx_spage
+ i
* C320p32buf_pgno
, ofsAddr
+ Page_rxb
);
733 writew(readb(ofsAddr
+ Page_rxb
), ofsAddr
+ EndPage_rxb
);
734 writew(C320p32tx_spage
+ i
* C320p32buf_pgno
, ofsAddr
+ Page_txb
);
735 writew(readw(ofsAddr
+ Page_txb
), ofsAddr
+ EndPage_txb
);
744 static int moxa_load_fw(struct moxa_board_conf
*brd
, const struct firmware
*fw
)
746 const void *ptr
= fw
->data
;
750 unsigned int a
, lenp
, lencnt
;
753 __le32 magic
; /* 0x34303430 */
755 u8 type
; /* UNIX = 3 */
756 u8 model
; /* C218T=1, C320T=2, CP204=3 */
761 BUILD_BUG_ON(ARRAY_SIZE(hdr
->len
) != ARRAY_SIZE(lens
));
763 if (fw
->size
< MOXA_FW_HDRLEN
) {
764 strcpy(rsn
, "too short (even header won't fit)");
767 if (hdr
->magic
!= cpu_to_le32(0x30343034)) {
768 sprintf(rsn
, "bad magic: %.8x", le32_to_cpu(hdr
->magic
));
771 if (hdr
->type
!= 3) {
772 sprintf(rsn
, "not for linux, type is %u", hdr
->type
);
775 if (moxa_check_fw_model(brd
, hdr
->model
)) {
776 sprintf(rsn
, "not for this card, model is %u", hdr
->model
);
780 len
= MOXA_FW_HDRLEN
;
781 lencnt
= hdr
->model
== 2 ? 5 : 3;
782 for (a
= 0; a
< ARRAY_SIZE(lens
); a
++) {
783 lens
[a
] = le16_to_cpu(hdr
->len
[a
]);
784 if (lens
[a
] && len
+ lens
[a
] <= fw
->size
&&
785 moxa_check_fw(&fw
->data
[len
]))
786 printk(KERN_WARNING
"MOXA firmware: unexpected input "
787 "at offset %u, but going on\n", (u32
)len
);
788 if (!lens
[a
] && a
< lencnt
) {
789 sprintf(rsn
, "too few entries in fw file");
795 if (len
!= fw
->size
) {
796 sprintf(rsn
, "bad length: %u (should be %u)", (u32
)fw
->size
,
801 ptr
+= MOXA_FW_HDRLEN
;
804 strcpy(rsn
, "read above");
806 ret
= moxa_load_bios(brd
, ptr
, lens
[lenp
]);
810 /* we skip the tty section (lens[1]), since we don't need it */
811 ptr
+= lens
[lenp
] + lens
[lenp
+ 1];
812 lenp
+= 2; /* comm */
814 if (hdr
->model
== 2) {
815 ret
= moxa_load_320b(brd
, ptr
, lens
[lenp
]);
818 /* skip another tty */
819 ptr
+= lens
[lenp
] + lens
[lenp
+ 1];
823 ret
= moxa_load_code(brd
, ptr
, lens
[lenp
]);
829 printk(KERN_ERR
"firmware failed to load, reason: %s\n", rsn
);
833 static int moxa_init_board(struct moxa_board_conf
*brd
, struct device
*dev
)
835 const struct firmware
*fw
;
838 unsigned int i
, first_idx
;
841 brd
->ports
= kcalloc(MAX_PORTS_PER_BOARD
, sizeof(*brd
->ports
),
843 if (brd
->ports
== NULL
) {
844 printk(KERN_ERR
"cannot allocate memory for ports\n");
849 for (i
= 0, p
= brd
->ports
; i
< MAX_PORTS_PER_BOARD
; i
++, p
++) {
850 tty_port_init(&p
->port
);
851 p
->port
.ops
= &moxa_port_ops
;
852 p
->type
= PORT_16550A
;
853 p
->cflag
= B9600
| CS8
| CREAD
| CLOCAL
| HUPCL
;
856 switch (brd
->boardType
) {
857 case MOXA_BOARD_C218_ISA
:
858 case MOXA_BOARD_C218_PCI
:
859 file
= "c218tunx.cod";
861 case MOXA_BOARD_CP204J
:
862 file
= "cp204unx.cod";
865 file
= "c320tunx.cod";
869 ret
= request_firmware(&fw
, file
, dev
);
871 printk(KERN_ERR
"MOXA: request_firmware failed. Make sure "
872 "you've placed '%s' file into your firmware "
873 "loader directory (e.g. /lib/firmware)\n",
878 ret
= moxa_load_fw(brd
, fw
);
880 release_firmware(fw
);
885 spin_lock_bh(&moxa_lock
);
887 if (!timer_pending(&moxaTimer
))
888 mod_timer(&moxaTimer
, jiffies
+ HZ
/ 50);
889 spin_unlock_bh(&moxa_lock
);
891 first_idx
= (brd
- moxa_boards
) * MAX_PORTS_PER_BOARD
;
892 for (i
= 0; i
< brd
->numPorts
; i
++)
893 tty_port_register_device(&brd
->ports
[i
].port
, moxaDriver
,
903 static void moxa_board_deinit(struct moxa_board_conf
*brd
)
905 unsigned int a
, opened
, first_idx
;
907 mutex_lock(&moxa_openlock
);
908 spin_lock_bh(&moxa_lock
);
910 spin_unlock_bh(&moxa_lock
);
912 /* pci hot-un-plug support */
913 for (a
= 0; a
< brd
->numPorts
; a
++)
914 if (brd
->ports
[a
].port
.flags
& ASYNC_INITIALIZED
) {
915 struct tty_struct
*tty
= tty_port_tty_get(
916 &brd
->ports
[a
].port
);
924 for (a
= 0; a
< brd
->numPorts
; a
++)
925 if (brd
->ports
[a
].port
.flags
& ASYNC_INITIALIZED
)
927 mutex_unlock(&moxa_openlock
);
931 mutex_lock(&moxa_openlock
);
934 first_idx
= (brd
- moxa_boards
) * MAX_PORTS_PER_BOARD
;
935 for (a
= 0; a
< brd
->numPorts
; a
++)
936 tty_unregister_device(moxaDriver
, first_idx
+ a
);
938 iounmap(brd
->basemem
);
944 static int __devinit
moxa_pci_probe(struct pci_dev
*pdev
,
945 const struct pci_device_id
*ent
)
947 struct moxa_board_conf
*board
;
949 int board_type
= ent
->driver_data
;
952 retval
= pci_enable_device(pdev
);
954 dev_err(&pdev
->dev
, "can't enable pci device\n");
958 for (i
= 0; i
< MAX_BOARDS
; i
++)
959 if (moxa_boards
[i
].basemem
== NULL
)
963 if (i
>= MAX_BOARDS
) {
964 dev_warn(&pdev
->dev
, "more than %u MOXA Intellio family boards "
965 "found. Board is ignored.\n", MAX_BOARDS
);
969 board
= &moxa_boards
[i
];
971 retval
= pci_request_region(pdev
, 2, "moxa-base");
973 dev_err(&pdev
->dev
, "can't request pci region 2\n");
977 board
->basemem
= ioremap_nocache(pci_resource_start(pdev
, 2), 0x4000);
978 if (board
->basemem
== NULL
) {
979 dev_err(&pdev
->dev
, "can't remap io space 2\n");
983 board
->boardType
= board_type
;
984 switch (board_type
) {
985 case MOXA_BOARD_C218_ISA
:
986 case MOXA_BOARD_C218_PCI
:
990 case MOXA_BOARD_CP204J
:
997 board
->busType
= MOXA_BUS_TYPE_PCI
;
999 retval
= moxa_init_board(board
, &pdev
->dev
);
1003 pci_set_drvdata(pdev
, board
);
1005 dev_info(&pdev
->dev
, "board '%s' ready (%u ports, firmware loaded)\n",
1006 moxa_brdname
[board_type
- 1], board
->numPorts
);
1010 iounmap(board
->basemem
);
1011 board
->basemem
= NULL
;
1013 pci_release_region(pdev
, 2);
1018 static void __devexit
moxa_pci_remove(struct pci_dev
*pdev
)
1020 struct moxa_board_conf
*brd
= pci_get_drvdata(pdev
);
1022 moxa_board_deinit(brd
);
1024 pci_release_region(pdev
, 2);
1027 static struct pci_driver moxa_pci_driver
= {
1029 .id_table
= moxa_pcibrds
,
1030 .probe
= moxa_pci_probe
,
1031 .remove
= __devexit_p(moxa_pci_remove
)
1033 #endif /* CONFIG_PCI */
1035 static int __init
moxa_init(void)
1037 unsigned int isabrds
= 0;
1039 struct moxa_board_conf
*brd
= moxa_boards
;
1042 printk(KERN_INFO
"MOXA Intellio family driver version %s\n",
1045 tty_port_init(&moxa_service_port
);
1047 moxaDriver
= tty_alloc_driver(MAX_PORTS
+ 1,
1048 TTY_DRIVER_REAL_RAW
|
1049 TTY_DRIVER_DYNAMIC_DEV
);
1053 moxaDriver
->name
= "ttyMX";
1054 moxaDriver
->major
= ttymajor
;
1055 moxaDriver
->minor_start
= 0;
1056 moxaDriver
->type
= TTY_DRIVER_TYPE_SERIAL
;
1057 moxaDriver
->subtype
= SERIAL_TYPE_NORMAL
;
1058 moxaDriver
->init_termios
= tty_std_termios
;
1059 moxaDriver
->init_termios
.c_cflag
= B9600
| CS8
| CREAD
| CLOCAL
| HUPCL
;
1060 moxaDriver
->init_termios
.c_ispeed
= 9600;
1061 moxaDriver
->init_termios
.c_ospeed
= 9600;
1062 tty_set_operations(moxaDriver
, &moxa_ops
);
1063 /* Having one more port only for ioctls is ugly */
1064 tty_port_link_device(&moxa_service_port
, moxaDriver
, MAX_PORTS
);
1066 if (tty_register_driver(moxaDriver
)) {
1067 printk(KERN_ERR
"can't register MOXA Smartio tty driver!\n");
1068 put_tty_driver(moxaDriver
);
1072 /* Find the boards defined from module args. */
1074 for (i
= 0; i
< MAX_BOARDS
; i
++) {
1077 if (type
[i
] == MOXA_BOARD_C218_ISA
||
1078 type
[i
] == MOXA_BOARD_C320_ISA
) {
1079 pr_debug("Moxa board %2d: %s board(baseAddr=%lx)\n",
1080 isabrds
+ 1, moxa_brdname
[type
[i
] - 1],
1082 brd
->boardType
= type
[i
];
1083 brd
->numPorts
= type
[i
] == MOXA_BOARD_C218_ISA
? 8 :
1085 brd
->busType
= MOXA_BUS_TYPE_ISA
;
1086 brd
->basemem
= ioremap_nocache(baseaddr
[i
], 0x4000);
1087 if (!brd
->basemem
) {
1088 printk(KERN_ERR
"MOXA: can't remap %lx\n",
1092 if (moxa_init_board(brd
, NULL
)) {
1093 iounmap(brd
->basemem
);
1094 brd
->basemem
= NULL
;
1098 printk(KERN_INFO
"MOXA isa board found at 0x%.8lu and "
1099 "ready (%u ports, firmware loaded)\n",
1100 baseaddr
[i
], brd
->numPorts
);
1108 retval
= pci_register_driver(&moxa_pci_driver
);
1110 printk(KERN_ERR
"Can't register MOXA pci driver!\n");
1119 static void __exit
moxa_exit(void)
1124 pci_unregister_driver(&moxa_pci_driver
);
1127 for (i
= 0; i
< MAX_BOARDS
; i
++) /* ISA boards */
1128 if (moxa_boards
[i
].ready
)
1129 moxa_board_deinit(&moxa_boards
[i
]);
1131 del_timer_sync(&moxaTimer
);
1133 if (tty_unregister_driver(moxaDriver
))
1134 printk(KERN_ERR
"Couldn't unregister MOXA Intellio family "
1136 put_tty_driver(moxaDriver
);
1139 module_init(moxa_init
);
1140 module_exit(moxa_exit
);
1142 static void moxa_shutdown(struct tty_port
*port
)
1144 struct moxa_port
*ch
= container_of(port
, struct moxa_port
, port
);
1145 MoxaPortDisable(ch
);
1146 MoxaPortFlushData(ch
, 2);
1149 static int moxa_carrier_raised(struct tty_port
*port
)
1151 struct moxa_port
*ch
= container_of(port
, struct moxa_port
, port
);
1154 spin_lock_irq(&port
->lock
);
1156 spin_unlock_irq(&port
->lock
);
1160 static void moxa_dtr_rts(struct tty_port
*port
, int onoff
)
1162 struct moxa_port
*ch
= container_of(port
, struct moxa_port
, port
);
1163 MoxaPortLineCtrl(ch
, onoff
, onoff
);
1167 static int moxa_open(struct tty_struct
*tty
, struct file
*filp
)
1169 struct moxa_board_conf
*brd
;
1170 struct moxa_port
*ch
;
1174 if (port
== MAX_PORTS
) {
1175 return capable(CAP_SYS_ADMIN
) ? 0 : -EPERM
;
1177 if (mutex_lock_interruptible(&moxa_openlock
))
1178 return -ERESTARTSYS
;
1179 brd
= &moxa_boards
[port
/ MAX_PORTS_PER_BOARD
];
1181 mutex_unlock(&moxa_openlock
);
1185 if (port
% MAX_PORTS_PER_BOARD
>= brd
->numPorts
) {
1186 mutex_unlock(&moxa_openlock
);
1190 ch
= &brd
->ports
[port
% MAX_PORTS_PER_BOARD
];
1192 tty
->driver_data
= ch
;
1193 tty_port_tty_set(&ch
->port
, tty
);
1194 mutex_lock(&ch
->port
.mutex
);
1195 if (!(ch
->port
.flags
& ASYNC_INITIALIZED
)) {
1196 ch
->statusflags
= 0;
1197 moxa_set_tty_param(tty
, &tty
->termios
);
1198 MoxaPortLineCtrl(ch
, 1, 1);
1200 MoxaSetFifo(ch
, ch
->type
== PORT_16550A
);
1201 ch
->port
.flags
|= ASYNC_INITIALIZED
;
1203 mutex_unlock(&ch
->port
.mutex
);
1204 mutex_unlock(&moxa_openlock
);
1206 return tty_port_block_til_ready(&ch
->port
, tty
, filp
);
1209 static void moxa_close(struct tty_struct
*tty
, struct file
*filp
)
1211 struct moxa_port
*ch
= tty
->driver_data
;
1212 ch
->cflag
= tty
->termios
.c_cflag
;
1213 tty_port_close(&ch
->port
, tty
, filp
);
1216 static int moxa_write(struct tty_struct
*tty
,
1217 const unsigned char *buf
, int count
)
1219 struct moxa_port
*ch
= tty
->driver_data
;
1220 unsigned long flags
;
1226 spin_lock_irqsave(&moxa_lock
, flags
);
1227 len
= MoxaPortWriteData(tty
, buf
, count
);
1228 spin_unlock_irqrestore(&moxa_lock
, flags
);
1230 set_bit(LOWWAIT
, &ch
->statusflags
);
1234 static int moxa_write_room(struct tty_struct
*tty
)
1236 struct moxa_port
*ch
;
1240 ch
= tty
->driver_data
;
1243 return MoxaPortTxFree(ch
);
1246 static void moxa_flush_buffer(struct tty_struct
*tty
)
1248 struct moxa_port
*ch
= tty
->driver_data
;
1252 MoxaPortFlushData(ch
, 1);
1256 static int moxa_chars_in_buffer(struct tty_struct
*tty
)
1258 struct moxa_port
*ch
= tty
->driver_data
;
1261 chars
= MoxaPortTxQueue(ch
);
1264 * Make it possible to wakeup anything waiting for output
1265 * in tty_ioctl.c, etc.
1267 set_bit(EMPTYWAIT
, &ch
->statusflags
);
1271 static int moxa_tiocmget(struct tty_struct
*tty
)
1273 struct moxa_port
*ch
= tty
->driver_data
;
1274 int flag
= 0, dtr
, rts
;
1276 MoxaPortGetLineOut(ch
, &dtr
, &rts
);
1281 dtr
= MoxaPortLineStatus(ch
);
1291 static int moxa_tiocmset(struct tty_struct
*tty
,
1292 unsigned int set
, unsigned int clear
)
1294 struct moxa_port
*ch
;
1297 mutex_lock(&moxa_openlock
);
1298 ch
= tty
->driver_data
;
1300 mutex_unlock(&moxa_openlock
);
1304 MoxaPortGetLineOut(ch
, &dtr
, &rts
);
1305 if (set
& TIOCM_RTS
)
1307 if (set
& TIOCM_DTR
)
1309 if (clear
& TIOCM_RTS
)
1311 if (clear
& TIOCM_DTR
)
1313 MoxaPortLineCtrl(ch
, dtr
, rts
);
1314 mutex_unlock(&moxa_openlock
);
1318 static void moxa_set_termios(struct tty_struct
*tty
,
1319 struct ktermios
*old_termios
)
1321 struct moxa_port
*ch
= tty
->driver_data
;
1325 moxa_set_tty_param(tty
, old_termios
);
1326 if (!(old_termios
->c_cflag
& CLOCAL
) && C_CLOCAL(tty
))
1327 wake_up_interruptible(&ch
->port
.open_wait
);
1330 static void moxa_stop(struct tty_struct
*tty
)
1332 struct moxa_port
*ch
= tty
->driver_data
;
1336 MoxaPortTxDisable(ch
);
1337 set_bit(TXSTOPPED
, &ch
->statusflags
);
1341 static void moxa_start(struct tty_struct
*tty
)
1343 struct moxa_port
*ch
= tty
->driver_data
;
1348 if (!test_bit(TXSTOPPED
, &ch
->statusflags
))
1351 MoxaPortTxEnable(ch
);
1352 clear_bit(TXSTOPPED
, &ch
->statusflags
);
1355 static void moxa_hangup(struct tty_struct
*tty
)
1357 struct moxa_port
*ch
= tty
->driver_data
;
1358 tty_port_hangup(&ch
->port
);
1361 static void moxa_new_dcdstate(struct moxa_port
*p
, u8 dcd
)
1363 struct tty_struct
*tty
;
1364 unsigned long flags
;
1367 spin_lock_irqsave(&p
->port
.lock
, flags
);
1368 if (dcd
!= p
->DCDState
) {
1370 spin_unlock_irqrestore(&p
->port
.lock
, flags
);
1371 tty
= tty_port_tty_get(&p
->port
);
1372 if (tty
&& C_CLOCAL(tty
) && !dcd
)
1377 spin_unlock_irqrestore(&p
->port
.lock
, flags
);
1380 static int moxa_poll_port(struct moxa_port
*p
, unsigned int handle
,
1383 struct tty_struct
*tty
= tty_port_tty_get(&p
->port
);
1384 void __iomem
*ofsAddr
;
1385 unsigned int inited
= p
->port
.flags
& ASYNC_INITIALIZED
;
1389 if (test_bit(EMPTYWAIT
, &p
->statusflags
) &&
1390 MoxaPortTxQueue(p
) == 0) {
1391 clear_bit(EMPTYWAIT
, &p
->statusflags
);
1394 if (test_bit(LOWWAIT
, &p
->statusflags
) && !tty
->stopped
&&
1395 MoxaPortTxQueue(p
) <= WAKEUP_CHARS
) {
1396 clear_bit(LOWWAIT
, &p
->statusflags
);
1400 if (inited
&& !test_bit(TTY_THROTTLED
, &tty
->flags
) &&
1401 MoxaPortRxQueue(p
) > 0) { /* RX */
1402 MoxaPortReadData(p
);
1403 tty_schedule_flip(tty
);
1406 clear_bit(EMPTYWAIT
, &p
->statusflags
);
1407 MoxaPortFlushData(p
, 0); /* flush RX */
1410 if (!handle
) /* nothing else to do */
1413 intr
= readw(ip
); /* port irq status */
1417 writew(0, ip
); /* ACK port */
1418 ofsAddr
= p
->tableAddr
;
1419 if (intr
& IntrTx
) /* disable tx intr */
1420 writew(readw(ofsAddr
+ HostStat
) & ~WakeupTx
,
1421 ofsAddr
+ HostStat
);
1426 if (tty
&& (intr
& IntrBreak
) && !I_IGNBRK(tty
)) { /* BREAK */
1427 tty_insert_flip_char(tty
, 0, TTY_BREAK
);
1428 tty_schedule_flip(tty
);
1431 if (intr
& IntrLine
)
1432 moxa_new_dcdstate(p
, readb(ofsAddr
+ FlagStat
) & DCD_state
);
1439 static void moxa_poll(unsigned long ignored
)
1441 struct moxa_board_conf
*brd
;
1443 unsigned int card
, port
, served
= 0;
1445 spin_lock(&moxa_lock
);
1446 for (card
= 0; card
< MAX_BOARDS
; card
++) {
1447 brd
= &moxa_boards
[card
];
1454 if (readb(brd
->intPend
) == 0xff)
1455 ip
= brd
->intTable
+ readb(brd
->intNdx
);
1457 for (port
= 0; port
< brd
->numPorts
; port
++)
1458 moxa_poll_port(&brd
->ports
[port
], !!ip
, ip
+ port
);
1461 writeb(0, brd
->intPend
); /* ACK */
1463 if (moxaLowWaterChk
) {
1464 struct moxa_port
*p
= brd
->ports
;
1465 for (port
= 0; port
< brd
->numPorts
; port
++, p
++)
1466 if (p
->lowChkFlag
) {
1468 moxa_low_water_check(p
->tableAddr
);
1472 moxaLowWaterChk
= 0;
1475 mod_timer(&moxaTimer
, jiffies
+ HZ
/ 50);
1476 spin_unlock(&moxa_lock
);
1479 /******************************************************************************/
1481 static void moxa_set_tty_param(struct tty_struct
*tty
, struct ktermios
*old_termios
)
1483 register struct ktermios
*ts
= &tty
->termios
;
1484 struct moxa_port
*ch
= tty
->driver_data
;
1485 int rts
, cts
, txflow
, rxflow
, xany
, baud
;
1487 rts
= cts
= txflow
= rxflow
= xany
= 0;
1488 if (ts
->c_cflag
& CRTSCTS
)
1490 if (ts
->c_iflag
& IXON
)
1492 if (ts
->c_iflag
& IXOFF
)
1494 if (ts
->c_iflag
& IXANY
)
1497 /* Clear the features we don't support */
1498 ts
->c_cflag
&= ~CMSPAR
;
1499 MoxaPortFlowCtrl(ch
, rts
, cts
, txflow
, rxflow
, xany
);
1500 baud
= MoxaPortSetTermio(ch
, ts
, tty_get_baud_rate(tty
));
1502 baud
= tty_termios_baud_rate(old_termios
);
1503 /* Not put the baud rate into the termios data */
1504 tty_encode_baud_rate(tty
, baud
, baud
);
1507 /*****************************************************************************
1508 * Driver level functions: *
1509 *****************************************************************************/
1511 static void MoxaPortFlushData(struct moxa_port
*port
, int mode
)
1513 void __iomem
*ofsAddr
;
1514 if (mode
< 0 || mode
> 2)
1516 ofsAddr
= port
->tableAddr
;
1517 moxafunc(ofsAddr
, FC_FlushQueue
, mode
);
1519 port
->lowChkFlag
= 0;
1520 moxa_low_water_check(ofsAddr
);
1525 * Moxa Port Number Description:
1527 * MOXA serial driver supports up to 4 MOXA-C218/C320 boards. And,
1528 * the port number using in MOXA driver functions will be 0 to 31 for
1529 * first MOXA board, 32 to 63 for second, 64 to 95 for third and 96
1530 * to 127 for fourth. For example, if you setup three MOXA boards,
1531 * first board is C218, second board is C320-16 and third board is
1532 * C320-32. The port number of first board (C218 - 8 ports) is from
1533 * 0 to 7. The port number of second board (C320 - 16 ports) is form
1534 * 32 to 47. The port number of third board (C320 - 32 ports) is from
1535 * 64 to 95. And those port numbers form 8 to 31, 48 to 63 and 96 to
1536 * 127 will be invalid.
1539 * Moxa Functions Description:
1541 * Function 1: Driver initialization routine, this routine must be
1542 * called when initialized driver.
1544 * void MoxaDriverInit();
1547 * Function 2: Moxa driver private IOCTL command processing.
1549 * int MoxaDriverIoctl(unsigned int cmd, unsigned long arg, int port);
1551 * unsigned int cmd : IOCTL command
1552 * unsigned long arg : IOCTL argument
1553 * int port : port number (0 - 127)
1560 * Function 6: Enable this port to start Tx/Rx data.
1562 * void MoxaPortEnable(int port);
1563 * int port : port number (0 - 127)
1566 * Function 7: Disable this port
1568 * void MoxaPortDisable(int port);
1569 * int port : port number (0 - 127)
1572 * Function 10: Setting baud rate of this port.
1574 * speed_t MoxaPortSetBaud(int port, speed_t baud);
1575 * int port : port number (0 - 127)
1576 * long baud : baud rate (50 - 115200)
1578 * return: 0 : this port is invalid or baud < 50
1579 * 50 - 115200 : the real baud rate set to the port, if
1580 * the argument baud is large than maximun
1581 * available baud rate, the real setting
1582 * baud rate will be the maximun baud rate.
1585 * Function 12: Configure the port.
1587 * int MoxaPortSetTermio(int port, struct ktermios *termio, speed_t baud);
1588 * int port : port number (0 - 127)
1589 * struct ktermios * termio : termio structure pointer
1590 * speed_t baud : baud rate
1592 * return: -1 : this port is invalid or termio == NULL
1596 * Function 13: Get the DTR/RTS state of this port.
1598 * int MoxaPortGetLineOut(int port, int *dtrState, int *rtsState);
1599 * int port : port number (0 - 127)
1600 * int * dtrState : pointer to INT to receive the current DTR
1601 * state. (if NULL, this function will not
1602 * write to this address)
1603 * int * rtsState : pointer to INT to receive the current RTS
1604 * state. (if NULL, this function will not
1605 * write to this address)
1607 * return: -1 : this port is invalid
1611 * Function 14: Setting the DTR/RTS output state of this port.
1613 * void MoxaPortLineCtrl(int port, int dtrState, int rtsState);
1614 * int port : port number (0 - 127)
1615 * int dtrState : DTR output state (0: off, 1: on)
1616 * int rtsState : RTS output state (0: off, 1: on)
1619 * Function 15: Setting the flow control of this port.
1621 * void MoxaPortFlowCtrl(int port, int rtsFlow, int ctsFlow, int rxFlow,
1622 * int txFlow,int xany);
1623 * int port : port number (0 - 127)
1624 * int rtsFlow : H/W RTS flow control (0: no, 1: yes)
1625 * int ctsFlow : H/W CTS flow control (0: no, 1: yes)
1626 * int rxFlow : S/W Rx XON/XOFF flow control (0: no, 1: yes)
1627 * int txFlow : S/W Tx XON/XOFF flow control (0: no, 1: yes)
1628 * int xany : S/W XANY flow control (0: no, 1: yes)
1631 * Function 16: Get ths line status of this port
1633 * int MoxaPortLineStatus(int port);
1634 * int port : port number (0 - 127)
1636 * return: Bit 0 - CTS state (0: off, 1: on)
1637 * Bit 1 - DSR state (0: off, 1: on)
1638 * Bit 2 - DCD state (0: off, 1: on)
1641 * Function 19: Flush the Rx/Tx buffer data of this port.
1643 * void MoxaPortFlushData(int port, int mode);
1644 * int port : port number (0 - 127)
1646 * 0 : flush the Rx buffer
1647 * 1 : flush the Tx buffer
1648 * 2 : flush the Rx and Tx buffer
1651 * Function 20: Write data.
1653 * int MoxaPortWriteData(int port, unsigned char * buffer, int length);
1654 * int port : port number (0 - 127)
1655 * unsigned char * buffer : pointer to write data buffer.
1656 * int length : write data length
1658 * return: 0 - length : real write data length
1661 * Function 21: Read data.
1663 * int MoxaPortReadData(int port, struct tty_struct *tty);
1664 * int port : port number (0 - 127)
1665 * struct tty_struct *tty : tty for data
1667 * return: 0 - length : real read data length
1670 * Function 24: Get the Tx buffer current queued data bytes
1672 * int MoxaPortTxQueue(int port);
1673 * int port : port number (0 - 127)
1675 * return: .. : Tx buffer current queued data bytes
1678 * Function 25: Get the Tx buffer current free space
1680 * int MoxaPortTxFree(int port);
1681 * int port : port number (0 - 127)
1683 * return: .. : Tx buffer current free space
1686 * Function 26: Get the Rx buffer current queued data bytes
1688 * int MoxaPortRxQueue(int port);
1689 * int port : port number (0 - 127)
1691 * return: .. : Rx buffer current queued data bytes
1694 * Function 28: Disable port data transmission.
1696 * void MoxaPortTxDisable(int port);
1697 * int port : port number (0 - 127)
1700 * Function 29: Enable port data transmission.
1702 * void MoxaPortTxEnable(int port);
1703 * int port : port number (0 - 127)
1706 * Function 31: Get the received BREAK signal count and reset it.
1708 * int MoxaPortResetBrkCnt(int port);
1709 * int port : port number (0 - 127)
1711 * return: 0 - .. : BREAK signal count
1716 static void MoxaPortEnable(struct moxa_port
*port
)
1718 void __iomem
*ofsAddr
;
1721 ofsAddr
= port
->tableAddr
;
1722 writew(lowwater
, ofsAddr
+ Low_water
);
1723 if (MOXA_IS_320(port
->board
))
1724 moxafunc(ofsAddr
, FC_SetBreakIrq
, 0);
1726 writew(readw(ofsAddr
+ HostStat
) | WakeupBreak
,
1727 ofsAddr
+ HostStat
);
1729 moxafunc(ofsAddr
, FC_SetLineIrq
, Magic_code
);
1730 moxafunc(ofsAddr
, FC_FlushQueue
, 2);
1732 moxafunc(ofsAddr
, FC_EnableCH
, Magic_code
);
1733 MoxaPortLineStatus(port
);
1736 static void MoxaPortDisable(struct moxa_port
*port
)
1738 void __iomem
*ofsAddr
= port
->tableAddr
;
1740 moxafunc(ofsAddr
, FC_SetFlowCtl
, 0); /* disable flow control */
1741 moxafunc(ofsAddr
, FC_ClrLineIrq
, Magic_code
);
1742 writew(0, ofsAddr
+ HostStat
);
1743 moxafunc(ofsAddr
, FC_DisableCH
, Magic_code
);
1746 static speed_t
MoxaPortSetBaud(struct moxa_port
*port
, speed_t baud
)
1748 void __iomem
*ofsAddr
= port
->tableAddr
;
1749 unsigned int clock
, val
;
1752 max
= MOXA_IS_320(port
->board
) ? 460800 : 921600;
1759 moxafunc(ofsAddr
, FC_SetBaud
, val
);
1764 static int MoxaPortSetTermio(struct moxa_port
*port
, struct ktermios
*termio
,
1767 void __iomem
*ofsAddr
;
1770 ofsAddr
= port
->tableAddr
;
1772 mode
= termio
->c_cflag
& CSIZE
;
1775 else if (mode
== CS6
)
1777 else if (mode
== CS7
)
1779 else if (mode
== CS8
)
1782 if (termio
->c_cflag
& CSTOPB
) {
1790 if (termio
->c_cflag
& PARENB
) {
1791 if (termio
->c_cflag
& PARODD
)
1798 moxafunc(ofsAddr
, FC_SetDataMode
, (u16
)mode
);
1800 if (MOXA_IS_320(port
->board
) && baud
>= 921600)
1803 baud
= MoxaPortSetBaud(port
, baud
);
1805 if (termio
->c_iflag
& (IXON
| IXOFF
| IXANY
)) {
1806 spin_lock_irq(&moxafunc_lock
);
1807 writeb(termio
->c_cc
[VSTART
], ofsAddr
+ FuncArg
);
1808 writeb(termio
->c_cc
[VSTOP
], ofsAddr
+ FuncArg1
);
1809 writeb(FC_SetXonXoff
, ofsAddr
+ FuncCode
);
1810 moxa_wait_finish(ofsAddr
);
1811 spin_unlock_irq(&moxafunc_lock
);
1817 static int MoxaPortGetLineOut(struct moxa_port
*port
, int *dtrState
,
1821 *dtrState
= !!(port
->lineCtrl
& DTR_ON
);
1823 *rtsState
= !!(port
->lineCtrl
& RTS_ON
);
1828 static void MoxaPortLineCtrl(struct moxa_port
*port
, int dtr
, int rts
)
1836 port
->lineCtrl
= mode
;
1837 moxafunc(port
->tableAddr
, FC_LineControl
, mode
);
1840 static void MoxaPortFlowCtrl(struct moxa_port
*port
, int rts
, int cts
,
1841 int txflow
, int rxflow
, int txany
)
1846 mode
|= RTS_FlowCtl
;
1848 mode
|= CTS_FlowCtl
;
1855 moxafunc(port
->tableAddr
, FC_SetFlowCtl
, mode
);
1858 static int MoxaPortLineStatus(struct moxa_port
*port
)
1860 void __iomem
*ofsAddr
;
1863 ofsAddr
= port
->tableAddr
;
1864 if (MOXA_IS_320(port
->board
))
1865 val
= moxafuncret(ofsAddr
, FC_LineStatus
, 0);
1867 val
= readw(ofsAddr
+ FlagStat
) >> 4;
1871 moxa_new_dcdstate(port
, val
& 8);
1876 static int MoxaPortWriteData(struct tty_struct
*tty
,
1877 const unsigned char *buffer
, int len
)
1879 struct moxa_port
*port
= tty
->driver_data
;
1880 void __iomem
*baseAddr
, *ofsAddr
, *ofs
;
1881 unsigned int c
, total
;
1882 u16 head
, tail
, tx_mask
, spage
, epage
;
1883 u16 pageno
, pageofs
, bufhead
;
1885 ofsAddr
= port
->tableAddr
;
1886 baseAddr
= port
->board
->basemem
;
1887 tx_mask
= readw(ofsAddr
+ TX_mask
);
1888 spage
= readw(ofsAddr
+ Page_txb
);
1889 epage
= readw(ofsAddr
+ EndPage_txb
);
1890 tail
= readw(ofsAddr
+ TXwptr
);
1891 head
= readw(ofsAddr
+ TXrptr
);
1892 c
= (head
> tail
) ? (head
- tail
- 1) : (head
- tail
+ tx_mask
);
1895 moxaLog
.txcnt
[port
->port
.tty
->index
] += c
;
1897 if (spage
== epage
) {
1898 bufhead
= readw(ofsAddr
+ Ofs_txb
);
1899 writew(spage
, baseAddr
+ Control_reg
);
1902 len
= head
- tail
- 1;
1904 len
= tx_mask
+ 1 - tail
;
1905 len
= (c
> len
) ? len
: c
;
1906 ofs
= baseAddr
+ DynPage_addr
+ bufhead
+ tail
;
1907 memcpy_toio(ofs
, buffer
, len
);
1909 tail
= (tail
+ len
) & tx_mask
;
1913 pageno
= spage
+ (tail
>> 13);
1914 pageofs
= tail
& Page_mask
;
1916 len
= Page_size
- pageofs
;
1919 writeb(pageno
, baseAddr
+ Control_reg
);
1920 ofs
= baseAddr
+ DynPage_addr
+ pageofs
;
1921 memcpy_toio(ofs
, buffer
, len
);
1923 if (++pageno
== epage
)
1928 tail
= (tail
+ total
) & tx_mask
;
1930 writew(tail
, ofsAddr
+ TXwptr
);
1931 writeb(1, ofsAddr
+ CD180TXirq
); /* start to send */
1935 static int MoxaPortReadData(struct moxa_port
*port
)
1937 struct tty_struct
*tty
= port
->port
.tty
;
1939 void __iomem
*baseAddr
, *ofsAddr
, *ofs
;
1940 unsigned int count
, len
, total
;
1941 u16 tail
, rx_mask
, spage
, epage
;
1942 u16 pageno
, pageofs
, bufhead
, head
;
1944 ofsAddr
= port
->tableAddr
;
1945 baseAddr
= port
->board
->basemem
;
1946 head
= readw(ofsAddr
+ RXrptr
);
1947 tail
= readw(ofsAddr
+ RXwptr
);
1948 rx_mask
= readw(ofsAddr
+ RX_mask
);
1949 spage
= readw(ofsAddr
+ Page_rxb
);
1950 epage
= readw(ofsAddr
+ EndPage_rxb
);
1951 count
= (tail
>= head
) ? (tail
- head
) : (tail
- head
+ rx_mask
+ 1);
1956 moxaLog
.rxcnt
[tty
->index
] += total
;
1957 if (spage
== epage
) {
1958 bufhead
= readw(ofsAddr
+ Ofs_rxb
);
1959 writew(spage
, baseAddr
+ Control_reg
);
1961 ofs
= baseAddr
+ DynPage_addr
+ bufhead
+ head
;
1962 len
= (tail
>= head
) ? (tail
- head
) :
1963 (rx_mask
+ 1 - head
);
1964 len
= tty_prepare_flip_string(tty
, &dst
,
1966 memcpy_fromio(dst
, ofs
, len
);
1967 head
= (head
+ len
) & rx_mask
;
1971 pageno
= spage
+ (head
>> 13);
1972 pageofs
= head
& Page_mask
;
1974 writew(pageno
, baseAddr
+ Control_reg
);
1975 ofs
= baseAddr
+ DynPage_addr
+ pageofs
;
1976 len
= tty_prepare_flip_string(tty
, &dst
,
1977 min(Page_size
- pageofs
, count
));
1978 memcpy_fromio(dst
, ofs
, len
);
1981 pageofs
= (pageofs
+ len
) & Page_mask
;
1982 if (pageofs
== 0 && ++pageno
== epage
)
1985 head
= (head
+ total
) & rx_mask
;
1987 writew(head
, ofsAddr
+ RXrptr
);
1988 if (readb(ofsAddr
+ FlagStat
) & Xoff_state
) {
1989 moxaLowWaterChk
= 1;
1990 port
->lowChkFlag
= 1;
1996 static int MoxaPortTxQueue(struct moxa_port
*port
)
1998 void __iomem
*ofsAddr
= port
->tableAddr
;
1999 u16 rptr
, wptr
, mask
;
2001 rptr
= readw(ofsAddr
+ TXrptr
);
2002 wptr
= readw(ofsAddr
+ TXwptr
);
2003 mask
= readw(ofsAddr
+ TX_mask
);
2004 return (wptr
- rptr
) & mask
;
2007 static int MoxaPortTxFree(struct moxa_port
*port
)
2009 void __iomem
*ofsAddr
= port
->tableAddr
;
2010 u16 rptr
, wptr
, mask
;
2012 rptr
= readw(ofsAddr
+ TXrptr
);
2013 wptr
= readw(ofsAddr
+ TXwptr
);
2014 mask
= readw(ofsAddr
+ TX_mask
);
2015 return mask
- ((wptr
- rptr
) & mask
);
2018 static int MoxaPortRxQueue(struct moxa_port
*port
)
2020 void __iomem
*ofsAddr
= port
->tableAddr
;
2021 u16 rptr
, wptr
, mask
;
2023 rptr
= readw(ofsAddr
+ RXrptr
);
2024 wptr
= readw(ofsAddr
+ RXwptr
);
2025 mask
= readw(ofsAddr
+ RX_mask
);
2026 return (wptr
- rptr
) & mask
;
2029 static void MoxaPortTxDisable(struct moxa_port
*port
)
2031 moxafunc(port
->tableAddr
, FC_SetXoffState
, Magic_code
);
2034 static void MoxaPortTxEnable(struct moxa_port
*port
)
2036 moxafunc(port
->tableAddr
, FC_SetXonState
, Magic_code
);
2039 static int moxa_get_serial_info(struct moxa_port
*info
,
2040 struct serial_struct __user
*retinfo
)
2042 struct serial_struct tmp
= {
2044 .line
= info
->port
.tty
->index
,
2045 .flags
= info
->port
.flags
,
2046 .baud_base
= 921600,
2047 .close_delay
= info
->port
.close_delay
2049 return copy_to_user(retinfo
, &tmp
, sizeof(*retinfo
)) ? -EFAULT
: 0;
2053 static int moxa_set_serial_info(struct moxa_port
*info
,
2054 struct serial_struct __user
*new_info
)
2056 struct serial_struct new_serial
;
2058 if (copy_from_user(&new_serial
, new_info
, sizeof(new_serial
)))
2061 if (new_serial
.irq
!= 0 || new_serial
.port
!= 0 ||
2062 new_serial
.custom_divisor
!= 0 ||
2063 new_serial
.baud_base
!= 921600)
2066 if (!capable(CAP_SYS_ADMIN
)) {
2067 if (((new_serial
.flags
& ~ASYNC_USR_MASK
) !=
2068 (info
->port
.flags
& ~ASYNC_USR_MASK
)))
2071 info
->port
.close_delay
= new_serial
.close_delay
* HZ
/ 100;
2073 new_serial
.flags
= (new_serial
.flags
& ~ASYNC_FLAGS
);
2074 new_serial
.flags
|= (info
->port
.flags
& ASYNC_FLAGS
);
2076 MoxaSetFifo(info
, new_serial
.type
== PORT_16550A
);
2078 info
->type
= new_serial
.type
;
2084 /*****************************************************************************
2085 * Static local functions: *
2086 *****************************************************************************/
2088 static void MoxaSetFifo(struct moxa_port
*port
, int enable
)
2090 void __iomem
*ofsAddr
= port
->tableAddr
;
2093 moxafunc(ofsAddr
, FC_SetRxFIFOTrig
, 0);
2094 moxafunc(ofsAddr
, FC_SetTxFIFOCnt
, 1);
2096 moxafunc(ofsAddr
, FC_SetRxFIFOTrig
, 3);
2097 moxafunc(ofsAddr
, FC_SetTxFIFOCnt
, 16);