blob: c858aff721c41423db613f5f7242b8e4a7a94f80 [file] [log] [blame]
Greg Kroah-Hartmane3b3d0f2017-11-06 18:11:51 +01001// SPDX-License-Identifier: GPL-2.0+
Linus Torvalds1da177e2005-04-16 15:20:36 -07002/*
3 * mxser.c -- MOXA Smartio/Industio family multiport serial driver.
4 *
Jiri Slaby80ff8a82008-02-07 00:16:51 -08005 * Copyright (C) 1999-2006 Moxa Technologies (support@moxa.com).
6 * Copyright (C) 2006-2008 Jiri Slaby <jirislaby@gmail.com>
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 *
Jiri Slaby1c456072008-02-07 00:16:46 -08008 * This code is loosely based on the 1.8 moxa driver which is based on
9 * Linux serial driver, written by Linus Torvalds, Theodore T'so and
10 * others.
Linus Torvalds1da177e2005-04-16 15:20:36 -070011 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070012 * Fed through a cleanup, indent and remove of non 2.6 code by Alan Cox
Alan Cox8eb04cf2008-11-11 14:48:44 +000013 * <alan@lxorguk.ukuu.org.uk>. The original 1.8 code is available on
14 * www.moxa.com.
Linus Torvalds1da177e2005-04-16 15:20:36 -070015 * - Fixed x86_64 cleanness
Linus Torvalds1da177e2005-04-16 15:20:36 -070016 */
17
Linus Torvalds1da177e2005-04-16 15:20:36 -070018#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070019#include <linux/errno.h>
20#include <linux/signal.h>
21#include <linux/sched.h>
22#include <linux/timer.h>
23#include <linux/interrupt.h>
24#include <linux/tty.h>
25#include <linux/tty_flip.h>
26#include <linux/serial.h>
27#include <linux/serial_reg.h>
28#include <linux/major.h>
29#include <linux/string.h>
30#include <linux/fcntl.h>
31#include <linux/ptrace.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#include <linux/ioport.h>
33#include <linux/mm.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034#include <linux/delay.h>
35#include <linux/pci.h>
Jiri Slaby1977f032007-10-18 23:40:25 -070036#include <linux/bitops.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090037#include <linux/slab.h>
Manuel Zerpies5a3c6b2512011-06-16 14:07:22 +020038#include <linux/ratelimit.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070039
Linus Torvalds1da177e2005-04-16 15:20:36 -070040#include <asm/io.h>
41#include <asm/irq.h>
Linus Torvalds7c0f6ba2016-12-24 11:46:01 -080042#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070043
Jiri Slaby4463cc52021-06-18 08:14:10 +020044/*
45 * Semi-public control interfaces
46 */
47
48/*
49 * MOXA ioctls
50 */
51
52#define MOXA 0x400
Jiri Slaby4463cc52021-06-18 08:14:10 +020053#define MOXA_SET_OP_MODE (MOXA + 66)
54#define MOXA_GET_OP_MODE (MOXA + 67)
55
56#define RS232_MODE 0
57#define RS485_2WIRE_MODE 1
58#define RS422_MODE 2
59#define RS485_4WIRE_MODE 3
60#define OP_MODE_MASK 3
61
Jiri Slaby4463cc52021-06-18 08:14:10 +020062/* --------------------------------------------------- */
63
Jiri Slaby4463cc52021-06-18 08:14:10 +020064/*
65 * Follow just what Moxa Must chip defines.
66 *
Jiri Slaby464fbf62021-06-18 08:15:08 +020067 * When LCR register (offset 0x03) is written the following value, the Must chip
68 * will enter enhanced mode. And a write to EFR (offset 0x02) bit 6,7 will
Jiri Slaby4463cc52021-06-18 08:14:10 +020069 * change bank.
70 */
Jiri Slaby464fbf62021-06-18 08:15:08 +020071#define MOXA_MUST_ENTER_ENHANCED 0xBF
Jiri Slaby4463cc52021-06-18 08:14:10 +020072
Jiri Slaby464fbf62021-06-18 08:15:08 +020073/* when enhanced mode is enabled, access to general bank register */
Jiri Slaby4463cc52021-06-18 08:14:10 +020074#define MOXA_MUST_GDL_REGISTER 0x07
75#define MOXA_MUST_GDL_MASK 0x7F
76#define MOXA_MUST_GDL_HAS_BAD_DATA 0x80
77
78#define MOXA_MUST_LSR_RERR 0x80 /* error in receive FIFO */
Jiri Slaby464fbf62021-06-18 08:15:08 +020079/* enhanced register bank select and enhanced mode setting register */
80/* This works only when LCR register equals to 0xBF */
Jiri Slaby4463cc52021-06-18 08:14:10 +020081#define MOXA_MUST_EFR_REGISTER 0x02
Jiri Slaby464fbf62021-06-18 08:15:08 +020082#define MOXA_MUST_EFR_EFRB_ENABLE 0x10 /* enhanced mode enable */
83/* enhanced register bank set 0, 1, 2 */
Jiri Slaby4463cc52021-06-18 08:14:10 +020084#define MOXA_MUST_EFR_BANK0 0x00
85#define MOXA_MUST_EFR_BANK1 0x40
86#define MOXA_MUST_EFR_BANK2 0x80
87#define MOXA_MUST_EFR_BANK3 0xC0
88#define MOXA_MUST_EFR_BANK_MASK 0xC0
89
90/* set XON1 value register, when LCR=0xBF and change to bank0 */
91#define MOXA_MUST_XON1_REGISTER 0x04
92
93/* set XON2 value register, when LCR=0xBF and change to bank0 */
94#define MOXA_MUST_XON2_REGISTER 0x05
95
96/* set XOFF1 value register, when LCR=0xBF and change to bank0 */
97#define MOXA_MUST_XOFF1_REGISTER 0x06
98
99/* set XOFF2 value register, when LCR=0xBF and change to bank0 */
100#define MOXA_MUST_XOFF2_REGISTER 0x07
101
102#define MOXA_MUST_RBRTL_REGISTER 0x04
103#define MOXA_MUST_RBRTH_REGISTER 0x05
104#define MOXA_MUST_RBRTI_REGISTER 0x06
105#define MOXA_MUST_THRTL_REGISTER 0x07
106#define MOXA_MUST_ENUM_REGISTER 0x04
107#define MOXA_MUST_HWID_REGISTER 0x05
108#define MOXA_MUST_ECR_REGISTER 0x06
109#define MOXA_MUST_CSR_REGISTER 0x07
110
111#define MOXA_MUST_FCR_GDA_MODE_ENABLE 0x20 /* good data mode enable */
112#define MOXA_MUST_FCR_GDA_ONLY_ENABLE 0x10 /* only good data put into RxFIFO */
113
114#define MOXA_MUST_IER_ECTSI 0x80 /* enable CTS interrupt */
115#define MOXA_MUST_IER_ERTSI 0x40 /* enable RTS interrupt */
116#define MOXA_MUST_IER_XINT 0x20 /* enable Xon/Xoff interrupt */
117#define MOXA_MUST_IER_EGDAI 0x10 /* enable GDA interrupt */
118
119#define MOXA_MUST_RECV_ISR (UART_IER_RDI | MOXA_MUST_IER_EGDAI)
120
121/* GDA interrupt pending */
122#define MOXA_MUST_IIR_GDA 0x1C
123#define MOXA_MUST_IIR_RDA 0x04
124#define MOXA_MUST_IIR_RTO 0x0C
125#define MOXA_MUST_IIR_LSR 0x06
126
127/* received Xon/Xoff or specical interrupt pending */
128#define MOXA_MUST_IIR_XSC 0x10
129
130/* RTS/CTS change state interrupt pending */
131#define MOXA_MUST_IIR_RTSCTS 0x20
132#define MOXA_MUST_IIR_MASK 0x3E
133
134#define MOXA_MUST_MCR_XON_FLAG 0x40
135#define MOXA_MUST_MCR_XON_ANY 0x80
136#define MOXA_MUST_MCR_TX_XON 0x08
137
138#define MOXA_MUST_EFR_SF_MASK 0x0F /* software flow control on chip mask value */
139#define MOXA_MUST_EFR_SF_TX1 0x08 /* send Xon1/Xoff1 */
140#define MOXA_MUST_EFR_SF_TX2 0x04 /* send Xon2/Xoff2 */
141#define MOXA_MUST_EFR_SF_TX12 0x0C /* send Xon1,Xon2/Xoff1,Xoff2 */
142#define MOXA_MUST_EFR_SF_TX_NO 0x00 /* don't send Xon/Xoff */
143#define MOXA_MUST_EFR_SF_TX_MASK 0x0C /* Tx software flow control mask */
144#define MOXA_MUST_EFR_SF_RX_NO 0x00 /* don't receive Xon/Xoff */
145#define MOXA_MUST_EFR_SF_RX1 0x02 /* receive Xon1/Xoff1 */
146#define MOXA_MUST_EFR_SF_RX2 0x01 /* receive Xon2/Xoff2 */
147#define MOXA_MUST_EFR_SF_RX12 0x03 /* receive Xon1,Xon2/Xoff1,Xoff2 */
148#define MOXA_MUST_EFR_SF_RX_MASK 0x03 /* Rx software flow control mask */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150#define MXSERMAJOR 174
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152#define MXSER_BOARDS 4 /* Max. boards */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153#define MXSER_PORTS_PER_BOARD 8 /* Max. ports per board */
Jiri Slaby1c456072008-02-07 00:16:46 -0800154#define MXSER_PORTS (MXSER_BOARDS * MXSER_PORTS_PER_BOARD)
155#define MXSER_ISR_PASS_LIMIT 100
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157#define WAKEUP_CHARS 256
158
Jiri Slabya6970c32021-06-18 08:14:41 +0200159#define MXSER_BAUD_BASE 921600
Jiri Slabyd811b262021-06-18 08:14:42 +0200160#define MXSER_CUSTOM_DIVISOR (MXSER_BAUD_BASE * 16)
Jiri Slabya6970c32021-06-18 08:14:41 +0200161
Jiri Slaby4167bd22021-11-18 08:31:24 +0100162#define PCI_DEVICE_ID_MOXA_RC7000 0x0001
163#define PCI_DEVICE_ID_MOXA_CP102 0x1020
164#define PCI_DEVICE_ID_MOXA_CP102UL 0x1021
165#define PCI_DEVICE_ID_MOXA_CP102U 0x1022
166#define PCI_DEVICE_ID_MOXA_CP102UF 0x1023
167#define PCI_DEVICE_ID_MOXA_C104 0x1040
168#define PCI_DEVICE_ID_MOXA_CP104U 0x1041
169#define PCI_DEVICE_ID_MOXA_CP104JU 0x1042
170#define PCI_DEVICE_ID_MOXA_CP104EL 0x1043
Jiri Slaby16add042021-11-18 08:31:23 +0100171#define PCI_DEVICE_ID_MOXA_POS104UL 0x1044
172#define PCI_DEVICE_ID_MOXA_CB108 0x1080
Jiri Slaby16add042021-11-18 08:31:23 +0100173#define PCI_DEVICE_ID_MOXA_CP112UL 0x1120
Jiri Slaby4167bd22021-11-18 08:31:24 +0100174#define PCI_DEVICE_ID_MOXA_CT114 0x1140
175#define PCI_DEVICE_ID_MOXA_CP114 0x1141
Jiri Slaby16add042021-11-18 08:31:23 +0100176#define PCI_DEVICE_ID_MOXA_CB114 0x1142
177#define PCI_DEVICE_ID_MOXA_CP114UL 0x1143
Jiri Slaby4167bd22021-11-18 08:31:24 +0100178#define PCI_DEVICE_ID_MOXA_CP118U 0x1180
179#define PCI_DEVICE_ID_MOXA_CP118EL 0x1181
180#define PCI_DEVICE_ID_MOXA_CP132 0x1320
181#define PCI_DEVICE_ID_MOXA_CP132U 0x1321
182#define PCI_DEVICE_ID_MOXA_CP134U 0x1340
Jiri Slaby16add042021-11-18 08:31:23 +0100183#define PCI_DEVICE_ID_MOXA_CB134I 0x1341
184#define PCI_DEVICE_ID_MOXA_CP138U 0x1380
Jiri Slaby4167bd22021-11-18 08:31:24 +0100185#define PCI_DEVICE_ID_MOXA_C168 0x1680
186#define PCI_DEVICE_ID_MOXA_CP168U 0x1681
187#define PCI_DEVICE_ID_MOXA_CP168EL 0x1682
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188
Jiri Slabyc24c31f2021-06-18 08:14:54 +0200189#define MXSER_NPORTS(ddata) ((ddata) & 0xffU)
190#define MXSER_HIGHBAUD 0x0100
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191
Jiri Slabye4558362021-06-18 08:14:14 +0200192enum mxser_must_hwid {
193 MOXA_OTHER_UART = 0x00,
194 MOXA_MUST_MU150_HWID = 0x01,
195 MOXA_MUST_MU860_HWID = 0x02,
196};
197
Jiri Slaby1c456072008-02-07 00:16:46 -0800198static const struct {
Jiri Slabydc33f642021-06-18 08:14:11 +0200199 u8 type;
200 u8 fifo_size;
201 u8 rx_high_water;
202 u8 rx_low_water;
203 speed_t max_baud;
Jiri Slaby1c456072008-02-07 00:16:46 -0800204} Gpci_uart_info[] = {
Jiri Slabydc33f642021-06-18 08:14:11 +0200205 { MOXA_OTHER_UART, 16, 14, 1, 921600 },
206 { MOXA_MUST_MU150_HWID, 64, 48, 16, 230400 },
207 { MOXA_MUST_MU860_HWID, 128, 96, 32, 921600 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700208};
Jiri Slaby1c456072008-02-07 00:16:46 -0800209#define UART_INFO_NUM ARRAY_SIZE(Gpci_uart_info)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210
Jiri Slaby1c456072008-02-07 00:16:46 -0800211
212/* driver_data correspond to the lines in the structure above
213 see also ISA probe function before you change something */
Arvind Yadav3385ecf2017-07-23 15:31:01 +0530214static const struct pci_device_id mxser_pcibrds[] = {
Jiri Slabyc668d562021-11-18 08:31:25 +0100215 { PCI_DEVICE_DATA(MOXA, C168, 8) },
216 { PCI_DEVICE_DATA(MOXA, C104, 4) },
217 { PCI_DEVICE_DATA(MOXA, CP132, 2) },
218 { PCI_DEVICE_DATA(MOXA, CP114, 4) },
219 { PCI_DEVICE_DATA(MOXA, CT114, 4) },
220 { PCI_DEVICE_DATA(MOXA, CP102, 2 | MXSER_HIGHBAUD) },
221 { PCI_DEVICE_DATA(MOXA, CP104U, 4) },
222 { PCI_DEVICE_DATA(MOXA, CP168U, 8) },
223 { PCI_DEVICE_DATA(MOXA, CP132U, 2) },
224 { PCI_DEVICE_DATA(MOXA, CP134U, 4) },
225 { PCI_DEVICE_DATA(MOXA, CP104JU, 4) },
226 { PCI_DEVICE_DATA(MOXA, RC7000, 8) }, /* RC7000 */
227 { PCI_DEVICE_DATA(MOXA, CP118U, 8) },
228 { PCI_DEVICE_DATA(MOXA, CP102UL, 2) },
229 { PCI_DEVICE_DATA(MOXA, CP102U, 2) },
230 { PCI_DEVICE_DATA(MOXA, CP118EL, 8) },
231 { PCI_DEVICE_DATA(MOXA, CP168EL, 8) },
232 { PCI_DEVICE_DATA(MOXA, CP104EL, 4) },
233 { PCI_DEVICE_DATA(MOXA, CB108, 8) },
234 { PCI_DEVICE_DATA(MOXA, CB114, 4) },
235 { PCI_DEVICE_DATA(MOXA, CB134I, 4) },
236 { PCI_DEVICE_DATA(MOXA, CP138U, 8) },
237 { PCI_DEVICE_DATA(MOXA, POS104UL, 4) },
238 { PCI_DEVICE_DATA(MOXA, CP114UL, 4) },
239 { PCI_DEVICE_DATA(MOXA, CP102UF, 2) },
240 { PCI_DEVICE_DATA(MOXA, CP112UL, 2) },
Jiri Slaby1c456072008-02-07 00:16:46 -0800241 { }
242};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243MODULE_DEVICE_TABLE(pci, mxser_pcibrds);
244
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245static int ttymajor = MXSERMAJOR;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246
247/* Variables for insmod */
248
249MODULE_AUTHOR("Casper Yang");
250MODULE_DESCRIPTION("MOXA Smartio/Industio Family Multiport Board Device Driver");
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800251module_param(ttymajor, int, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252MODULE_LICENSE("GPL");
253
Jiri Slaby1c456072008-02-07 00:16:46 -0800254struct mxser_board;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255
Jiri Slaby1c456072008-02-07 00:16:46 -0800256struct mxser_port {
Alan Cox0ad9e7d2008-07-16 21:56:10 +0100257 struct tty_port port;
Jiri Slaby1c456072008-02-07 00:16:46 -0800258 struct mxser_board *board;
Jiri Slaby1c456072008-02-07 00:16:46 -0800259
260 unsigned long ioaddr;
261 unsigned long opmode_ioaddr;
Jiri Slaby1c456072008-02-07 00:16:46 -0800262
Jiri Slabydc33f642021-06-18 08:14:11 +0200263 u8 rx_high_water;
264 u8 rx_low_water;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265 int type; /* UART type */
Jiri Slaby1c456072008-02-07 00:16:46 -0800266
Jiri Slabya93963e2021-06-18 08:14:24 +0200267 unsigned char x_char; /* xon/xoff character */
268 u8 IER; /* Interrupt Enable Register */
269 u8 MCR; /* Modem control register */
Jiri Slabyd249e662021-09-22 09:59:38 +0200270 u8 FCR; /* FIFO control register */
Jiri Slaby1c456072008-02-07 00:16:46 -0800271
Jiri Slaby1c456072008-02-07 00:16:46 -0800272 struct async_icount icount; /* kernel counters for 4 input interrupts */
Jiri Slaby104583b2017-09-12 12:39:54 +0200273 unsigned int timeout;
Jiri Slaby1c456072008-02-07 00:16:46 -0800274
Jiri Slabya93963e2021-06-18 08:14:24 +0200275 u8 read_status_mask;
276 u8 ignore_status_mask;
Jiri Slabydc33f642021-06-18 08:14:11 +0200277 u8 xmit_fifo_size;
Jiri Slaby02e43142021-06-18 08:14:25 +0200278 unsigned int xmit_head;
279 unsigned int xmit_tail;
280 unsigned int xmit_cnt;
Jiri Slaby1c456072008-02-07 00:16:46 -0800281
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282 spinlock_t slock;
Jiri Slaby1c456072008-02-07 00:16:46 -0800283};
284
285struct mxser_board {
286 unsigned int idx;
Jiri Slabyc24c31f2021-06-18 08:14:54 +0200287 unsigned short nports;
Jiri Slaby1c456072008-02-07 00:16:46 -0800288 int irq;
Jiri Slaby1c456072008-02-07 00:16:46 -0800289 unsigned long vector;
Jiri Slaby1c456072008-02-07 00:16:46 -0800290
Jiri Slabye4558362021-06-18 08:14:14 +0200291 enum mxser_must_hwid must_hwid;
Jiri Slaby928f9462021-06-18 08:14:16 +0200292 speed_t max_baud;
Jiri Slaby1c456072008-02-07 00:16:46 -0800293
Jiri Slabyad1c92f2021-06-18 08:14:59 +0200294 struct mxser_port ports[];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295};
296
Jiri Slabyf8b6b322021-06-18 08:14:58 +0200297static DECLARE_BITMAP(mxser_boards, MXSER_BOARDS);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298static struct tty_driver *mxvar_sdriver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700299
Jiri Slabyedb7d272021-06-18 08:14:46 +0200300static u8 __mxser_must_set_EFR(unsigned long baseio, u8 clear, u8 set,
301 bool restore_LCR)
Christoph Hellwig148ff862008-04-30 00:54:29 -0700302{
Jiri Slabyedb7d272021-06-18 08:14:46 +0200303 u8 oldlcr, efr;
Christoph Hellwig148ff862008-04-30 00:54:29 -0700304
305 oldlcr = inb(baseio + UART_LCR);
Jiri Slaby464fbf62021-06-18 08:15:08 +0200306 outb(MOXA_MUST_ENTER_ENHANCED, baseio + UART_LCR);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700307
308 efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
Jiri Slabyedb7d272021-06-18 08:14:46 +0200309 efr &= ~clear;
310 efr |= set;
Christoph Hellwig148ff862008-04-30 00:54:29 -0700311
312 outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700313
Jiri Slabyedb7d272021-06-18 08:14:46 +0200314 if (restore_LCR)
315 outb(oldlcr, baseio + UART_LCR);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700316
Jiri Slabyedb7d272021-06-18 08:14:46 +0200317 return oldlcr;
Christoph Hellwig148ff862008-04-30 00:54:29 -0700318}
319
Jiri Slabyb2864842021-06-18 08:14:47 +0200320static u8 mxser_must_select_bank(unsigned long baseio, u8 bank)
321{
322 return __mxser_must_set_EFR(baseio, MOXA_MUST_EFR_BANK_MASK, bank,
323 false);
324}
325
Christoph Hellwig148ff862008-04-30 00:54:29 -0700326static void mxser_set_must_xon1_value(unsigned long baseio, u8 value)
327{
Jiri Slabyb2864842021-06-18 08:14:47 +0200328 u8 oldlcr = mxser_must_select_bank(baseio, MOXA_MUST_EFR_BANK0);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700329 outb(value, baseio + MOXA_MUST_XON1_REGISTER);
330 outb(oldlcr, baseio + UART_LCR);
331}
332
333static void mxser_set_must_xoff1_value(unsigned long baseio, u8 value)
334{
Jiri Slabyb2864842021-06-18 08:14:47 +0200335 u8 oldlcr = mxser_must_select_bank(baseio, MOXA_MUST_EFR_BANK0);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700336 outb(value, baseio + MOXA_MUST_XOFF1_REGISTER);
337 outb(oldlcr, baseio + UART_LCR);
338}
339
340static void mxser_set_must_fifo_value(struct mxser_port *info)
341{
Jiri Slabyb2864842021-06-18 08:14:47 +0200342 u8 oldlcr = mxser_must_select_bank(info->ioaddr, MOXA_MUST_EFR_BANK1);
Jiri Slabydc33f642021-06-18 08:14:11 +0200343 outb(info->rx_high_water, info->ioaddr + MOXA_MUST_RBRTH_REGISTER);
344 outb(info->rx_high_water, info->ioaddr + MOXA_MUST_RBRTI_REGISTER);
345 outb(info->rx_low_water, info->ioaddr + MOXA_MUST_RBRTL_REGISTER);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700346 outb(oldlcr, info->ioaddr + UART_LCR);
347}
348
349static void mxser_set_must_enum_value(unsigned long baseio, u8 value)
350{
Jiri Slabyb2864842021-06-18 08:14:47 +0200351 u8 oldlcr = mxser_must_select_bank(baseio, MOXA_MUST_EFR_BANK2);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700352 outb(value, baseio + MOXA_MUST_ENUM_REGISTER);
353 outb(oldlcr, baseio + UART_LCR);
354}
355
Jiri Slabyb2864842021-06-18 08:14:47 +0200356static u8 mxser_get_must_hardware_id(unsigned long baseio)
Christoph Hellwig148ff862008-04-30 00:54:29 -0700357{
Jiri Slabyb2864842021-06-18 08:14:47 +0200358 u8 oldlcr = mxser_must_select_bank(baseio, MOXA_MUST_EFR_BANK2);
359 u8 id = inb(baseio + MOXA_MUST_HWID_REGISTER);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700360 outb(oldlcr, baseio + UART_LCR);
Jiri Slabyb2864842021-06-18 08:14:47 +0200361
362 return id;
Christoph Hellwig148ff862008-04-30 00:54:29 -0700363}
364
Jiri Slabyedb7d272021-06-18 08:14:46 +0200365static void mxser_must_set_EFR(unsigned long baseio, u8 clear, u8 set)
366{
367 __mxser_must_set_EFR(baseio, clear, set, true);
368}
369
370static void mxser_must_set_enhance_mode(unsigned long baseio, bool enable)
371{
372 mxser_must_set_EFR(baseio,
373 enable ? 0 : MOXA_MUST_EFR_EFRB_ENABLE,
374 enable ? MOXA_MUST_EFR_EFRB_ENABLE : 0);
375}
376
Jiri Slabyb441eb02021-06-18 08:14:48 +0200377static void mxser_must_no_sw_flow_control(unsigned long baseio)
Christoph Hellwig148ff862008-04-30 00:54:29 -0700378{
Jiri Slabyb441eb02021-06-18 08:14:48 +0200379 mxser_must_set_EFR(baseio, MOXA_MUST_EFR_SF_MASK, 0);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700380}
381
Jiri Slabyb441eb02021-06-18 08:14:48 +0200382static void mxser_must_set_tx_sw_flow_control(unsigned long baseio, bool enable)
Christoph Hellwig148ff862008-04-30 00:54:29 -0700383{
Jiri Slabyb441eb02021-06-18 08:14:48 +0200384 mxser_must_set_EFR(baseio, MOXA_MUST_EFR_SF_TX_MASK,
385 enable ? MOXA_MUST_EFR_SF_TX1 : 0);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700386}
387
Jiri Slabyb441eb02021-06-18 08:14:48 +0200388static void mxser_must_set_rx_sw_flow_control(unsigned long baseio, bool enable)
Christoph Hellwig148ff862008-04-30 00:54:29 -0700389{
Jiri Slabyb441eb02021-06-18 08:14:48 +0200390 mxser_must_set_EFR(baseio, MOXA_MUST_EFR_SF_RX_MASK,
391 enable ? MOXA_MUST_EFR_SF_RX1 : 0);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700392}
393
Jiri Slabye4558362021-06-18 08:14:14 +0200394static enum mxser_must_hwid mxser_must_get_hwid(unsigned long io)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395{
396 u8 oldmcr, hwid;
397 int i;
398
399 outb(0, io + UART_LCR);
Jiri Slabyedb7d272021-06-18 08:14:46 +0200400 mxser_must_set_enhance_mode(io, false);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401 oldmcr = inb(io + UART_MCR);
402 outb(0, io + UART_MCR);
Christoph Hellwig148ff862008-04-30 00:54:29 -0700403 mxser_set_must_xon1_value(io, 0x11);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 if ((hwid = inb(io + UART_MCR)) != 0) {
405 outb(oldmcr, io + UART_MCR);
Jesper Juhl8ea2c2e2006-06-25 05:47:54 -0700406 return MOXA_OTHER_UART;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407 }
408
Jiri Slabyb2864842021-06-18 08:14:47 +0200409 hwid = mxser_get_must_hardware_id(io);
Jiri Slabye4558362021-06-18 08:14:14 +0200410 for (i = 1; i < UART_INFO_NUM; i++) /* 0 = OTHER_UART */
Jiri Slaby1c456072008-02-07 00:16:46 -0800411 if (hwid == Gpci_uart_info[i].type)
Jiri Slabye4558362021-06-18 08:14:14 +0200412 return hwid;
413
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414 return MOXA_OTHER_UART;
415}
416
Jiri Slaby5d1ea1a2021-06-18 08:15:12 +0200417static bool mxser_16550A_or_MUST(struct mxser_port *info)
418{
419 return info->type == PORT_16550A || info->board->must_hwid;
420}
421
Jiri Slabyc3db20c2021-06-18 08:14:55 +0200422static void mxser_process_txrx_fifo(struct mxser_port *info)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423{
Jiri Slabyc3db20c2021-06-18 08:14:55 +0200424 unsigned int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425
Jiri Slabyc3db20c2021-06-18 08:14:55 +0200426 if (info->type == PORT_16450 || info->type == PORT_8250) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427 info->rx_high_water = 1;
428 info->rx_low_water = 1;
429 info->xmit_fifo_size = 1;
Jiri Slabyc3db20c2021-06-18 08:14:55 +0200430 return;
431 }
432
433 for (i = 0; i < UART_INFO_NUM; i++)
434 if (info->board->must_hwid == Gpci_uart_info[i].type) {
435 info->rx_low_water = Gpci_uart_info[i].rx_low_water;
436 info->rx_high_water = Gpci_uart_info[i].rx_high_water;
437 info->xmit_fifo_size = Gpci_uart_info[i].fifo_size;
438 break;
439 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440}
441
Jiri Slaby740165f2021-06-18 08:15:05 +0200442static void __mxser_start_tx(struct mxser_port *info)
443{
444 outb(info->IER & ~UART_IER_THRI, info->ioaddr + UART_IER);
445 info->IER |= UART_IER_THRI;
446 outb(info->IER, info->ioaddr + UART_IER);
447}
448
449static void mxser_start_tx(struct mxser_port *info)
450{
451 unsigned long flags;
452
453 spin_lock_irqsave(&info->slock, flags);
454 __mxser_start_tx(info);
455 spin_unlock_irqrestore(&info->slock, flags);
456}
457
458static void __mxser_stop_tx(struct mxser_port *info)
459{
460 info->IER &= ~UART_IER_THRI;
461 outb(info->IER, info->ioaddr + UART_IER);
462}
463
Alan Cox31f35932009-01-02 13:45:05 +0000464static int mxser_carrier_raised(struct tty_port *port)
465{
466 struct mxser_port *mp = container_of(port, struct mxser_port, port);
467 return (inb(mp->ioaddr + UART_MSR) & UART_MSR_DCD)?1:0;
468}
469
Alan Coxfcc8ac12009-06-11 12:24:17 +0100470static void mxser_dtr_rts(struct tty_port *port, int on)
Alan Cox5d951fb2009-01-02 13:45:19 +0000471{
472 struct mxser_port *mp = container_of(port, struct mxser_port, port);
473 unsigned long flags;
Jiri Slaby007bbdc2021-06-18 08:15:02 +0200474 u8 mcr;
Alan Cox5d951fb2009-01-02 13:45:19 +0000475
476 spin_lock_irqsave(&mp->slock, flags);
Jiri Slaby007bbdc2021-06-18 08:15:02 +0200477 mcr = inb(mp->ioaddr + UART_MCR);
Alan Coxfcc8ac12009-06-11 12:24:17 +0100478 if (on)
Jiri Slaby007bbdc2021-06-18 08:15:02 +0200479 mcr |= UART_MCR_DTR | UART_MCR_RTS;
Alan Coxfcc8ac12009-06-11 12:24:17 +0100480 else
Jiri Slaby007bbdc2021-06-18 08:15:02 +0200481 mcr &= ~(UART_MCR_DTR | UART_MCR_RTS);
482 outb(mcr, mp->ioaddr + UART_MCR);
Alan Cox5d951fb2009-01-02 13:45:19 +0000483 spin_unlock_irqrestore(&mp->slock, flags);
484}
485
Jiri Slabydc33f642021-06-18 08:14:11 +0200486static int mxser_set_baud(struct tty_struct *tty, speed_t newspd)
Jiri Slaby1c456072008-02-07 00:16:46 -0800487{
Alan Cox216ba022008-10-13 10:40:19 +0100488 struct mxser_port *info = tty->driver_data;
Jiri Slaby104583b2017-09-12 12:39:54 +0200489 unsigned int quot = 0, baud;
Jiri Slaby1c456072008-02-07 00:16:46 -0800490 unsigned char cval;
Jiri Slaby104583b2017-09-12 12:39:54 +0200491 u64 timeout;
Jiri Slaby1c456072008-02-07 00:16:46 -0800492
Jiri Slaby928f9462021-06-18 08:14:16 +0200493 if (newspd > info->board->max_baud)
Jiri Slaby1c456072008-02-07 00:16:46 -0800494 return -1;
495
496 if (newspd == 134) {
Jiri Slabya6970c32021-06-18 08:14:41 +0200497 quot = 2 * MXSER_BAUD_BASE / 269;
Alan Cox216ba022008-10-13 10:40:19 +0100498 tty_encode_baud_rate(tty, 134, 134);
Jiri Slaby1c456072008-02-07 00:16:46 -0800499 } else if (newspd) {
Jiri Slabya6970c32021-06-18 08:14:41 +0200500 quot = MXSER_BAUD_BASE / newspd;
Jiri Slaby1c456072008-02-07 00:16:46 -0800501 if (quot == 0)
502 quot = 1;
Jiri Slabya6970c32021-06-18 08:14:41 +0200503 baud = MXSER_BAUD_BASE / quot;
Alan Cox216ba022008-10-13 10:40:19 +0100504 tty_encode_baud_rate(tty, baud, baud);
Jiri Slaby1c456072008-02-07 00:16:46 -0800505 } else {
506 quot = 0;
507 }
508
Jiri Slaby104583b2017-09-12 12:39:54 +0200509 /*
510 * worst case (128 * 1000 * 10 * 18432) needs 35 bits, so divide in the
511 * u64 domain
512 */
513 timeout = (u64)info->xmit_fifo_size * HZ * 10 * quot;
Jiri Slabya6970c32021-06-18 08:14:41 +0200514 do_div(timeout, MXSER_BAUD_BASE);
Jiri Slaby104583b2017-09-12 12:39:54 +0200515 info->timeout = timeout + HZ / 50; /* Add .02 seconds of slop */
Jiri Slaby1c456072008-02-07 00:16:46 -0800516
517 if (quot) {
518 info->MCR |= UART_MCR_DTR;
519 outb(info->MCR, info->ioaddr + UART_MCR);
520 } else {
521 info->MCR &= ~UART_MCR_DTR;
522 outb(info->MCR, info->ioaddr + UART_MCR);
523 return 0;
524 }
525
526 cval = inb(info->ioaddr + UART_LCR);
527
528 outb(cval | UART_LCR_DLAB, info->ioaddr + UART_LCR); /* set DLAB */
529
530 outb(quot & 0xff, info->ioaddr + UART_DLL); /* LS of divisor */
531 outb(quot >> 8, info->ioaddr + UART_DLM); /* MS of divisor */
532 outb(cval, info->ioaddr + UART_LCR); /* reset DLAB */
533
534#ifdef BOTHER
Alan Cox216ba022008-10-13 10:40:19 +0100535 if (C_BAUD(tty) == BOTHER) {
Jiri Slabya6970c32021-06-18 08:14:41 +0200536 quot = MXSER_BAUD_BASE % newspd;
Jiri Slaby1c456072008-02-07 00:16:46 -0800537 quot *= 8;
538 if (quot % newspd > newspd / 2) {
539 quot /= newspd;
540 quot++;
541 } else
542 quot /= newspd;
543
Christoph Hellwig148ff862008-04-30 00:54:29 -0700544 mxser_set_must_enum_value(info->ioaddr, quot);
Jiri Slaby1c456072008-02-07 00:16:46 -0800545 } else
546#endif
Christoph Hellwig148ff862008-04-30 00:54:29 -0700547 mxser_set_must_enum_value(info->ioaddr, 0);
Jiri Slaby1c456072008-02-07 00:16:46 -0800548
549 return 0;
550}
551
Jiri Slabybe486662021-06-18 08:15:04 +0200552static void mxser_handle_cts(struct tty_struct *tty, struct mxser_port *info,
553 u8 msr)
554{
555 bool cts = msr & UART_MSR_CTS;
556
557 if (tty->hw_stopped) {
558 if (cts) {
559 tty->hw_stopped = 0;
560
Jiri Slaby5d1ea1a2021-06-18 08:15:12 +0200561 if (!mxser_16550A_or_MUST(info))
Jiri Slaby740165f2021-06-18 08:15:05 +0200562 __mxser_start_tx(info);
Jiri Slabybe486662021-06-18 08:15:04 +0200563 tty_wakeup(tty);
564 }
565 return;
566 } else if (cts)
567 return;
568
569 tty->hw_stopped = 1;
Jiri Slaby5d1ea1a2021-06-18 08:15:12 +0200570 if (!mxser_16550A_or_MUST(info))
Jiri Slaby740165f2021-06-18 08:15:05 +0200571 __mxser_stop_tx(info);
Jiri Slabybe486662021-06-18 08:15:04 +0200572}
573
Jiri Slaby1c456072008-02-07 00:16:46 -0800574/*
575 * This routine is called to set the UART divisor registers to match
576 * the specified baud rate for a serial port.
577 */
Jiri Slaby3fdfa162021-09-22 09:59:32 +0200578static void mxser_change_speed(struct tty_struct *tty, struct ktermios *old_termios)
Jiri Slaby1c456072008-02-07 00:16:46 -0800579{
Alan Cox216ba022008-10-13 10:40:19 +0100580 struct mxser_port *info = tty->driver_data;
Jiri Slabyd249e662021-09-22 09:59:38 +0200581 unsigned cflag, cval;
Jiri Slaby1c456072008-02-07 00:16:46 -0800582
Alan Coxadc8d742012-07-14 15:31:47 +0100583 cflag = tty->termios.c_cflag;
Jiri Slaby1c456072008-02-07 00:16:46 -0800584
Jiri Slaby3fdfa162021-09-22 09:59:32 +0200585 if (mxser_set_baud(tty, tty_get_baud_rate(tty))) {
586 /* Use previous rate on a failure */
587 if (old_termios) {
588 speed_t baud = tty_termios_baud_rate(old_termios);
589 tty_encode_baud_rate(tty, baud, baud);
590 }
591 }
Jiri Slaby1c456072008-02-07 00:16:46 -0800592
593 /* byte size and parity */
594 switch (cflag & CSIZE) {
Jiri Slaby2c218322021-06-18 08:14:43 +0200595 default:
Jiri Slaby1c456072008-02-07 00:16:46 -0800596 case CS5:
Jiri Slaby2c218322021-06-18 08:14:43 +0200597 cval = UART_LCR_WLEN5;
Jiri Slaby1c456072008-02-07 00:16:46 -0800598 break;
599 case CS6:
Jiri Slaby2c218322021-06-18 08:14:43 +0200600 cval = UART_LCR_WLEN6;
Jiri Slaby1c456072008-02-07 00:16:46 -0800601 break;
602 case CS7:
Jiri Slaby2c218322021-06-18 08:14:43 +0200603 cval = UART_LCR_WLEN7;
Jiri Slaby1c456072008-02-07 00:16:46 -0800604 break;
605 case CS8:
Jiri Slaby2c218322021-06-18 08:14:43 +0200606 cval = UART_LCR_WLEN8;
Jiri Slaby1c456072008-02-07 00:16:46 -0800607 break;
Jiri Slaby1c456072008-02-07 00:16:46 -0800608 }
Jiri Slaby2c218322021-06-18 08:14:43 +0200609
Jiri Slaby1c456072008-02-07 00:16:46 -0800610 if (cflag & CSTOPB)
Jiri Slaby2c218322021-06-18 08:14:43 +0200611 cval |= UART_LCR_STOP;
Jiri Slaby1c456072008-02-07 00:16:46 -0800612 if (cflag & PARENB)
613 cval |= UART_LCR_PARITY;
614 if (!(cflag & PARODD))
615 cval |= UART_LCR_EPAR;
616 if (cflag & CMSPAR)
617 cval |= UART_LCR_SPAR;
618
Jiri Slabyd249e662021-09-22 09:59:38 +0200619 info->FCR = 0;
Jiri Slabybf1434c2021-09-22 09:59:35 +0200620 if (info->board->must_hwid) {
Jiri Slabyd249e662021-09-22 09:59:38 +0200621 info->FCR |= UART_FCR_ENABLE_FIFO |
Jiri Slabybf1434c2021-09-22 09:59:35 +0200622 MOXA_MUST_FCR_GDA_MODE_ENABLE;
623 mxser_set_must_fifo_value(info);
624 } else if (info->type != PORT_8250 && info->type != PORT_16450) {
Jiri Slabyd249e662021-09-22 09:59:38 +0200625 info->FCR |= UART_FCR_ENABLE_FIFO;
Jiri Slabybf1434c2021-09-22 09:59:35 +0200626 switch (info->rx_high_water) {
627 case 1:
Jiri Slabyd249e662021-09-22 09:59:38 +0200628 info->FCR |= UART_FCR_TRIGGER_1;
Jiri Slabybf1434c2021-09-22 09:59:35 +0200629 break;
630 case 4:
Jiri Slabyd249e662021-09-22 09:59:38 +0200631 info->FCR |= UART_FCR_TRIGGER_4;
Jiri Slabybf1434c2021-09-22 09:59:35 +0200632 break;
633 case 8:
Jiri Slabyd249e662021-09-22 09:59:38 +0200634 info->FCR |= UART_FCR_TRIGGER_8;
Jiri Slabybf1434c2021-09-22 09:59:35 +0200635 break;
636 default:
Jiri Slabyd249e662021-09-22 09:59:38 +0200637 info->FCR |= UART_FCR_TRIGGER_14;
Jiri Slabybf1434c2021-09-22 09:59:35 +0200638 break;
Jiri Slaby1c456072008-02-07 00:16:46 -0800639 }
640 }
641
642 /* CTS flow control flag and modem status interrupts */
643 info->IER &= ~UART_IER_MSI;
644 info->MCR &= ~UART_MCR_AFE;
Peter Hurley5604a982016-04-09 17:53:21 -0700645 tty_port_set_cts_flow(&info->port, cflag & CRTSCTS);
Jiri Slaby1c456072008-02-07 00:16:46 -0800646 if (cflag & CRTSCTS) {
Jiri Slaby1c456072008-02-07 00:16:46 -0800647 info->IER |= UART_IER_MSI;
Jiri Slaby5d1ea1a2021-06-18 08:15:12 +0200648 if (mxser_16550A_or_MUST(info)) {
Jiri Slaby1c456072008-02-07 00:16:46 -0800649 info->MCR |= UART_MCR_AFE;
650 } else {
Jiri Slabybe486662021-06-18 08:15:04 +0200651 mxser_handle_cts(tty, info,
652 inb(info->ioaddr + UART_MSR));
Jiri Slaby1c456072008-02-07 00:16:46 -0800653 }
Jiri Slaby1c456072008-02-07 00:16:46 -0800654 }
655 outb(info->MCR, info->ioaddr + UART_MCR);
Peter Hurley2d686552016-04-09 17:53:23 -0700656 tty_port_set_check_carrier(&info->port, ~cflag & CLOCAL);
657 if (~cflag & CLOCAL)
Jiri Slaby1c456072008-02-07 00:16:46 -0800658 info->IER |= UART_IER_MSI;
Jiri Slaby1c456072008-02-07 00:16:46 -0800659 outb(info->IER, info->ioaddr + UART_IER);
660
661 /*
662 * Set up parity check flag
663 */
664 info->read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR;
Alan Cox216ba022008-10-13 10:40:19 +0100665 if (I_INPCK(tty))
Jiri Slaby1c456072008-02-07 00:16:46 -0800666 info->read_status_mask |= UART_LSR_FE | UART_LSR_PE;
Alan Cox216ba022008-10-13 10:40:19 +0100667 if (I_BRKINT(tty) || I_PARMRK(tty))
Jiri Slaby1c456072008-02-07 00:16:46 -0800668 info->read_status_mask |= UART_LSR_BI;
669
670 info->ignore_status_mask = 0;
671
Alan Cox216ba022008-10-13 10:40:19 +0100672 if (I_IGNBRK(tty)) {
Jiri Slaby1c456072008-02-07 00:16:46 -0800673 info->ignore_status_mask |= UART_LSR_BI;
674 info->read_status_mask |= UART_LSR_BI;
675 /*
676 * If we're ignore parity and break indicators, ignore
677 * overruns too. (For real raw support).
678 */
Alan Cox216ba022008-10-13 10:40:19 +0100679 if (I_IGNPAR(tty)) {
Jiri Slaby1c456072008-02-07 00:16:46 -0800680 info->ignore_status_mask |=
681 UART_LSR_OE |
682 UART_LSR_PE |
683 UART_LSR_FE;
684 info->read_status_mask |=
685 UART_LSR_OE |
686 UART_LSR_PE |
687 UART_LSR_FE;
688 }
689 }
Jiri Slaby292955a2021-06-18 08:14:13 +0200690 if (info->board->must_hwid) {
Alan Cox216ba022008-10-13 10:40:19 +0100691 mxser_set_must_xon1_value(info->ioaddr, START_CHAR(tty));
692 mxser_set_must_xoff1_value(info->ioaddr, STOP_CHAR(tty));
Jiri Slabyb441eb02021-06-18 08:14:48 +0200693 mxser_must_set_rx_sw_flow_control(info->ioaddr, I_IXON(tty));
694 mxser_must_set_tx_sw_flow_control(info->ioaddr, I_IXOFF(tty));
Jiri Slaby1c456072008-02-07 00:16:46 -0800695 }
696
697
Jiri Slabyd249e662021-09-22 09:59:38 +0200698 outb(info->FCR, info->ioaddr + UART_FCR);
Jiri Slaby1c456072008-02-07 00:16:46 -0800699 outb(cval, info->ioaddr + UART_LCR);
Jiri Slaby1c456072008-02-07 00:16:46 -0800700}
701
Jiri Slaby30f60272021-11-18 08:31:10 +0100702static u8 mxser_check_modem_status(struct tty_struct *tty,
703 struct mxser_port *port)
Jiri Slaby1c456072008-02-07 00:16:46 -0800704{
Jiri Slaby30f60272021-11-18 08:31:10 +0100705 u8 msr = inb(port->ioaddr + UART_MSR);
706
707 if (!(msr & UART_MSR_ANY_DELTA))
708 return msr;
709
Jiri Slaby1c456072008-02-07 00:16:46 -0800710 /* update input line counters */
Jiri Slaby30f60272021-11-18 08:31:10 +0100711 if (msr & UART_MSR_TERI)
Jiri Slaby1c456072008-02-07 00:16:46 -0800712 port->icount.rng++;
Jiri Slaby30f60272021-11-18 08:31:10 +0100713 if (msr & UART_MSR_DDSR)
Jiri Slaby1c456072008-02-07 00:16:46 -0800714 port->icount.dsr++;
Jiri Slaby30f60272021-11-18 08:31:10 +0100715 if (msr & UART_MSR_DDCD)
Jiri Slaby1c456072008-02-07 00:16:46 -0800716 port->icount.dcd++;
Jiri Slaby30f60272021-11-18 08:31:10 +0100717 if (msr & UART_MSR_DCTS)
Jiri Slaby1c456072008-02-07 00:16:46 -0800718 port->icount.cts++;
Alan Coxbdc04e32009-09-19 13:13:31 -0700719 wake_up_interruptible(&port->port.delta_msr_wait);
Jiri Slaby1c456072008-02-07 00:16:46 -0800720
Jiri Slaby30f60272021-11-18 08:31:10 +0100721 if (tty_port_check_carrier(&port->port) && (msr & UART_MSR_DDCD)) {
722 if (msr & UART_MSR_DCD)
Alan Cox0ad9e7d2008-07-16 21:56:10 +0100723 wake_up_interruptible(&port->port.open_wait);
Jiri Slaby1c456072008-02-07 00:16:46 -0800724 }
725
Jiri Slabybe486662021-06-18 08:15:04 +0200726 if (tty_port_cts_enabled(&port->port))
Jiri Slaby30f60272021-11-18 08:31:10 +0100727 mxser_handle_cts(tty, port, msr);
728
729 return msr;
Jiri Slaby1c456072008-02-07 00:16:46 -0800730}
731
Jiri Slabyee7e5e62021-09-22 09:59:36 +0200732static void mxser_disable_and_clear_FIFO(struct mxser_port *info)
733{
734 u8 fcr = UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT;
735
736 if (info->board->must_hwid)
737 fcr |= MOXA_MUST_FCR_GDA_MODE_ENABLE;
738
739 outb(fcr, info->ioaddr + UART_FCR);
740}
741
Alan Cox67691402009-11-30 13:17:35 +0000742static int mxser_activate(struct tty_port *port, struct tty_struct *tty)
Jiri Slaby1c456072008-02-07 00:16:46 -0800743{
Alan Cox67691402009-11-30 13:17:35 +0000744 struct mxser_port *info = container_of(port, struct mxser_port, port);
Jiri Slaby1c456072008-02-07 00:16:46 -0800745 unsigned long page;
746 unsigned long flags;
747
748 page = __get_free_page(GFP_KERNEL);
749 if (!page)
750 return -ENOMEM;
751
752 spin_lock_irqsave(&info->slock, flags);
753
Jiri Slaby987a4cf2021-06-18 08:15:00 +0200754 if (!info->type) {
Alan Cox216ba022008-10-13 10:40:19 +0100755 set_bit(TTY_IO_ERROR, &tty->flags);
Jiri Slaby1c456072008-02-07 00:16:46 -0800756 free_page(page);
757 spin_unlock_irqrestore(&info->slock, flags);
758 return 0;
759 }
Alan Cox67691402009-11-30 13:17:35 +0000760 info->port.xmit_buf = (unsigned char *) page;
Jiri Slaby1c456072008-02-07 00:16:46 -0800761
762 /*
763 * Clear the FIFO buffers and disable them
764 * (they will be reenabled in mxser_change_speed())
765 */
Jiri Slabyee7e5e62021-09-22 09:59:36 +0200766 mxser_disable_and_clear_FIFO(info);
Jiri Slaby1c456072008-02-07 00:16:46 -0800767
768 /*
769 * At this point there's no way the LSR could still be 0xFF;
770 * if it is, then bail out, because there's likely no UART
771 * here.
772 */
773 if (inb(info->ioaddr + UART_LSR) == 0xff) {
774 spin_unlock_irqrestore(&info->slock, flags);
775 if (capable(CAP_SYS_ADMIN)) {
Jiri Slabyf43a510d2009-12-09 12:34:15 -0800776 set_bit(TTY_IO_ERROR, &tty->flags);
Jiri Slaby1c456072008-02-07 00:16:46 -0800777 return 0;
778 } else
779 return -ENODEV;
780 }
781
782 /*
783 * Clear the interrupt registers.
784 */
785 (void) inb(info->ioaddr + UART_LSR);
786 (void) inb(info->ioaddr + UART_RX);
787 (void) inb(info->ioaddr + UART_IIR);
788 (void) inb(info->ioaddr + UART_MSR);
789
790 /*
791 * Now, initialize the UART
792 */
793 outb(UART_LCR_WLEN8, info->ioaddr + UART_LCR); /* reset DLAB */
794 info->MCR = UART_MCR_DTR | UART_MCR_RTS;
795 outb(info->MCR, info->ioaddr + UART_MCR);
796
797 /*
798 * Finally, enable interrupts
799 */
800 info->IER = UART_IER_MSI | UART_IER_RLSI | UART_IER_RDI;
801
Jiri Slaby292955a2021-06-18 08:14:13 +0200802 if (info->board->must_hwid)
Jiri Slaby1c456072008-02-07 00:16:46 -0800803 info->IER |= MOXA_MUST_IER_EGDAI;
804 outb(info->IER, info->ioaddr + UART_IER); /* enable interrupts */
805
806 /*
807 * And clear the interrupt registers again for luck.
808 */
809 (void) inb(info->ioaddr + UART_LSR);
810 (void) inb(info->ioaddr + UART_RX);
811 (void) inb(info->ioaddr + UART_IIR);
812 (void) inb(info->ioaddr + UART_MSR);
813
Alan Cox216ba022008-10-13 10:40:19 +0100814 clear_bit(TTY_IO_ERROR, &tty->flags);
Jiri Slaby1c456072008-02-07 00:16:46 -0800815 info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
816
817 /*
818 * and set the speed of the serial port
819 */
Jiri Slaby3fdfa162021-09-22 09:59:32 +0200820 mxser_change_speed(tty, NULL);
Jiri Slaby1c456072008-02-07 00:16:46 -0800821 spin_unlock_irqrestore(&info->slock, flags);
822
823 return 0;
824}
825
826/*
Jiri Slaby47b722d2021-11-18 08:31:14 +0100827 * To stop accepting input, we disable the receive line status interrupts, and
828 * tell the interrupt driver to stop checking the data ready bit in the line
829 * status register.
830 */
831static void mxser_stop_rx(struct mxser_port *info)
832{
833 info->IER &= ~UART_IER_RLSI;
834 if (info->board->must_hwid)
835 info->IER &= ~MOXA_MUST_RECV_ISR;
836
837 outb(info->IER, info->ioaddr + UART_IER);
838}
839
840/*
Alan Cox67691402009-11-30 13:17:35 +0000841 * This routine will shutdown a serial port
Jiri Slaby1c456072008-02-07 00:16:46 -0800842 */
Alan Cox67691402009-11-30 13:17:35 +0000843static void mxser_shutdown_port(struct tty_port *port)
Jiri Slaby1c456072008-02-07 00:16:46 -0800844{
Alan Cox67691402009-11-30 13:17:35 +0000845 struct mxser_port *info = container_of(port, struct mxser_port, port);
Jiri Slaby1c456072008-02-07 00:16:46 -0800846 unsigned long flags;
847
Jiri Slaby1c456072008-02-07 00:16:46 -0800848 spin_lock_irqsave(&info->slock, flags);
849
Jiri Slaby47b722d2021-11-18 08:31:14 +0100850 mxser_stop_rx(info);
851
Jiri Slaby1c456072008-02-07 00:16:46 -0800852 /*
853 * clear delta_msr_wait queue to avoid mem leaks: we may free the irq
854 * here so the queue might never be waken up
855 */
Alan Coxbdc04e32009-09-19 13:13:31 -0700856 wake_up_interruptible(&info->port.delta_msr_wait);
Jiri Slaby1c456072008-02-07 00:16:46 -0800857
858 /*
Alan Cox67691402009-11-30 13:17:35 +0000859 * Free the xmit buffer, if necessary
Jiri Slaby1c456072008-02-07 00:16:46 -0800860 */
Alan Cox0ad9e7d2008-07-16 21:56:10 +0100861 if (info->port.xmit_buf) {
862 free_page((unsigned long) info->port.xmit_buf);
863 info->port.xmit_buf = NULL;
Jiri Slaby1c456072008-02-07 00:16:46 -0800864 }
865
866 info->IER = 0;
867 outb(0x00, info->ioaddr + UART_IER);
868
Jiri Slaby1c456072008-02-07 00:16:46 -0800869 /* clear Rx/Tx FIFO's */
Jiri Slabyee7e5e62021-09-22 09:59:36 +0200870 mxser_disable_and_clear_FIFO(info);
Jiri Slaby1c456072008-02-07 00:16:46 -0800871
872 /* read data port to reset things */
873 (void) inb(info->ioaddr + UART_RX);
874
Jiri Slaby1c456072008-02-07 00:16:46 -0800875
Jiri Slaby292955a2021-06-18 08:14:13 +0200876 if (info->board->must_hwid)
Jiri Slabyb441eb02021-06-18 08:14:48 +0200877 mxser_must_no_sw_flow_control(info->ioaddr);
Jiri Slaby1c456072008-02-07 00:16:46 -0800878
879 spin_unlock_irqrestore(&info->slock, flags);
880}
881
Linus Torvalds1da177e2005-04-16 15:20:36 -0700882/*
883 * This routine is called whenever a serial port is opened. It
884 * enables interrupts for a serial port, linking in its async structure into
885 * the IRQ chain. It also performs the serial-specific
886 * initialization for the tty structure.
887 */
888static int mxser_open(struct tty_struct *tty, struct file *filp)
889{
Jiri Slaby42ad25f2021-06-18 08:14:56 +0200890 struct tty_port *tport = tty->port;
891 struct mxser_port *port = container_of(tport, struct mxser_port, port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700892
Jiri Slaby42ad25f2021-06-18 08:14:56 +0200893 tty->driver_data = port;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700894
Jiri Slaby42ad25f2021-06-18 08:14:56 +0200895 return tty_port_open(tport, tty, filp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700896}
897
Alan Cox978e5952008-04-30 00:53:59 -0700898static void mxser_flush_buffer(struct tty_struct *tty)
899{
900 struct mxser_port *info = tty->driver_data;
Alan Cox978e5952008-04-30 00:53:59 -0700901 unsigned long flags;
902
903
904 spin_lock_irqsave(&info->slock, flags);
905 info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
906
Jiri Slabyd249e662021-09-22 09:59:38 +0200907 outb(info->FCR | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT,
Alan Cox978e5952008-04-30 00:53:59 -0700908 info->ioaddr + UART_FCR);
Alan Cox978e5952008-04-30 00:53:59 -0700909
910 spin_unlock_irqrestore(&info->slock, flags);
911
912 tty_wakeup(tty);
913}
914
Alan Cox1e2b0252009-09-19 13:13:21 -0700915static void mxser_close(struct tty_struct *tty, struct file *filp)
916{
Jiri Slabyc7ec0122021-11-18 08:31:16 +0100917 tty_port_close(tty->port, tty, filp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918}
919
920static int mxser_write(struct tty_struct *tty, const unsigned char *buf, int count)
921{
922 int c, total = 0;
Jiri Slaby1c456072008-02-07 00:16:46 -0800923 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700924 unsigned long flags;
925
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926 while (1) {
Jesper Juhl8ea2c2e2006-06-25 05:47:54 -0700927 c = min_t(int, count, min(SERIAL_XMIT_SIZE - info->xmit_cnt - 1,
928 SERIAL_XMIT_SIZE - info->xmit_head));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700929 if (c <= 0)
930 break;
931
Alan Cox0ad9e7d2008-07-16 21:56:10 +0100932 memcpy(info->port.xmit_buf + info->xmit_head, buf, c);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700933 spin_lock_irqsave(&info->slock, flags);
Jesper Juhl8ea2c2e2006-06-25 05:47:54 -0700934 info->xmit_head = (info->xmit_head + c) &
935 (SERIAL_XMIT_SIZE - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700936 info->xmit_cnt += c;
937 spin_unlock_irqrestore(&info->slock, flags);
938
939 buf += c;
940 count -= c;
941 total += c;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700942 }
943
Jiri Slaby5d1ea1a2021-06-18 08:15:12 +0200944 if (info->xmit_cnt && !tty->flow.stopped)
945 if (!tty->hw_stopped || mxser_16550A_or_MUST(info))
Jiri Slaby740165f2021-06-18 08:15:05 +0200946 mxser_start_tx(info);
Jiri Slaby5d1ea1a2021-06-18 08:15:12 +0200947
Linus Torvalds1da177e2005-04-16 15:20:36 -0700948 return total;
949}
950
Alan Cox0be2ead2008-04-30 00:54:03 -0700951static int mxser_put_char(struct tty_struct *tty, unsigned char ch)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952{
Jiri Slaby1c456072008-02-07 00:16:46 -0800953 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700954 unsigned long flags;
955
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956 if (info->xmit_cnt >= SERIAL_XMIT_SIZE - 1)
Alan Cox0be2ead2008-04-30 00:54:03 -0700957 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700958
959 spin_lock_irqsave(&info->slock, flags);
Alan Cox0ad9e7d2008-07-16 21:56:10 +0100960 info->port.xmit_buf[info->xmit_head++] = ch;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961 info->xmit_head &= SERIAL_XMIT_SIZE - 1;
962 info->xmit_cnt++;
963 spin_unlock_irqrestore(&info->slock, flags);
Jiri Slaby8aff64e2021-06-18 08:15:03 +0200964
Alan Cox0be2ead2008-04-30 00:54:03 -0700965 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966}
967
968
969static void mxser_flush_chars(struct tty_struct *tty)
970{
Jiri Slaby1c456072008-02-07 00:16:46 -0800971 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700972
Jiri Slaby5c338fb2021-11-18 08:31:12 +0100973 if (!info->xmit_cnt || tty->flow.stopped ||
Jiri Slaby5d1ea1a2021-06-18 08:15:12 +0200974 (tty->hw_stopped && !mxser_16550A_or_MUST(info)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700975 return;
976
Jiri Slaby740165f2021-06-18 08:15:05 +0200977 mxser_start_tx(info);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700978}
979
Jiri Slaby03b3b1a2021-05-05 11:19:15 +0200980static unsigned int mxser_write_room(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700981{
Jiri Slaby1c456072008-02-07 00:16:46 -0800982 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983 int ret;
984
985 ret = SERIAL_XMIT_SIZE - info->xmit_cnt - 1;
Jiri Slabyace7dd92008-07-25 01:48:22 -0700986 return ret < 0 ? 0 : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700987}
988
Jiri Slabyfff4ef12021-05-05 11:19:19 +0200989static unsigned int mxser_chars_in_buffer(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700990{
Jiri Slaby1c456072008-02-07 00:16:46 -0800991 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700992 return info->xmit_cnt;
993}
994
Jiri Slaby1c456072008-02-07 00:16:46 -0800995/*
996 * ------------------------------------------------------------
997 * friends of mxser_ioctl()
998 * ------------------------------------------------------------
999 */
Alan Cox216ba022008-10-13 10:40:19 +01001000static int mxser_get_serial_info(struct tty_struct *tty,
Al Viro6da5b582018-09-11 22:22:06 -04001001 struct serial_struct *ss)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001002{
Alan Cox216ba022008-10-13 10:40:19 +01001003 struct mxser_port *info = tty->driver_data;
Al Viro6da5b582018-09-11 22:22:06 -04001004 struct tty_port *port = &info->port;
Johan Hovoldbe6cf582021-04-07 12:23:31 +02001005 unsigned int closing_wait, close_delay;
Al Viro6da5b582018-09-11 22:22:06 -04001006
Al Viro6da5b582018-09-11 22:22:06 -04001007 mutex_lock(&port->mutex);
Johan Hovoldbe6cf582021-04-07 12:23:31 +02001008
1009 close_delay = jiffies_to_msecs(info->port.close_delay) / 10;
1010 closing_wait = info->port.closing_wait;
1011 if (closing_wait != ASYNC_CLOSING_WAIT_NONE)
1012 closing_wait = jiffies_to_msecs(closing_wait) / 10;
1013
Dan Carpenter2285c492021-08-25 10:24:35 +03001014 ss->type = info->type;
1015 ss->line = tty->index;
1016 ss->port = info->ioaddr;
1017 ss->irq = info->board->irq;
1018 ss->flags = info->port.flags;
1019 ss->baud_base = MXSER_BAUD_BASE;
Johan Hovoldbe6cf582021-04-07 12:23:31 +02001020 ss->close_delay = close_delay;
1021 ss->closing_wait = closing_wait;
Jiri Slabyd811b262021-06-18 08:14:42 +02001022 ss->custom_divisor = MXSER_CUSTOM_DIVISOR,
Al Viro6da5b582018-09-11 22:22:06 -04001023 mutex_unlock(&port->mutex);
Jiri Slaby1c456072008-02-07 00:16:46 -08001024 return 0;
1025}
1026
Alan Cox216ba022008-10-13 10:40:19 +01001027static int mxser_set_serial_info(struct tty_struct *tty,
Al Viro6da5b582018-09-11 22:22:06 -04001028 struct serial_struct *ss)
Jiri Slaby1c456072008-02-07 00:16:46 -08001029{
Alan Cox216ba022008-10-13 10:40:19 +01001030 struct mxser_port *info = tty->driver_data;
Alan Cox07f86c02009-11-30 13:17:41 +00001031 struct tty_port *port = &info->port;
Jiri Slaby80ff8a82008-02-07 00:16:51 -08001032 speed_t baud;
Jiri Slaby1c456072008-02-07 00:16:46 -08001033 unsigned long sl_flags;
Jiri Slaby06cc52e2021-06-18 08:15:11 +02001034 unsigned int old_speed, close_delay, closing_wait;
Jiri Slaby1c456072008-02-07 00:16:46 -08001035 int retval = 0;
1036
Al Viro6da5b582018-09-11 22:22:06 -04001037 if (tty_io_error(tty))
1038 return -EIO;
Jiri Slaby1c456072008-02-07 00:16:46 -08001039
Al Viro6da5b582018-09-11 22:22:06 -04001040 mutex_lock(&port->mutex);
Al Viro6da5b582018-09-11 22:22:06 -04001041
1042 if (ss->irq != info->board->irq ||
1043 ss->port != info->ioaddr) {
1044 mutex_unlock(&port->mutex);
Jiri Slaby80ff8a82008-02-07 00:16:51 -08001045 return -EINVAL;
Al Viro6da5b582018-09-11 22:22:06 -04001046 }
Jiri Slaby1c456072008-02-07 00:16:46 -08001047
Jiri Slaby06cc52e2021-06-18 08:15:11 +02001048 old_speed = port->flags & ASYNC_SPD_MASK;
Jiri Slaby1c456072008-02-07 00:16:46 -08001049
Johan Hovoldbe6cf582021-04-07 12:23:31 +02001050 close_delay = msecs_to_jiffies(ss->close_delay * 10);
1051 closing_wait = ss->closing_wait;
1052 if (closing_wait != ASYNC_CLOSING_WAIT_NONE)
1053 closing_wait = msecs_to_jiffies(closing_wait * 10);
1054
Jiri Slaby1c456072008-02-07 00:16:46 -08001055 if (!capable(CAP_SYS_ADMIN)) {
Jiri Slabya6970c32021-06-18 08:14:41 +02001056 if ((ss->baud_base != MXSER_BAUD_BASE) ||
Jiri Slaby1b3086b2021-06-18 08:15:10 +02001057 (close_delay != port->close_delay) ||
1058 (closing_wait != port->closing_wait) ||
1059 ((ss->flags & ~ASYNC_USR_MASK) != (port->flags & ~ASYNC_USR_MASK))) {
Al Viro6da5b582018-09-11 22:22:06 -04001060 mutex_unlock(&port->mutex);
Jiri Slaby1c456072008-02-07 00:16:46 -08001061 return -EPERM;
Al Viro6da5b582018-09-11 22:22:06 -04001062 }
Jiri Slaby1b3086b2021-06-18 08:15:10 +02001063 port->flags = (port->flags & ~ASYNC_USR_MASK) |
1064 (ss->flags & ASYNC_USR_MASK);
Jiri Slaby1c456072008-02-07 00:16:46 -08001065 } else {
1066 /*
1067 * OK, past this point, all the error checking has been done.
1068 * At this point, we start making changes.....
1069 */
Alan Cox07f86c02009-11-30 13:17:41 +00001070 port->flags = ((port->flags & ~ASYNC_FLAGS) |
Al Viro6da5b582018-09-11 22:22:06 -04001071 (ss->flags & ASYNC_FLAGS));
Johan Hovoldbe6cf582021-04-07 12:23:31 +02001072 port->close_delay = close_delay;
1073 port->closing_wait = closing_wait;
Alan Cox07f86c02009-11-30 13:17:41 +00001074 if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST &&
Jiri Slabya6970c32021-06-18 08:14:41 +02001075 (ss->baud_base != MXSER_BAUD_BASE ||
Al Viro6da5b582018-09-11 22:22:06 -04001076 ss->custom_divisor !=
Jiri Slabyd811b262021-06-18 08:14:42 +02001077 MXSER_CUSTOM_DIVISOR)) {
Al Viro6da5b582018-09-11 22:22:06 -04001078 if (ss->custom_divisor == 0) {
1079 mutex_unlock(&port->mutex);
Alan Cox07f86c02009-11-30 13:17:41 +00001080 return -EINVAL;
Al Viro6da5b582018-09-11 22:22:06 -04001081 }
1082 baud = ss->baud_base / ss->custom_divisor;
Alan Cox216ba022008-10-13 10:40:19 +01001083 tty_encode_baud_rate(tty, baud, baud);
Jiri Slaby80ff8a82008-02-07 00:16:51 -08001084 }
Johan Hovoldb91cfb22021-04-07 12:23:32 +02001085
1086 info->type = ss->type;
1087
Jiri Slabyc3db20c2021-06-18 08:14:55 +02001088 mxser_process_txrx_fifo(info);
Jiri Slaby1c456072008-02-07 00:16:46 -08001089 }
1090
Peter Hurleyd41861c2016-04-09 17:53:25 -07001091 if (tty_port_initialized(port)) {
Jiri Slaby06cc52e2021-06-18 08:15:11 +02001092 if (old_speed != (port->flags & ASYNC_SPD_MASK)) {
Jiri Slaby1c456072008-02-07 00:16:46 -08001093 spin_lock_irqsave(&info->slock, sl_flags);
Jiri Slaby3fdfa162021-09-22 09:59:32 +02001094 mxser_change_speed(tty, NULL);
Jiri Slaby1c456072008-02-07 00:16:46 -08001095 spin_unlock_irqrestore(&info->slock, sl_flags);
1096 }
Alan Cox67691402009-11-30 13:17:35 +00001097 } else {
Alan Cox07f86c02009-11-30 13:17:41 +00001098 retval = mxser_activate(port, tty);
Alan Cox67691402009-11-30 13:17:35 +00001099 if (retval == 0)
Peter Hurleyd41861c2016-04-09 17:53:25 -07001100 tty_port_set_initialized(port, 1);
Alan Cox67691402009-11-30 13:17:35 +00001101 }
Al Viro6da5b582018-09-11 22:22:06 -04001102 mutex_unlock(&port->mutex);
Jiri Slaby1c456072008-02-07 00:16:46 -08001103 return retval;
1104}
1105
1106/*
1107 * mxser_get_lsr_info - get line status register info
1108 *
1109 * Purpose: Let user call ioctl() to get info when the UART physically
1110 * is emptied. On bus types like RS485, the transmitter must
1111 * release the bus after transmitting. This must be done when
1112 * the transmit shift register is empty, not be done when the
1113 * transmit holding register is empty. This functionality
1114 * allows an RS485 driver to be written in user space.
1115 */
1116static int mxser_get_lsr_info(struct mxser_port *info,
1117 unsigned int __user *value)
1118{
1119 unsigned char status;
1120 unsigned int result;
1121 unsigned long flags;
1122
1123 spin_lock_irqsave(&info->slock, flags);
1124 status = inb(info->ioaddr + UART_LSR);
1125 spin_unlock_irqrestore(&info->slock, flags);
1126 result = ((status & UART_LSR_TEMT) ? TIOCSER_TEMT : 0);
1127 return put_user(result, value);
1128}
1129
Alan Cox60b33c12011-02-14 16:26:14 +00001130static int mxser_tiocmget(struct tty_struct *tty)
Jiri Slaby1c456072008-02-07 00:16:46 -08001131{
1132 struct mxser_port *info = tty->driver_data;
Jiri Slaby30f60272021-11-18 08:31:10 +01001133 unsigned char control;
Jiri Slaby1c456072008-02-07 00:16:46 -08001134 unsigned long flags;
Jiri Slaby30f60272021-11-18 08:31:10 +01001135 u8 msr;
Jiri Slaby1c456072008-02-07 00:16:46 -08001136
Peter Hurley18900ca2016-04-09 17:06:48 -07001137 if (tty_io_error(tty))
Jiri Slaby1c456072008-02-07 00:16:46 -08001138 return -EIO;
1139
Jiri Slaby1c456072008-02-07 00:16:46 -08001140 spin_lock_irqsave(&info->slock, flags);
Jiri Slaby202acda2021-06-18 08:15:09 +02001141 control = info->MCR;
Jiri Slaby30f60272021-11-18 08:31:10 +01001142 msr = mxser_check_modem_status(tty, info);
Jiri Slaby1c456072008-02-07 00:16:46 -08001143 spin_unlock_irqrestore(&info->slock, flags);
Jiri Slaby202acda2021-06-18 08:15:09 +02001144
Jiri Slaby1c456072008-02-07 00:16:46 -08001145 return ((control & UART_MCR_RTS) ? TIOCM_RTS : 0) |
1146 ((control & UART_MCR_DTR) ? TIOCM_DTR : 0) |
Jiri Slaby30f60272021-11-18 08:31:10 +01001147 ((msr & UART_MSR_DCD) ? TIOCM_CAR : 0) |
1148 ((msr & UART_MSR_RI) ? TIOCM_RNG : 0) |
1149 ((msr & UART_MSR_DSR) ? TIOCM_DSR : 0) |
1150 ((msr & UART_MSR_CTS) ? TIOCM_CTS : 0);
Jiri Slaby1c456072008-02-07 00:16:46 -08001151}
1152
Alan Cox20b9d172011-02-14 16:26:50 +00001153static int mxser_tiocmset(struct tty_struct *tty,
Jiri Slaby1c456072008-02-07 00:16:46 -08001154 unsigned int set, unsigned int clear)
1155{
1156 struct mxser_port *info = tty->driver_data;
1157 unsigned long flags;
1158
Peter Hurley18900ca2016-04-09 17:06:48 -07001159 if (tty_io_error(tty))
Jiri Slaby1c456072008-02-07 00:16:46 -08001160 return -EIO;
1161
1162 spin_lock_irqsave(&info->slock, flags);
1163
1164 if (set & TIOCM_RTS)
1165 info->MCR |= UART_MCR_RTS;
1166 if (set & TIOCM_DTR)
1167 info->MCR |= UART_MCR_DTR;
1168
1169 if (clear & TIOCM_RTS)
1170 info->MCR &= ~UART_MCR_RTS;
1171 if (clear & TIOCM_DTR)
1172 info->MCR &= ~UART_MCR_DTR;
1173
1174 outb(info->MCR, info->ioaddr + UART_MCR);
1175 spin_unlock_irqrestore(&info->slock, flags);
1176 return 0;
1177}
1178
Jiri Slaby1c456072008-02-07 00:16:46 -08001179static int mxser_cflags_changed(struct mxser_port *info, unsigned long arg,
1180 struct async_icount *cprev)
1181{
1182 struct async_icount cnow;
1183 unsigned long flags;
1184 int ret;
1185
1186 spin_lock_irqsave(&info->slock, flags);
1187 cnow = info->icount; /* atomic copy */
1188 spin_unlock_irqrestore(&info->slock, flags);
1189
1190 ret = ((arg & TIOCM_RNG) && (cnow.rng != cprev->rng)) ||
1191 ((arg & TIOCM_DSR) && (cnow.dsr != cprev->dsr)) ||
1192 ((arg & TIOCM_CD) && (cnow.dcd != cprev->dcd)) ||
1193 ((arg & TIOCM_CTS) && (cnow.cts != cprev->cts));
1194
1195 *cprev = cnow;
1196
1197 return ret;
1198}
1199
Jiri Slaby9fae5f82021-06-18 08:14:44 +02001200/* We should likely switch to TIOCGRS485/TIOCSRS485. */
1201static int mxser_ioctl_op_mode(struct mxser_port *port, int index, bool set,
1202 int __user *u_opmode)
1203{
Jiri Slaby9fae5f82021-06-18 08:14:44 +02001204 int opmode, p = index % 4;
1205 int shiftbit = p * 2;
Jiri Slaby238d1172021-06-18 08:14:45 +02001206 u8 val;
Jiri Slaby9fae5f82021-06-18 08:14:44 +02001207
1208 if (port->board->must_hwid != MOXA_MUST_MU860_HWID)
1209 return -EFAULT;
1210
1211 if (set) {
1212 if (get_user(opmode, u_opmode))
1213 return -EFAULT;
1214
Jiri Slaby238d1172021-06-18 08:14:45 +02001215 if (opmode & ~OP_MODE_MASK)
1216 return -EINVAL;
Jiri Slaby9fae5f82021-06-18 08:14:44 +02001217
1218 spin_lock_irq(&port->slock);
1219 val = inb(port->opmode_ioaddr);
Jiri Slaby238d1172021-06-18 08:14:45 +02001220 val &= ~(OP_MODE_MASK << shiftbit);
Jiri Slaby9fae5f82021-06-18 08:14:44 +02001221 val |= (opmode << shiftbit);
1222 outb(val, port->opmode_ioaddr);
1223 spin_unlock_irq(&port->slock);
Jiri Slaby9fae5f82021-06-18 08:14:44 +02001224
Jiri Slaby238d1172021-06-18 08:14:45 +02001225 return 0;
Jiri Slaby9fae5f82021-06-18 08:14:44 +02001226 }
1227
Jiri Slaby238d1172021-06-18 08:14:45 +02001228 spin_lock_irq(&port->slock);
1229 opmode = inb(port->opmode_ioaddr) >> shiftbit;
1230 spin_unlock_irq(&port->slock);
1231
1232 return put_user(opmode & OP_MODE_MASK, u_opmode);
Jiri Slaby9fae5f82021-06-18 08:14:44 +02001233}
1234
Alan Cox6caa76b2011-02-14 16:27:22 +00001235static int mxser_ioctl(struct tty_struct *tty,
Jiri Slaby1c456072008-02-07 00:16:46 -08001236 unsigned int cmd, unsigned long arg)
1237{
1238 struct mxser_port *info = tty->driver_data;
1239 struct async_icount cnow;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240 unsigned long flags;
1241 void __user *argp = (void __user *)arg;
1242
Jiri Slaby9fae5f82021-06-18 08:14:44 +02001243 if (cmd == MOXA_SET_OP_MODE || cmd == MOXA_GET_OP_MODE)
1244 return mxser_ioctl_op_mode(info, tty->index,
1245 cmd == MOXA_SET_OP_MODE, argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001246
Al Viro6da5b582018-09-11 22:22:06 -04001247 if (cmd != TIOCMIWAIT && tty_io_error(tty))
Jiri Slaby1c456072008-02-07 00:16:46 -08001248 return -EIO;
1249
Linus Torvalds1da177e2005-04-16 15:20:36 -07001250 switch (cmd) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001251 case TIOCSERGETLSR: /* Get line status register */
Alan Cox9d6d1622008-04-30 00:53:20 -07001252 return mxser_get_lsr_info(info, argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001253 /*
1254 * Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change
1255 * - mask passed in arg for lines of interest
1256 * (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
1257 * Caller should use TIOCGICOUNT to see which one it was
1258 */
Jiri Slabyfc838152007-04-23 14:41:04 -07001259 case TIOCMIWAIT:
1260 spin_lock_irqsave(&info->slock, flags);
1261 cnow = info->icount; /* note the counters on entry */
1262 spin_unlock_irqrestore(&info->slock, flags);
1263
Alan Coxbdc04e32009-09-19 13:13:31 -07001264 return wait_event_interruptible(info->port.delta_msr_wait,
Jiri Slaby1c456072008-02-07 00:16:46 -08001265 mxser_cflags_changed(info, arg, &cnow));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001266 default:
1267 return -ENOIOCTLCMD;
1268 }
1269 return 0;
1270}
1271
Alan Cox05871022010-09-16 18:21:52 +01001272 /*
1273 * Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
1274 * Return: write counters to the user passed counter struct
1275 * NB: both 1->0 and 0->1 transitions are counted except for
1276 * RI where only 0->1 is counted.
1277 */
1278
1279static int mxser_get_icount(struct tty_struct *tty,
1280 struct serial_icounter_struct *icount)
1281
1282{
1283 struct mxser_port *info = tty->driver_data;
1284 struct async_icount cnow;
1285 unsigned long flags;
1286
1287 spin_lock_irqsave(&info->slock, flags);
1288 cnow = info->icount;
1289 spin_unlock_irqrestore(&info->slock, flags);
1290
1291 icount->frame = cnow.frame;
1292 icount->brk = cnow.brk;
1293 icount->overrun = cnow.overrun;
1294 icount->buf_overrun = cnow.buf_overrun;
1295 icount->parity = cnow.parity;
1296 icount->rx = cnow.rx;
1297 icount->tx = cnow.tx;
1298 icount->cts = cnow.cts;
1299 icount->dsr = cnow.dsr;
1300 icount->rng = cnow.rng;
1301 icount->dcd = cnow.dcd;
1302 return 0;
1303}
1304
Jiri Slabyc6693e62021-11-18 08:31:20 +01001305/*
1306 * This routine is called by the upper-layer tty layer to signal that
1307 * incoming characters should be throttled.
1308 */
1309static void mxser_throttle(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001310{
Jiri Slaby1c456072008-02-07 00:16:46 -08001311 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001312
Linus Torvalds1da177e2005-04-16 15:20:36 -07001313 if (I_IXOFF(tty)) {
Jiri Slaby292955a2021-06-18 08:14:13 +02001314 if (info->board->must_hwid) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001315 info->IER &= ~MOXA_MUST_RECV_ISR;
Jiri Slaby1c456072008-02-07 00:16:46 -08001316 outb(info->IER, info->ioaddr + UART_IER);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001317 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001318 info->x_char = STOP_CHAR(tty);
Jiri Slaby1c456072008-02-07 00:16:46 -08001319 outb(0, info->ioaddr + UART_IER);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001320 info->IER |= UART_IER_THRI;
Jiri Slaby1c456072008-02-07 00:16:46 -08001321 outb(info->IER, info->ioaddr + UART_IER);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001322 }
1323 }
1324
Peter Hurley9db276f2016-01-10 20:36:15 -08001325 if (C_CRTSCTS(tty)) {
Jiri Slaby1c456072008-02-07 00:16:46 -08001326 info->MCR &= ~UART_MCR_RTS;
1327 outb(info->MCR, info->ioaddr + UART_MCR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328 }
1329}
1330
Linus Torvalds1da177e2005-04-16 15:20:36 -07001331static void mxser_unthrottle(struct tty_struct *tty)
1332{
Jiri Slaby1c456072008-02-07 00:16:46 -08001333 struct mxser_port *info = tty->driver_data;
Jesper Juhl8ea2c2e2006-06-25 05:47:54 -07001334
Jiri Slaby1c456072008-02-07 00:16:46 -08001335 /* startrx */
Jiri Slaby1c456072008-02-07 00:16:46 -08001336 if (I_IXOFF(tty)) {
1337 if (info->x_char)
1338 info->x_char = 0;
1339 else {
Jiri Slaby292955a2021-06-18 08:14:13 +02001340 if (info->board->must_hwid) {
Jiri Slaby1c456072008-02-07 00:16:46 -08001341 info->IER |= MOXA_MUST_RECV_ISR;
1342 outb(info->IER, info->ioaddr + UART_IER);
1343 } else {
1344 info->x_char = START_CHAR(tty);
1345 outb(0, info->ioaddr + UART_IER);
1346 info->IER |= UART_IER_THRI;
1347 outb(info->IER, info->ioaddr + UART_IER);
1348 }
1349 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001350 }
1351
Peter Hurley9db276f2016-01-10 20:36:15 -08001352 if (C_CRTSCTS(tty)) {
Jiri Slaby1c456072008-02-07 00:16:46 -08001353 info->MCR |= UART_MCR_RTS;
1354 outb(info->MCR, info->ioaddr + UART_MCR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001355 }
1356}
1357
1358/*
1359 * mxser_stop() and mxser_start()
1360 *
Jiri Slaby6e94dbc2021-05-05 11:19:05 +02001361 * This routines are called before setting or resetting tty->flow.stopped.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001362 * They enable or disable transmitter interrupts, as necessary.
1363 */
1364static void mxser_stop(struct tty_struct *tty)
1365{
Jiri Slaby1c456072008-02-07 00:16:46 -08001366 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001367 unsigned long flags;
1368
1369 spin_lock_irqsave(&info->slock, flags);
Jiri Slaby740165f2021-06-18 08:15:05 +02001370 if (info->IER & UART_IER_THRI)
1371 __mxser_stop_tx(info);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001372 spin_unlock_irqrestore(&info->slock, flags);
1373}
1374
1375static void mxser_start(struct tty_struct *tty)
1376{
Jiri Slaby1c456072008-02-07 00:16:46 -08001377 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001378 unsigned long flags;
1379
1380 spin_lock_irqsave(&info->slock, flags);
Jiri Slaby5c338fb2021-11-18 08:31:12 +01001381 if (info->xmit_cnt)
Jiri Slaby740165f2021-06-18 08:15:05 +02001382 __mxser_start_tx(info);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001383 spin_unlock_irqrestore(&info->slock, flags);
1384}
1385
Jiri Slaby1c456072008-02-07 00:16:46 -08001386static void mxser_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
1387{
1388 struct mxser_port *info = tty->driver_data;
1389 unsigned long flags;
1390
1391 spin_lock_irqsave(&info->slock, flags);
Jiri Slaby3fdfa162021-09-22 09:59:32 +02001392 mxser_change_speed(tty, old_termios);
Jiri Slaby1c456072008-02-07 00:16:46 -08001393 spin_unlock_irqrestore(&info->slock, flags);
1394
Peter Hurley9db276f2016-01-10 20:36:15 -08001395 if ((old_termios->c_cflag & CRTSCTS) && !C_CRTSCTS(tty)) {
Jiri Slaby1c456072008-02-07 00:16:46 -08001396 tty->hw_stopped = 0;
1397 mxser_start(tty);
1398 }
1399
1400 /* Handle sw stopped */
Peter Hurley9db276f2016-01-10 20:36:15 -08001401 if ((old_termios->c_iflag & IXON) && !I_IXON(tty)) {
Jiri Slaby6e94dbc2021-05-05 11:19:05 +02001402 tty->flow.stopped = 0;
Jiri Slaby1c456072008-02-07 00:16:46 -08001403
Jiri Slaby292955a2021-06-18 08:14:13 +02001404 if (info->board->must_hwid) {
Jiri Slaby1c456072008-02-07 00:16:46 -08001405 spin_lock_irqsave(&info->slock, flags);
Jiri Slabyb441eb02021-06-18 08:14:48 +02001406 mxser_must_set_rx_sw_flow_control(info->ioaddr, false);
Jiri Slaby1c456072008-02-07 00:16:46 -08001407 spin_unlock_irqrestore(&info->slock, flags);
1408 }
1409
1410 mxser_start(tty);
1411 }
1412}
1413
Jiri Slaby239ef192021-11-18 08:31:17 +01001414static bool mxser_tx_empty(struct mxser_port *info)
1415{
1416 unsigned long flags;
1417 u8 lsr;
1418
1419 spin_lock_irqsave(&info->slock, flags);
1420 lsr = inb(info->ioaddr + UART_LSR);
1421 spin_unlock_irqrestore(&info->slock, flags);
1422
1423 return !(lsr & UART_LSR_TEMT);
1424}
1425
Linus Torvalds1da177e2005-04-16 15:20:36 -07001426/*
1427 * mxser_wait_until_sent() --- wait until the transmitter is empty
1428 */
1429static void mxser_wait_until_sent(struct tty_struct *tty, int timeout)
1430{
Jiri Slaby1c456072008-02-07 00:16:46 -08001431 struct mxser_port *info = tty->driver_data;
Jiri Slaby49b798a2021-11-18 08:31:19 +01001432 unsigned long expire, char_time;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001433
1434 if (info->type == PORT_UNKNOWN)
1435 return;
1436
1437 if (info->xmit_fifo_size == 0)
1438 return; /* Just in case.... */
1439
Linus Torvalds1da177e2005-04-16 15:20:36 -07001440 /*
1441 * Set the check interval to be 1/5 of the estimated time to
1442 * send a single character, and make it at least 1. The check
1443 * interval should also be less than the timeout.
1444 *
1445 * Note: we have to use pretty tight timings here to satisfy
1446 * the NIST-PCTS.
1447 */
1448 char_time = (info->timeout - HZ / 50) / info->xmit_fifo_size;
1449 char_time = char_time / 5;
1450 if (char_time == 0)
1451 char_time = 1;
1452 if (timeout && timeout < char_time)
1453 char_time = timeout;
Jiri Slabyfe74bc62021-11-18 08:31:18 +01001454
1455 char_time = jiffies_to_msecs(char_time);
1456
Linus Torvalds1da177e2005-04-16 15:20:36 -07001457 /*
1458 * If the transmitter hasn't cleared in twice the approximate
1459 * amount of time to send the entire FIFO, it probably won't
1460 * ever clear. This assumes the UART isn't doing flow
1461 * control, which is currently the case. Hence, if it ever
1462 * takes longer than info->timeout, this is probably due to a
1463 * UART bug of some kind. So, we clamp the timeout parameter at
1464 * 2*info->timeout.
1465 */
1466 if (!timeout || timeout > 2 * info->timeout)
1467 timeout = 2 * info->timeout;
Jiri Slaby8bab5342011-07-14 14:35:15 +02001468
Jiri Slaby49b798a2021-11-18 08:31:19 +01001469 expire = jiffies + timeout;
1470
Jiri Slaby239ef192021-11-18 08:31:17 +01001471 while (mxser_tx_empty(info)) {
Jiri Slabyfe74bc62021-11-18 08:31:18 +01001472 msleep_interruptible(char_time);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001473 if (signal_pending(current))
1474 break;
Jiri Slaby49b798a2021-11-18 08:31:19 +01001475 if (time_after(jiffies, expire))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001476 break;
1477 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001478}
1479
Linus Torvalds1da177e2005-04-16 15:20:36 -07001480/*
1481 * This routine is called by tty_hangup() when a hangup is signaled.
1482 */
Jiri Slaby1c456072008-02-07 00:16:46 -08001483static void mxser_hangup(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001484{
Jiri Slaby1c456072008-02-07 00:16:46 -08001485 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001486
1487 mxser_flush_buffer(tty);
Alan Cox3b6826b2009-01-02 13:45:58 +00001488 tty_port_hangup(&info->port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001489}
1490
Linus Torvalds1da177e2005-04-16 15:20:36 -07001491/*
1492 * mxser_rs_break() --- routine which turns the break handling on or off
1493 */
Alan Cox9e98966c2008-07-22 11:18:03 +01001494static int mxser_rs_break(struct tty_struct *tty, int break_state)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001495{
Jiri Slaby1c456072008-02-07 00:16:46 -08001496 struct mxser_port *info = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001497 unsigned long flags;
Jiri Slaby59908432021-06-18 08:15:01 +02001498 u8 lcr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001499
1500 spin_lock_irqsave(&info->slock, flags);
Jiri Slaby59908432021-06-18 08:15:01 +02001501 lcr = inb(info->ioaddr + UART_LCR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001502 if (break_state == -1)
Jiri Slaby59908432021-06-18 08:15:01 +02001503 lcr |= UART_LCR_SBC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001504 else
Jiri Slaby59908432021-06-18 08:15:01 +02001505 lcr &= ~UART_LCR_SBC;
1506 outb(lcr, info->ioaddr + UART_LCR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001507 spin_unlock_irqrestore(&info->slock, flags);
Jiri Slaby59908432021-06-18 08:15:01 +02001508
Alan Cox9e98966c2008-07-22 11:18:03 +01001509 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001510}
1511
Jiri Slaby9dd6f302021-11-18 08:31:21 +01001512static bool mxser_receive_chars_new(struct mxser_port *port, u8 status)
Jiri Slabye5ce1bc2021-06-18 08:14:21 +02001513{
1514 enum mxser_must_hwid hwid = port->board->must_hwid;
1515 u8 gdl;
1516
1517 if (hwid == MOXA_OTHER_UART)
1518 return false;
Jiri Slaby7d5006d2021-09-22 09:59:33 +02001519 if (status & (UART_LSR_BRK_ERROR_BITS | MOXA_MUST_LSR_RERR))
Jiri Slabye5ce1bc2021-06-18 08:14:21 +02001520 return false;
1521
1522 gdl = inb(port->ioaddr + MOXA_MUST_GDL_REGISTER);
1523 if (hwid == MOXA_MUST_MU150_HWID)
1524 gdl &= MOXA_MUST_GDL_MASK;
1525
Jiri Slabye5ce1bc2021-06-18 08:14:21 +02001526 while (gdl--) {
1527 u8 ch = inb(port->ioaddr + UART_RX);
Jiri Slabyeb68ac02021-11-18 08:31:22 +01001528 if (!tty_insert_flip_char(&port->port, ch, 0))
1529 port->icount.buf_overrun++;
Jiri Slabye5ce1bc2021-06-18 08:14:21 +02001530 }
1531
1532 return true;
1533}
1534
Jiri Slaby0c419422021-06-18 08:14:22 +02001535static u8 mxser_receive_chars_old(struct tty_struct *tty,
Jiri Slaby95b3ea42021-06-18 08:14:37 +02001536 struct mxser_port *port, u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001537{
Jiri Slaby0c419422021-06-18 08:14:22 +02001538 enum mxser_must_hwid hwid = port->board->must_hwid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001539 int ignored = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001540 int max = 256;
Jiri Slaby0c419422021-06-18 08:14:22 +02001541 u8 ch;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001542
1543 do {
1544 if (max-- < 0)
1545 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001546
Jiri Slaby1c456072008-02-07 00:16:46 -08001547 ch = inb(port->ioaddr + UART_RX);
Jiri Slaby0c419422021-06-18 08:14:22 +02001548 if (hwid && (status & UART_LSR_OE))
Jiri Slabyd249e662021-09-22 09:59:38 +02001549 outb(port->FCR | UART_FCR_CLEAR_RCVR,
Jiri Slabyaaa28e92021-06-18 08:15:07 +02001550 port->ioaddr + UART_FCR);
Jiri Slaby15517802021-06-18 08:14:18 +02001551 status &= port->read_status_mask;
1552 if (status & port->ignore_status_mask) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001553 if (++ignored > 100)
1554 break;
1555 } else {
Denis Vlasenko3399ba52005-06-06 13:35:55 -07001556 char flag = 0;
Jiri Slaby70640052021-06-18 08:14:26 +02001557 if (status & UART_LSR_BRK_ERROR_BITS) {
Jiri Slaby15517802021-06-18 08:14:18 +02001558 if (status & UART_LSR_BI) {
Denis Vlasenko3399ba52005-06-06 13:35:55 -07001559 flag = TTY_BREAK;
Jiri Slaby1c456072008-02-07 00:16:46 -08001560 port->icount.brk++;
1561
Alan Cox0ad9e7d2008-07-16 21:56:10 +01001562 if (port->port.flags & ASYNC_SAK)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001563 do_SAK(tty);
Jiri Slaby15517802021-06-18 08:14:18 +02001564 } else if (status & UART_LSR_PE) {
Denis Vlasenko3399ba52005-06-06 13:35:55 -07001565 flag = TTY_PARITY;
Jiri Slaby1c456072008-02-07 00:16:46 -08001566 port->icount.parity++;
Jiri Slaby15517802021-06-18 08:14:18 +02001567 } else if (status & UART_LSR_FE) {
Denis Vlasenko3399ba52005-06-06 13:35:55 -07001568 flag = TTY_FRAME;
Jiri Slaby1c456072008-02-07 00:16:46 -08001569 port->icount.frame++;
Jiri Slaby15517802021-06-18 08:14:18 +02001570 } else if (status & UART_LSR_OE) {
Denis Vlasenko3399ba52005-06-06 13:35:55 -07001571 flag = TTY_OVERRUN;
Jiri Slaby1c456072008-02-07 00:16:46 -08001572 port->icount.overrun++;
Jiri Slaby6de6e5c2021-06-18 08:14:23 +02001573 }
Denis Vlasenko3399ba52005-06-06 13:35:55 -07001574 }
Jiri Slabyeb68ac02021-11-18 08:31:22 +01001575 if (!tty_insert_flip_char(&port->port, ch, flag)) {
1576 port->icount.buf_overrun++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001577 break;
Jiri Slabyeb68ac02021-11-18 08:31:22 +01001578 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001579 }
1580
Jiri Slaby0c419422021-06-18 08:14:22 +02001581 if (hwid)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001582 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001583
Jiri Slaby15517802021-06-18 08:14:18 +02001584 status = inb(port->ioaddr + UART_LSR);
1585 } while (status & UART_LSR_DR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001586
Jiri Slaby0c419422021-06-18 08:14:22 +02001587 return status;
1588}
1589
1590static u8 mxser_receive_chars(struct tty_struct *tty,
1591 struct mxser_port *port, u8 status)
1592{
Jiri Slaby9dd6f302021-11-18 08:31:21 +01001593 if (!mxser_receive_chars_new(port, status))
Jiri Slaby95b3ea42021-06-18 08:14:37 +02001594 status = mxser_receive_chars_old(tty, port, status);
Jiri Slaby0c419422021-06-18 08:14:22 +02001595
Jiri Slaby2e124b42013-01-03 15:53:06 +01001596 tty_flip_buffer_push(&port->port);
Jiri Slaby15517802021-06-18 08:14:18 +02001597
1598 return status;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001599}
1600
Alan Cox216ba022008-10-13 10:40:19 +01001601static void mxser_transmit_chars(struct tty_struct *tty, struct mxser_port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001602{
Jiri Slaby3b88dbf2021-11-18 08:31:11 +01001603 int count;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001604
Jiri Slaby1c456072008-02-07 00:16:46 -08001605 if (port->x_char) {
1606 outb(port->x_char, port->ioaddr + UART_TX);
1607 port->x_char = 0;
Jiri Slaby1c456072008-02-07 00:16:46 -08001608 port->icount.tx++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001609 return;
1610 }
1611
Jiri Slaby265ceff2021-06-18 08:15:06 +02001612 if (!port->xmit_cnt || tty->flow.stopped ||
Jiri Slaby5d1ea1a2021-06-18 08:15:12 +02001613 (tty->hw_stopped && !mxser_16550A_or_MUST(port))) {
Jiri Slaby740165f2021-06-18 08:15:05 +02001614 __mxser_stop_tx(port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001615 return;
1616 }
1617
Jiri Slaby1c456072008-02-07 00:16:46 -08001618 count = port->xmit_fifo_size;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001619 do {
Alan Cox0ad9e7d2008-07-16 21:56:10 +01001620 outb(port->port.xmit_buf[port->xmit_tail++],
Jiri Slaby1c456072008-02-07 00:16:46 -08001621 port->ioaddr + UART_TX);
Jiri Slaby3b88dbf2021-11-18 08:31:11 +01001622 port->xmit_tail &= SERIAL_XMIT_SIZE - 1;
1623 port->icount.tx++;
Jiri Slaby265ceff2021-06-18 08:15:06 +02001624 if (!--port->xmit_cnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001625 break;
1626 } while (--count > 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001627
Kulikov Vasiliy464eb8f2010-07-23 20:34:53 +04001628 if (port->xmit_cnt < WAKEUP_CHARS)
Alan Cox216ba022008-10-13 10:40:19 +01001629 tty_wakeup(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001630
Jiri Slaby265ceff2021-06-18 08:15:06 +02001631 if (!port->xmit_cnt)
Jiri Slaby740165f2021-06-18 08:15:05 +02001632 __mxser_stop_tx(port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001633}
1634
Jiri Slaby9e40ea12021-06-18 08:14:19 +02001635static bool mxser_port_isr(struct mxser_port *port)
1636{
1637 struct tty_struct *tty;
Jiri Slaby30f60272021-11-18 08:31:10 +01001638 u8 iir, status;
Jiri Slaby9e40ea12021-06-18 08:14:19 +02001639 bool error = false;
1640
1641 iir = inb(port->ioaddr + UART_IIR);
1642 if (iir & UART_IIR_NO_INT)
1643 return true;
1644
1645 iir &= MOXA_MUST_IIR_MASK;
1646 tty = tty_port_tty_get(&port->port);
Jiri Slaby274ab582021-11-18 08:31:09 +01001647 if (!tty) {
Jiri Slaby9e40ea12021-06-18 08:14:19 +02001648 status = inb(port->ioaddr + UART_LSR);
Jiri Slabyd249e662021-09-22 09:59:38 +02001649 outb(port->FCR | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT,
Jiri Slabyaaa28e92021-06-18 08:15:07 +02001650 port->ioaddr + UART_FCR);
Jiri Slaby9e40ea12021-06-18 08:14:19 +02001651 inb(port->ioaddr + UART_MSR);
1652
1653 error = true;
1654 goto put_tty;
1655 }
1656
1657 status = inb(port->ioaddr + UART_LSR);
1658
Jiri Slaby9e40ea12021-06-18 08:14:19 +02001659 if (port->board->must_hwid) {
1660 if (iir == MOXA_MUST_IIR_GDA ||
1661 iir == MOXA_MUST_IIR_RDA ||
1662 iir == MOXA_MUST_IIR_RTO ||
1663 iir == MOXA_MUST_IIR_LSR)
1664 status = mxser_receive_chars(tty, port, status);
1665 } else {
1666 status &= port->read_status_mask;
1667 if (status & UART_LSR_DR)
1668 status = mxser_receive_chars(tty, port, status);
1669 }
1670
Jiri Slaby30f60272021-11-18 08:31:10 +01001671 mxser_check_modem_status(tty, port);
Jiri Slaby9e40ea12021-06-18 08:14:19 +02001672
1673 if (port->board->must_hwid) {
1674 if (iir == 0x02 && (status & UART_LSR_THRE))
1675 mxser_transmit_chars(tty, port);
1676 } else {
1677 if (status & UART_LSR_THRE)
1678 mxser_transmit_chars(tty, port);
1679 }
1680
1681put_tty:
1682 tty_kref_put(tty);
1683
1684 return error;
1685}
1686
Linus Torvalds1da177e2005-04-16 15:20:36 -07001687/*
Jiri Slaby1c456072008-02-07 00:16:46 -08001688 * This is the serial driver's generic interrupt routine
Linus Torvalds1da177e2005-04-16 15:20:36 -07001689 */
Jiri Slaby1c456072008-02-07 00:16:46 -08001690static irqreturn_t mxser_interrupt(int irq, void *dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001691{
Jiri Slabycef222c2021-06-18 08:14:17 +02001692 struct mxser_board *brd = dev_id;
Jiri Slaby1c456072008-02-07 00:16:46 -08001693 struct mxser_port *port;
Jiri Slaby1c456072008-02-07 00:16:46 -08001694 unsigned int int_cnt, pass_counter = 0;
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001695 unsigned int i, max = brd->nports;
Jiri Slaby1c456072008-02-07 00:16:46 -08001696 int handled = IRQ_NONE;
Jiri Slaby9cb5c9c2021-06-18 08:14:20 +02001697 u8 irqbits, bits, mask = BIT(max) - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001698
Jiri Slaby1c456072008-02-07 00:16:46 -08001699 while (pass_counter++ < MXSER_ISR_PASS_LIMIT) {
Jiri Slaby9cb5c9c2021-06-18 08:14:20 +02001700 irqbits = inb(brd->vector) & mask;
1701 if (irqbits == mask)
Jiri Slaby1c456072008-02-07 00:16:46 -08001702 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001703
Jiri Slaby1c456072008-02-07 00:16:46 -08001704 handled = IRQ_HANDLED;
1705 for (i = 0, bits = 1; i < max; i++, irqbits |= bits, bits <<= 1) {
Jiri Slaby9cb5c9c2021-06-18 08:14:20 +02001706 if (irqbits == mask)
Jiri Slaby1c456072008-02-07 00:16:46 -08001707 break;
1708 if (bits & irqbits)
1709 continue;
1710 port = &brd->ports[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001711
Jiri Slaby1c456072008-02-07 00:16:46 -08001712 int_cnt = 0;
1713 spin_lock(&port->slock);
1714 do {
Jiri Slaby9e40ea12021-06-18 08:14:19 +02001715 if (mxser_port_isr(port))
Jiri Slaby1c456072008-02-07 00:16:46 -08001716 break;
Jiri Slaby1c456072008-02-07 00:16:46 -08001717 } while (int_cnt++ < MXSER_ISR_PASS_LIMIT);
1718 spin_unlock(&port->slock);
1719 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001720 }
1721
Jiri Slaby1c456072008-02-07 00:16:46 -08001722 return handled;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001723}
1724
Jiri Slaby1c456072008-02-07 00:16:46 -08001725static const struct tty_operations mxser_ops = {
1726 .open = mxser_open,
1727 .close = mxser_close,
1728 .write = mxser_write,
1729 .put_char = mxser_put_char,
1730 .flush_chars = mxser_flush_chars,
1731 .write_room = mxser_write_room,
1732 .chars_in_buffer = mxser_chars_in_buffer,
1733 .flush_buffer = mxser_flush_buffer,
1734 .ioctl = mxser_ioctl,
1735 .throttle = mxser_throttle,
1736 .unthrottle = mxser_unthrottle,
1737 .set_termios = mxser_set_termios,
1738 .stop = mxser_stop,
1739 .start = mxser_start,
1740 .hangup = mxser_hangup,
1741 .break_ctl = mxser_rs_break,
1742 .wait_until_sent = mxser_wait_until_sent,
1743 .tiocmget = mxser_tiocmget,
1744 .tiocmset = mxser_tiocmset,
Al Viro6da5b582018-09-11 22:22:06 -04001745 .set_serial = mxser_set_serial_info,
1746 .get_serial = mxser_get_serial_info,
Alan Cox05871022010-09-16 18:21:52 +01001747 .get_icount = mxser_get_icount,
Jiri Slaby1c456072008-02-07 00:16:46 -08001748};
1749
Aya Mahfouz04b757d2015-12-15 01:53:36 +02001750static const struct tty_port_operations mxser_port_ops = {
Alan Cox31f35932009-01-02 13:45:05 +00001751 .carrier_raised = mxser_carrier_raised,
Alan Coxfcc8ac12009-06-11 12:24:17 +01001752 .dtr_rts = mxser_dtr_rts,
Alan Cox67691402009-11-30 13:17:35 +00001753 .activate = mxser_activate,
1754 .shutdown = mxser_shutdown_port,
Alan Cox31f35932009-01-02 13:45:05 +00001755};
1756
Linus Torvalds1da177e2005-04-16 15:20:36 -07001757/*
Jiri Slaby1c456072008-02-07 00:16:46 -08001758 * The MOXA Smartio/Industio serial driver boot-time initialization code!
Linus Torvalds1da177e2005-04-16 15:20:36 -07001759 */
Jiri Slaby1c456072008-02-07 00:16:46 -08001760
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001761static void mxser_initbrd(struct mxser_board *brd, bool high_baud)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001762{
Jiri Slaby1c456072008-02-07 00:16:46 -08001763 struct mxser_port *info;
1764 unsigned int i;
Jiri Slaby57faa7d2021-06-18 08:14:49 +02001765 bool is_mu860;
1766
1767 brd->must_hwid = mxser_must_get_hwid(brd->ports[0].ioaddr);
1768 is_mu860 = brd->must_hwid == MOXA_MUST_MU860_HWID;
1769
1770 for (i = 0; i < UART_INFO_NUM; i++) {
1771 if (Gpci_uart_info[i].type == brd->must_hwid) {
1772 brd->max_baud = Gpci_uart_info[i].max_baud;
1773
1774 /* exception....CP-102 */
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001775 if (high_baud)
Jiri Slaby57faa7d2021-06-18 08:14:49 +02001776 brd->max_baud = 921600;
1777 break;
1778 }
1779 }
1780
1781 if (is_mu860) {
1782 /* set to RS232 mode by default */
1783 outb(0, brd->vector + 4);
1784 outb(0, brd->vector + 0x0c);
1785 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001786
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001787 for (i = 0; i < brd->nports; i++) {
Jiri Slaby1c456072008-02-07 00:16:46 -08001788 info = &brd->ports[i];
Jiri Slaby57faa7d2021-06-18 08:14:49 +02001789 if (is_mu860) {
1790 if (i < 4)
1791 info->opmode_ioaddr = brd->vector + 4;
1792 else
1793 info->opmode_ioaddr = brd->vector + 0x0c;
1794 }
Alan Cox44b7d1b2008-07-16 21:57:18 +01001795 tty_port_init(&info->port);
Alan Cox31f35932009-01-02 13:45:05 +00001796 info->port.ops = &mxser_port_ops;
Jiri Slaby1c456072008-02-07 00:16:46 -08001797 info->board = brd;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001798
Jiri Slaby1c456072008-02-07 00:16:46 -08001799 /* Enhance mode enabled here */
Jiri Slaby292955a2021-06-18 08:14:13 +02001800 if (brd->must_hwid != MOXA_OTHER_UART)
Jiri Slabyedb7d272021-06-18 08:14:46 +02001801 mxser_must_set_enhance_mode(info->ioaddr, true);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001802
Jiri Slaby58a2ddb2021-06-18 08:14:15 +02001803 info->type = PORT_16550A;
Jiri Slaby1c456072008-02-07 00:16:46 -08001804
Jiri Slabyc3db20c2021-06-18 08:14:55 +02001805 mxser_process_txrx_fifo(info);
Jiri Slaby1c456072008-02-07 00:16:46 -08001806
Alan Cox44b7d1b2008-07-16 21:57:18 +01001807 info->port.close_delay = 5 * HZ / 10;
1808 info->port.closing_wait = 30 * HZ;
Jiri Slaby1c456072008-02-07 00:16:46 -08001809 spin_lock_init(&info->slock);
1810
1811 /* before set INT ISR, disable all int */
1812 outb(inb(info->ioaddr + UART_IER) & 0xf0,
1813 info->ioaddr + UART_IER);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001814 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001815}
1816
Bill Pemberton9671f092012-11-19 13:21:50 -05001817static int mxser_probe(struct pci_dev *pdev,
Jiri Slaby1c456072008-02-07 00:16:46 -08001818 const struct pci_device_id *ent)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001819{
Jiri Slaby1c456072008-02-07 00:16:46 -08001820 struct mxser_board *brd;
Jiri Slaby13d4aba2021-06-18 08:14:57 +02001821 unsigned int i, base;
Jiri Slaby1c456072008-02-07 00:16:46 -08001822 unsigned long ioaddress;
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001823 unsigned short nports = MXSER_NPORTS(ent->driver_data);
Alexey Khoroshilov9e17df32013-02-17 02:24:37 +04001824 struct device *tty_dev;
Jiri Slaby1c456072008-02-07 00:16:46 -08001825 int retval = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001826
Jiri Slabyf8b6b322021-06-18 08:14:58 +02001827 i = find_first_zero_bit(mxser_boards, MXSER_BOARDS);
Jiri Slaby1c456072008-02-07 00:16:46 -08001828 if (i >= MXSER_BOARDS) {
Jiri Slaby83766bc2008-07-25 01:48:21 -07001829 dev_err(&pdev->dev, "too many boards found (maximum %d), board "
1830 "not configured\n", MXSER_BOARDS);
Jiri Slaby1c456072008-02-07 00:16:46 -08001831 goto err;
1832 }
1833
Jiri Slabyad1c92f2021-06-18 08:14:59 +02001834 brd = devm_kzalloc(&pdev->dev, struct_size(brd, ports, nports),
1835 GFP_KERNEL);
Jiri Slabyf8b6b322021-06-18 08:14:58 +02001836 if (!brd)
1837 goto err;
1838
Jiri Slaby13d4aba2021-06-18 08:14:57 +02001839 brd->idx = i;
Jiri Slabyf8b6b322021-06-18 08:14:58 +02001840 __set_bit(brd->idx, mxser_boards);
Jiri Slaby13d4aba2021-06-18 08:14:57 +02001841 base = i * MXSER_PORTS_PER_BOARD;
Jiri Slaby1c456072008-02-07 00:16:46 -08001842
Jiri Slabydcb04e22021-06-18 08:14:51 +02001843 retval = pcim_enable_device(pdev);
Jiri Slaby1c456072008-02-07 00:16:46 -08001844 if (retval) {
Jiri Slaby83766bc2008-07-25 01:48:21 -07001845 dev_err(&pdev->dev, "PCI enable failed\n");
Jiri Slabyf8b6b322021-06-18 08:14:58 +02001846 goto err_zero;
Jiri Slaby1c456072008-02-07 00:16:46 -08001847 }
1848
1849 /* io address */
1850 ioaddress = pci_resource_start(pdev, 2);
1851 retval = pci_request_region(pdev, 2, "mxser(IO)");
1852 if (retval)
Jiri Slabyf8b6b322021-06-18 08:14:58 +02001853 goto err_zero;
Jiri Slaby1c456072008-02-07 00:16:46 -08001854
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001855 brd->nports = nports;
1856 for (i = 0; i < nports; i++)
Jiri Slaby1c456072008-02-07 00:16:46 -08001857 brd->ports[i].ioaddr = ioaddress + 8 * i;
1858
1859 /* vector */
1860 ioaddress = pci_resource_start(pdev, 3);
1861 retval = pci_request_region(pdev, 3, "mxser(vector)");
1862 if (retval)
Jiri Slabydf480512010-09-03 10:31:37 +02001863 goto err_zero;
Jiri Slaby1c456072008-02-07 00:16:46 -08001864 brd->vector = ioaddress;
1865
1866 /* irq */
1867 brd->irq = pdev->irq;
1868
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001869 mxser_initbrd(brd, ent->driver_data & MXSER_HIGHBAUD);
Jiri Slaby7f0e79d2021-06-18 08:14:52 +02001870
1871 retval = devm_request_irq(&pdev->dev, brd->irq, mxser_interrupt,
1872 IRQF_SHARED, "mxser", brd);
1873 if (retval) {
1874 dev_err(&pdev->dev, "request irq failed");
1875 goto err_relbrd;
1876 }
Jiri Slaby1c456072008-02-07 00:16:46 -08001877
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001878 for (i = 0; i < nports; i++) {
Alexey Khoroshilov9e17df32013-02-17 02:24:37 +04001879 tty_dev = tty_port_register_device(&brd->ports[i].port,
Jiri Slaby13d4aba2021-06-18 08:14:57 +02001880 mxvar_sdriver, base + i, &pdev->dev);
Alexey Khoroshilov9e17df32013-02-17 02:24:37 +04001881 if (IS_ERR(tty_dev)) {
1882 retval = PTR_ERR(tty_dev);
Alexey Khoroshilov1b581f12013-04-07 23:46:47 +04001883 for (; i > 0; i--)
Alexey Khoroshilov9e17df32013-02-17 02:24:37 +04001884 tty_unregister_device(mxvar_sdriver,
Jiri Slaby13d4aba2021-06-18 08:14:57 +02001885 base + i - 1);
Alexey Khoroshilov9e17df32013-02-17 02:24:37 +04001886 goto err_relbrd;
1887 }
1888 }
Jiri Slaby1c456072008-02-07 00:16:46 -08001889
1890 pci_set_drvdata(pdev, brd);
1891
1892 return 0;
Alexey Khoroshilov9e17df32013-02-17 02:24:37 +04001893err_relbrd:
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001894 for (i = 0; i < nports; i++)
Alexey Khoroshilov9e17df32013-02-17 02:24:37 +04001895 tty_port_destroy(&brd->ports[i].port);
Jiri Slabydf480512010-09-03 10:31:37 +02001896err_zero:
Jiri Slabyf8b6b322021-06-18 08:14:58 +02001897 __clear_bit(brd->idx, mxser_boards);
Jiri Slaby1c456072008-02-07 00:16:46 -08001898err:
1899 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001900}
1901
Bill Pembertonae8d8a12012-11-19 13:26:18 -05001902static void mxser_remove(struct pci_dev *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001903{
Jiri Slaby1c456072008-02-07 00:16:46 -08001904 struct mxser_board *brd = pci_get_drvdata(pdev);
Jiri Slaby13d4aba2021-06-18 08:14:57 +02001905 unsigned int i, base = brd->idx * MXSER_PORTS_PER_BOARD;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001906
Jiri Slabyc24c31f2021-06-18 08:14:54 +02001907 for (i = 0; i < brd->nports; i++) {
Jiri Slaby13d4aba2021-06-18 08:14:57 +02001908 tty_unregister_device(mxvar_sdriver, base + i);
Jiri Slabyd450f082021-06-18 08:14:50 +02001909 tty_port_destroy(&brd->ports[i].port);
1910 }
1911
Jiri Slabyf8b6b322021-06-18 08:14:58 +02001912 __clear_bit(brd->idx, mxser_boards);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001913}
1914
Jiri Slaby1c456072008-02-07 00:16:46 -08001915static struct pci_driver mxser_driver = {
1916 .name = "mxser",
1917 .id_table = mxser_pcibrds,
1918 .probe = mxser_probe,
Bill Pemberton91116cb2012-11-19 13:21:06 -05001919 .remove = mxser_remove
Jiri Slaby1c456072008-02-07 00:16:46 -08001920};
Linus Torvalds1da177e2005-04-16 15:20:36 -07001921
Jiri Slaby1c456072008-02-07 00:16:46 -08001922static int __init mxser_module_init(void)
1923{
Jiri Slaby1df00922008-07-25 01:48:22 -07001924 int retval;
Jiri Slaby1c456072008-02-07 00:16:46 -08001925
Jiri Slaby39b7b422021-07-23 09:43:13 +02001926 mxvar_sdriver = tty_alloc_driver(MXSER_PORTS, TTY_DRIVER_REAL_RAW |
1927 TTY_DRIVER_DYNAMIC_DEV);
1928 if (IS_ERR(mxvar_sdriver))
1929 return PTR_ERR(mxvar_sdriver);
Jiri Slaby1c456072008-02-07 00:16:46 -08001930
Jiri Slaby1c456072008-02-07 00:16:46 -08001931 /* Initialize the tty_driver structure */
Jiri Slaby1c456072008-02-07 00:16:46 -08001932 mxvar_sdriver->name = "ttyMI";
1933 mxvar_sdriver->major = ttymajor;
1934 mxvar_sdriver->minor_start = 0;
Jiri Slaby1c456072008-02-07 00:16:46 -08001935 mxvar_sdriver->type = TTY_DRIVER_TYPE_SERIAL;
1936 mxvar_sdriver->subtype = SERIAL_TYPE_NORMAL;
1937 mxvar_sdriver->init_termios = tty_std_termios;
1938 mxvar_sdriver->init_termios.c_cflag = B9600|CS8|CREAD|HUPCL|CLOCAL;
Jiri Slaby1c456072008-02-07 00:16:46 -08001939 tty_set_operations(mxvar_sdriver, &mxser_ops);
1940
1941 retval = tty_register_driver(mxvar_sdriver);
1942 if (retval) {
1943 printk(KERN_ERR "Couldn't install MOXA Smartio/Industio family "
1944 "tty driver !\n");
1945 goto err_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001946 }
Jiri Slaby1c456072008-02-07 00:16:46 -08001947
Jiri Slaby1c456072008-02-07 00:16:46 -08001948 retval = pci_register_driver(&mxser_driver);
1949 if (retval) {
Jiri Slaby83766bc2008-07-25 01:48:21 -07001950 printk(KERN_ERR "mxser: can't register pci driver\n");
Jiri Slaby29134362021-06-18 08:14:07 +02001951 goto err_unr;
Jiri Slaby1c456072008-02-07 00:16:46 -08001952 }
1953
Jiri Slaby1c456072008-02-07 00:16:46 -08001954 return 0;
1955err_unr:
1956 tty_unregister_driver(mxvar_sdriver);
1957err_put:
Jiri Slaby9f90a4d2021-07-23 09:43:16 +02001958 tty_driver_kref_put(mxvar_sdriver);
Jiri Slaby1c456072008-02-07 00:16:46 -08001959 return retval;
1960}
1961
1962static void __exit mxser_module_exit(void)
1963{
Jiri Slaby1c456072008-02-07 00:16:46 -08001964 pci_unregister_driver(&mxser_driver);
Jiri Slaby1c456072008-02-07 00:16:46 -08001965 tty_unregister_driver(mxvar_sdriver);
Jiri Slaby9f90a4d2021-07-23 09:43:16 +02001966 tty_driver_kref_put(mxvar_sdriver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001967}
1968
1969module_init(mxser_module_init);
1970module_exit(mxser_module_exit);