blob: 3cfa22d469e0cd7f74e01b416f428dc3be508add [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/drivers/char/riscom.c -- RISCom/8 multiport serial driver.
3 *
4 * Copyright (C) 1994-1996 Dmitry Gorodchanin (pgmdsg@ibi.com)
5 *
6 * This code is loosely based on the Linux serial driver, written by
Alan Cox9492e132008-04-30 00:54:15 -07007 * Linus Torvalds, Theodore T'so and others. The RISCom/8 card
8 * programming info was obtained from various drivers for other OSes
9 * (FreeBSD, ISC, etc), but no source code from those drivers were
Linus Torvalds1da177e2005-04-16 15:20:36 -070010 * directly included in this driver.
11 *
12 *
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License as published by
15 * the Free Software Foundation; either version 2 of the License, or
16 * (at your option) any later version.
17 *
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License
24 * along with this program; if not, write to the Free Software
25 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26 *
27 * Revision 1.1
28 *
29 * ChangeLog:
30 * Arnaldo Carvalho de Melo <acme@conectiva.com.br> - 27-Jun-2001
31 * - get rid of check_region and several cleanups
32 */
33
34#include <linux/module.h>
35
Alan Cox9492e132008-04-30 00:54:15 -070036#include <linux/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070037#include <linux/kernel.h>
38#include <linux/sched.h>
39#include <linux/ioport.h>
40#include <linux/interrupt.h>
41#include <linux/errno.h>
42#include <linux/tty.h>
43#include <linux/mm.h>
44#include <linux/serial.h>
45#include <linux/fcntl.h>
46#include <linux/major.h>
47#include <linux/init.h>
48#include <linux/delay.h>
Alan Cox33f0f882006-01-09 20:54:13 -080049#include <linux/tty_flip.h>
Alexey Dobriyan405f5572009-07-11 22:08:37 +040050#include <linux/smp_lock.h>
Jeff Garzikd9afa432008-02-06 01:36:11 -080051#include <linux/spinlock.h>
Scott James Remnant5c9f5802009-04-06 17:33:26 +010052#include <linux/device.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
Alan Cox9492e132008-04-30 00:54:15 -070054#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070055
56#include "riscom8.h"
57#include "riscom8_reg.h"
58
59/* Am I paranoid or not ? ;-) */
60#define RISCOM_PARANOIA_CHECK
61
Alan Cox9492e132008-04-30 00:54:15 -070062/*
63 * Crazy InteliCom/8 boards sometimes have swapped CTS & DSR signals.
Linus Torvalds1da177e2005-04-16 15:20:36 -070064 * You can slightly speed up things by #undefing the following option,
Alan Cox9492e132008-04-30 00:54:15 -070065 * if you are REALLY sure that your board is correct one.
Linus Torvalds1da177e2005-04-16 15:20:36 -070066 */
67
68#define RISCOM_BRAIN_DAMAGED_CTS
69
Alan Cox9492e132008-04-30 00:54:15 -070070/*
Linus Torvalds1da177e2005-04-16 15:20:36 -070071 * The following defines are mostly for testing purposes. But if you need
72 * some nice reporting in your syslog, you can define them also.
73 */
74#undef RC_REPORT_FIFO
75#undef RC_REPORT_OVERRUN
76
77
78#define RISCOM_LEGAL_FLAGS \
79 (ASYNC_HUP_NOTIFY | ASYNC_SAK | ASYNC_SPLIT_TERMIOS | \
80 ASYNC_SPD_HI | ASYNC_SPEED_VHI | ASYNC_SESSION_LOCKOUT | \
81 ASYNC_PGRP_LOCKOUT | ASYNC_CALLOUT_NOHUP)
82
Linus Torvalds1da177e2005-04-16 15:20:36 -070083static struct tty_driver *riscom_driver;
Linus Torvalds1da177e2005-04-16 15:20:36 -070084
Jeff Garzikd9afa432008-02-06 01:36:11 -080085static DEFINE_SPINLOCK(riscom_lock);
86
Linus Torvalds1da177e2005-04-16 15:20:36 -070087static struct riscom_board rc_board[RC_NBOARD] = {
88 {
89 .base = RC_IOBASE1,
90 },
91 {
92 .base = RC_IOBASE2,
93 },
94 {
95 .base = RC_IOBASE3,
96 },
97 {
98 .base = RC_IOBASE4,
99 },
100};
101
102static struct riscom_port rc_port[RC_NBOARD * RC_NPORT];
103
104/* RISCom/8 I/O ports addresses (without address translation) */
105static unsigned short rc_ioport[] = {
Tobias Klauserfe971072006-01-09 20:54:02 -0800106#if 1
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x09, 0x0a, 0x0b, 0x0c,
Tobias Klauserfe971072006-01-09 20:54:02 -0800108#else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x09, 0x0a, 0x0b, 0x0c, 0x10,
110 0x11, 0x12, 0x18, 0x28, 0x31, 0x32, 0x39, 0x3a, 0x40, 0x41, 0x61, 0x62,
111 0x63, 0x64, 0x6b, 0x70, 0x71, 0x78, 0x7a, 0x7b, 0x7f, 0x100, 0x101
Tobias Klauserfe971072006-01-09 20:54:02 -0800112#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113};
Tobias Klauserfe971072006-01-09 20:54:02 -0800114#define RC_NIOPORT ARRAY_SIZE(rc_ioport)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700115
116
Alan Cox9492e132008-04-30 00:54:15 -0700117static int rc_paranoia_check(struct riscom_port const *port,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118 char *name, const char *routine)
119{
120#ifdef RISCOM_PARANOIA_CHECK
121 static const char badmagic[] = KERN_INFO
122 "rc: Warning: bad riscom port magic number for device %s in %s\n";
123 static const char badinfo[] = KERN_INFO
124 "rc: Warning: null riscom port for device %s in %s\n";
125
126 if (!port) {
127 printk(badinfo, name, routine);
128 return 1;
129 }
130 if (port->magic != RISCOM8_MAGIC) {
131 printk(badmagic, name, routine);
132 return 1;
133 }
134#endif
135 return 0;
136}
137
138/*
Alan Cox9492e132008-04-30 00:54:15 -0700139 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140 * Service functions for RISCom/8 driver.
Alan Cox9492e132008-04-30 00:54:15 -0700141 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142 */
143
144/* Get board number from pointer */
Alan Cox9492e132008-04-30 00:54:15 -0700145static inline int board_No(struct riscom_board const *bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146{
147 return bp - rc_board;
148}
149
150/* Get port number from pointer */
Alan Cox9492e132008-04-30 00:54:15 -0700151static inline int port_No(struct riscom_port const *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152{
Alan Cox9492e132008-04-30 00:54:15 -0700153 return RC_PORT(port - rc_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154}
155
156/* Get pointer to board from pointer to port */
Alan Cox9492e132008-04-30 00:54:15 -0700157static inline struct riscom_board *port_Board(struct riscom_port const *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158{
159 return &rc_board[RC_BOARD(port - rc_port)];
160}
161
162/* Input Byte from CL CD180 register */
Alan Cox9492e132008-04-30 00:54:15 -0700163static inline unsigned char rc_in(struct riscom_board const *bp,
164 unsigned short reg)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165{
166 return inb(bp->base + RC_TO_ISA(reg));
167}
168
169/* Output Byte to CL CD180 register */
Alan Cox9492e132008-04-30 00:54:15 -0700170static inline void rc_out(struct riscom_board const *bp, unsigned short reg,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 unsigned char val)
172{
173 outb(val, bp->base + RC_TO_ISA(reg));
174}
175
176/* Wait for Channel Command Register ready */
Alan Cox9492e132008-04-30 00:54:15 -0700177static void rc_wait_CCR(struct riscom_board const *bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700178{
179 unsigned long delay;
180
181 /* FIXME: need something more descriptive then 100000 :) */
Alan Cox9492e132008-04-30 00:54:15 -0700182 for (delay = 100000; delay; delay--)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 if (!rc_in(bp, CD180_CCR))
184 return;
Alan Cox9492e132008-04-30 00:54:15 -0700185
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186 printk(KERN_INFO "rc%d: Timeout waiting for CCR.\n", board_No(bp));
187}
188
189/*
190 * RISCom/8 probe functions.
191 */
192
Alan Cox9492e132008-04-30 00:54:15 -0700193static int rc_request_io_range(struct riscom_board * const bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194{
195 int i;
Alan Cox9492e132008-04-30 00:54:15 -0700196
197 for (i = 0; i < RC_NIOPORT; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 if (!request_region(RC_TO_ISA(rc_ioport[i]) + bp->base, 1,
199 "RISCom/8")) {
200 goto out_release;
201 }
202 return 0;
203out_release:
204 printk(KERN_INFO "rc%d: Skipping probe at 0x%03x. IO address in use.\n",
205 board_No(bp), bp->base);
Alan Cox9492e132008-04-30 00:54:15 -0700206 while (--i >= 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700207 release_region(RC_TO_ISA(rc_ioport[i]) + bp->base, 1);
208 return 1;
209}
210
Alan Cox9492e132008-04-30 00:54:15 -0700211static void rc_release_io_range(struct riscom_board * const bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212{
213 int i;
Alan Cox9492e132008-04-30 00:54:15 -0700214
215 for (i = 0; i < RC_NIOPORT; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216 release_region(RC_TO_ISA(rc_ioport[i]) + bp->base, 1);
217}
Alan Cox9492e132008-04-30 00:54:15 -0700218
Linus Torvalds1da177e2005-04-16 15:20:36 -0700219/* Reset and setup CD180 chip */
Alan Cox9492e132008-04-30 00:54:15 -0700220static void __init rc_init_CD180(struct riscom_board const *bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221{
222 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -0700223
Jeff Garzikd9afa432008-02-06 01:36:11 -0800224 spin_lock_irqsave(&riscom_lock, flags);
225
Alan Cox9492e132008-04-30 00:54:15 -0700226 rc_out(bp, RC_CTOUT, 0); /* Clear timeout */
227 rc_wait_CCR(bp); /* Wait for CCR ready */
228 rc_out(bp, CD180_CCR, CCR_HARDRESET); /* Reset CD180 chip */
Jeff Garzikd9afa432008-02-06 01:36:11 -0800229 spin_unlock_irqrestore(&riscom_lock, flags);
Alan Cox9492e132008-04-30 00:54:15 -0700230 msleep(50); /* Delay 0.05 sec */
Jeff Garzikd9afa432008-02-06 01:36:11 -0800231 spin_lock_irqsave(&riscom_lock, flags);
Alan Cox9492e132008-04-30 00:54:15 -0700232 rc_out(bp, CD180_GIVR, RC_ID); /* Set ID for this chip */
233 rc_out(bp, CD180_GICR, 0); /* Clear all bits */
234 rc_out(bp, CD180_PILR1, RC_ACK_MINT); /* Prio for modem intr */
235 rc_out(bp, CD180_PILR2, RC_ACK_TINT); /* Prio for tx intr */
236 rc_out(bp, CD180_PILR3, RC_ACK_RINT); /* Prio for rx intr */
237
Linus Torvalds1da177e2005-04-16 15:20:36 -0700238 /* Setting up prescaler. We need 4 ticks per 1 ms */
239 rc_out(bp, CD180_PPRH, (RC_OSCFREQ/(1000000/RISCOM_TPS)) >> 8);
240 rc_out(bp, CD180_PPRL, (RC_OSCFREQ/(1000000/RISCOM_TPS)) & 0xff);
Alan Cox9492e132008-04-30 00:54:15 -0700241
Jeff Garzikd9afa432008-02-06 01:36:11 -0800242 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243}
244
245/* Main probing routine, also sets irq. */
246static int __init rc_probe(struct riscom_board *bp)
247{
248 unsigned char val1, val2;
249 int irqs = 0;
250 int retries;
Alan Cox9492e132008-04-30 00:54:15 -0700251
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252 bp->irq = 0;
253
254 if (rc_request_io_range(bp))
255 return 1;
Alan Cox9492e132008-04-30 00:54:15 -0700256
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257 /* Are the I/O ports here ? */
258 rc_out(bp, CD180_PPRL, 0x5a);
259 outb(0xff, 0x80);
260 val1 = rc_in(bp, CD180_PPRL);
261 rc_out(bp, CD180_PPRL, 0xa5);
262 outb(0x00, 0x80);
263 val2 = rc_in(bp, CD180_PPRL);
Alan Cox9492e132008-04-30 00:54:15 -0700264
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265 if ((val1 != 0x5a) || (val2 != 0xa5)) {
266 printk(KERN_ERR "rc%d: RISCom/8 Board at 0x%03x not found.\n",
267 board_No(bp), bp->base);
268 goto out_release;
269 }
Alan Cox9492e132008-04-30 00:54:15 -0700270
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 /* It's time to find IRQ for this board */
Alan Cox9492e132008-04-30 00:54:15 -0700272 for (retries = 0; retries < 5 && irqs <= 0; retries++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700273 irqs = probe_irq_on();
Alan Cox9492e132008-04-30 00:54:15 -0700274 rc_init_CD180(bp); /* Reset CD180 chip */
275 rc_out(bp, CD180_CAR, 2); /* Select port 2 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276 rc_wait_CCR(bp);
Alan Cox9492e132008-04-30 00:54:15 -0700277 rc_out(bp, CD180_CCR, CCR_TXEN); /* Enable transmitter */
278 rc_out(bp, CD180_IER, IER_TXRDY);/* Enable tx empty intr */
Jiri Slabyc4ebd922007-07-17 04:05:20 -0700279 msleep(50);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280 irqs = probe_irq_off(irqs);
Alan Cox9492e132008-04-30 00:54:15 -0700281 val1 = rc_in(bp, RC_BSR); /* Get Board Status reg */
282 val2 = rc_in(bp, RC_ACK_TINT); /* ACK interrupt */
283 rc_init_CD180(bp); /* Reset CD180 again */
284
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 if ((val1 & RC_BSR_TINT) || (val2 != (RC_ID | GIVR_IT_TX))) {
286 printk(KERN_ERR "rc%d: RISCom/8 Board at 0x%03x not "
287 "found.\n", board_No(bp), bp->base);
288 goto out_release;
289 }
290 }
Alan Cox9492e132008-04-30 00:54:15 -0700291
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 if (irqs <= 0) {
293 printk(KERN_ERR "rc%d: Can't find IRQ for RISCom/8 board "
294 "at 0x%03x.\n", board_No(bp), bp->base);
295 goto out_release;
296 }
297 bp->irq = irqs;
298 bp->flags |= RC_BOARD_PRESENT;
Alan Cox9492e132008-04-30 00:54:15 -0700299
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 printk(KERN_INFO "rc%d: RISCom/8 Rev. %c board detected at "
301 "0x%03x, IRQ %d.\n",
302 board_No(bp),
303 (rc_in(bp, CD180_GFRCR) & 0x0f) + 'A', /* Board revision */
304 bp->base, bp->irq);
Alan Cox9492e132008-04-30 00:54:15 -0700305
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306 return 0;
307out_release:
308 rc_release_io_range(bp);
309 return 1;
310}
311
Alan Cox9492e132008-04-30 00:54:15 -0700312/*
313 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700314 * Interrupt processing routines.
Alan Cox9492e132008-04-30 00:54:15 -0700315 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 */
317
Alan Cox9492e132008-04-30 00:54:15 -0700318static struct riscom_port *rc_get_port(struct riscom_board const *bp,
319 unsigned char const *what)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320{
321 unsigned char channel;
Alan Cox9492e132008-04-30 00:54:15 -0700322 struct riscom_port *port;
323
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324 channel = rc_in(bp, CD180_GICR) >> GICR_CHAN_OFF;
325 if (channel < CD180_NCH) {
326 port = &rc_port[board_No(bp) * RC_NPORT + channel];
Alan Cox85f8f812008-07-16 21:55:29 +0100327 if (port->port.flags & ASYNC_INITIALIZED)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700328 return port;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329 }
Alan Cox9492e132008-04-30 00:54:15 -0700330 printk(KERN_ERR "rc%d: %s interrupt from invalid port %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 board_No(bp), what, channel);
332 return NULL;
333}
334
Alan Cox9492e132008-04-30 00:54:15 -0700335static void rc_receive_exc(struct riscom_board const *bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336{
337 struct riscom_port *port;
338 struct tty_struct *tty;
339 unsigned char status;
Alan Cox33f0f882006-01-09 20:54:13 -0800340 unsigned char ch, flag;
Alan Cox9492e132008-04-30 00:54:15 -0700341
342 port = rc_get_port(bp, "Receive");
343 if (port == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 return;
345
Alan Cox6ff1ab22009-09-19 13:13:22 -0700346 tty = tty_port_tty_get(&port->port);
Alan Cox9492e132008-04-30 00:54:15 -0700347
348#ifdef RC_REPORT_OVERRUN
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349 status = rc_in(bp, CD180_RCSR);
Alan Cox33f0f882006-01-09 20:54:13 -0800350 if (status & RCSR_OE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 port->overrun++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352 status &= port->mark_mask;
Alan Cox9492e132008-04-30 00:54:15 -0700353#else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354 status = rc_in(bp, CD180_RCSR) & port->mark_mask;
Alan Cox9492e132008-04-30 00:54:15 -0700355#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356 ch = rc_in(bp, CD180_RDR);
Alan Cox9492e132008-04-30 00:54:15 -0700357 if (!status)
Alan Cox6ff1ab22009-09-19 13:13:22 -0700358 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700359 if (status & RCSR_TOUT) {
360 printk(KERN_WARNING "rc%d: port %d: Receiver timeout. "
Alan Cox9492e132008-04-30 00:54:15 -0700361 "Hardware problems ?\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362 board_No(bp), port_No(port));
Alan Cox6ff1ab22009-09-19 13:13:22 -0700363 goto out;
Alan Cox9492e132008-04-30 00:54:15 -0700364
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365 } else if (status & RCSR_BREAK) {
366 printk(KERN_INFO "rc%d: port %d: Handling break...\n",
367 board_No(bp), port_No(port));
Alan Cox33f0f882006-01-09 20:54:13 -0800368 flag = TTY_BREAK;
Alan Cox6ff1ab22009-09-19 13:13:22 -0700369 if (tty && (port->port.flags & ASYNC_SAK))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700370 do_SAK(tty);
Alan Cox9492e132008-04-30 00:54:15 -0700371
372 } else if (status & RCSR_PE)
Alan Cox33f0f882006-01-09 20:54:13 -0800373 flag = TTY_PARITY;
Alan Cox9492e132008-04-30 00:54:15 -0700374
375 else if (status & RCSR_FE)
Alan Cox33f0f882006-01-09 20:54:13 -0800376 flag = TTY_FRAME;
Alan Cox9492e132008-04-30 00:54:15 -0700377
378 else if (status & RCSR_OE)
Alan Cox33f0f882006-01-09 20:54:13 -0800379 flag = TTY_OVERRUN;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380 else
Alan Cox33f0f882006-01-09 20:54:13 -0800381 flag = TTY_NORMAL;
Alan Cox9492e132008-04-30 00:54:15 -0700382
Alan Cox6ff1ab22009-09-19 13:13:22 -0700383 if (tty) {
384 tty_insert_flip_char(tty, ch, flag);
385 tty_flip_buffer_push(tty);
386 }
387out:
388 tty_kref_put(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389}
390
Alan Cox9492e132008-04-30 00:54:15 -0700391static void rc_receive(struct riscom_board const *bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392{
393 struct riscom_port *port;
394 struct tty_struct *tty;
395 unsigned char count;
Alan Cox9492e132008-04-30 00:54:15 -0700396
397 port = rc_get_port(bp, "Receive");
398 if (port == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 return;
Alan Cox9492e132008-04-30 00:54:15 -0700400
Alan Cox6ff1ab22009-09-19 13:13:22 -0700401 tty = tty_port_tty_get(&port->port);
Alan Cox9492e132008-04-30 00:54:15 -0700402
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403 count = rc_in(bp, CD180_RDCR);
Alan Cox9492e132008-04-30 00:54:15 -0700404
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405#ifdef RC_REPORT_FIFO
406 port->hits[count > 8 ? 9 : count]++;
Alan Cox9492e132008-04-30 00:54:15 -0700407#endif
408
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409 while (count--) {
Alan Cox6ff1ab22009-09-19 13:13:22 -0700410 u8 ch = rc_in(bp, CD180_RDR);
411 if (tty)
412 tty_insert_flip_char(tty, ch, TTY_NORMAL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413 }
Alan Cox6ff1ab22009-09-19 13:13:22 -0700414 if (tty) {
415 tty_flip_buffer_push(tty);
416 tty_kref_put(tty);
417 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418}
419
Alan Cox9492e132008-04-30 00:54:15 -0700420static void rc_transmit(struct riscom_board const *bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421{
422 struct riscom_port *port;
423 struct tty_struct *tty;
424 unsigned char count;
Alan Cox9492e132008-04-30 00:54:15 -0700425
426 port = rc_get_port(bp, "Transmit");
427 if (port == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700428 return;
Alan Cox9492e132008-04-30 00:54:15 -0700429
Alan Cox6ff1ab22009-09-19 13:13:22 -0700430 tty = tty_port_tty_get(&port->port);
Alan Cox9492e132008-04-30 00:54:15 -0700431
432 if (port->IER & IER_TXEMPTY) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433 /* FIFO drained */
434 rc_out(bp, CD180_CAR, port_No(port));
435 port->IER &= ~IER_TXEMPTY;
436 rc_out(bp, CD180_IER, port->IER);
Alan Cox6ff1ab22009-09-19 13:13:22 -0700437 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700438 }
Alan Cox9492e132008-04-30 00:54:15 -0700439
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440 if ((port->xmit_cnt <= 0 && !port->break_length)
Alan Cox6ff1ab22009-09-19 13:13:22 -0700441 || (tty && (tty->stopped || tty->hw_stopped))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700442 rc_out(bp, CD180_CAR, port_No(port));
443 port->IER &= ~IER_TXRDY;
444 rc_out(bp, CD180_IER, port->IER);
Alan Cox6ff1ab22009-09-19 13:13:22 -0700445 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700446 }
Alan Cox9492e132008-04-30 00:54:15 -0700447
Linus Torvalds1da177e2005-04-16 15:20:36 -0700448 if (port->break_length) {
449 if (port->break_length > 0) {
450 if (port->COR2 & COR2_ETC) {
451 rc_out(bp, CD180_TDR, CD180_C_ESC);
452 rc_out(bp, CD180_TDR, CD180_C_SBRK);
453 port->COR2 &= ~COR2_ETC;
454 }
455 count = min_t(int, port->break_length, 0xff);
456 rc_out(bp, CD180_TDR, CD180_C_ESC);
457 rc_out(bp, CD180_TDR, CD180_C_DELAY);
458 rc_out(bp, CD180_TDR, count);
Alan Cox9492e132008-04-30 00:54:15 -0700459 port->break_length -= count;
460 if (port->break_length == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461 port->break_length--;
462 } else {
463 rc_out(bp, CD180_TDR, CD180_C_ESC);
464 rc_out(bp, CD180_TDR, CD180_C_EBRK);
465 rc_out(bp, CD180_COR2, port->COR2);
466 rc_wait_CCR(bp);
467 rc_out(bp, CD180_CCR, CCR_CORCHG2);
468 port->break_length = 0;
469 }
Jiri Slaby7e63d0c2009-09-06 23:10:09 +0200470 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700471 }
Alan Cox9492e132008-04-30 00:54:15 -0700472
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473 count = CD180_NFIFO;
474 do {
Alan Cox85f8f812008-07-16 21:55:29 +0100475 rc_out(bp, CD180_TDR, port->port.xmit_buf[port->xmit_tail++]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476 port->xmit_tail = port->xmit_tail & (SERIAL_XMIT_SIZE-1);
477 if (--port->xmit_cnt <= 0)
478 break;
479 } while (--count > 0);
Alan Cox9492e132008-04-30 00:54:15 -0700480
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 if (port->xmit_cnt <= 0) {
482 rc_out(bp, CD180_CAR, port_No(port));
483 port->IER &= ~IER_TXRDY;
484 rc_out(bp, CD180_IER, port->IER);
485 }
Alan Cox6ff1ab22009-09-19 13:13:22 -0700486 if (tty && port->xmit_cnt <= port->wakeup_chars)
Jiri Slabyb98e70d2008-02-07 00:16:41 -0800487 tty_wakeup(tty);
Alan Cox6ff1ab22009-09-19 13:13:22 -0700488out:
489 tty_kref_put(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700490}
491
Alan Cox9492e132008-04-30 00:54:15 -0700492static void rc_check_modem(struct riscom_board const *bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493{
494 struct riscom_port *port;
495 struct tty_struct *tty;
496 unsigned char mcr;
Alan Cox9492e132008-04-30 00:54:15 -0700497
498 port = rc_get_port(bp, "Modem");
499 if (port == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700500 return;
Alan Cox9492e132008-04-30 00:54:15 -0700501
Alan Cox6ff1ab22009-09-19 13:13:22 -0700502 tty = tty_port_tty_get(&port->port);
Alan Cox9492e132008-04-30 00:54:15 -0700503
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504 mcr = rc_in(bp, CD180_MCR);
Alan Cox9492e132008-04-30 00:54:15 -0700505 if (mcr & MCR_CDCHG) {
506 if (rc_in(bp, CD180_MSVR) & MSVR_CD)
Alan Cox85f8f812008-07-16 21:55:29 +0100507 wake_up_interruptible(&port->port.open_wait);
Alan Cox6ff1ab22009-09-19 13:13:22 -0700508 else if (tty)
Jiri Slabyb98e70d2008-02-07 00:16:41 -0800509 tty_hangup(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510 }
Alan Cox9492e132008-04-30 00:54:15 -0700511
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512#ifdef RISCOM_BRAIN_DAMAGED_CTS
513 if (mcr & MCR_CTSCHG) {
514 if (rc_in(bp, CD180_MSVR) & MSVR_CTS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515 port->IER |= IER_TXRDY;
Alan Cox6ff1ab22009-09-19 13:13:22 -0700516 if (tty) {
517 tty->hw_stopped = 0;
518 if (port->xmit_cnt <= port->wakeup_chars)
519 tty_wakeup(tty);
520 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 } else {
Alan Cox6ff1ab22009-09-19 13:13:22 -0700522 if (tty)
523 tty->hw_stopped = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524 port->IER &= ~IER_TXRDY;
525 }
526 rc_out(bp, CD180_IER, port->IER);
527 }
528 if (mcr & MCR_DSRCHG) {
529 if (rc_in(bp, CD180_MSVR) & MSVR_DSR) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530 port->IER |= IER_TXRDY;
Alan Cox6ff1ab22009-09-19 13:13:22 -0700531 if (tty) {
532 tty->hw_stopped = 0;
533 if (port->xmit_cnt <= port->wakeup_chars)
534 tty_wakeup(tty);
535 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 } else {
Alan Cox6ff1ab22009-09-19 13:13:22 -0700537 if (tty)
538 tty->hw_stopped = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539 port->IER &= ~IER_TXRDY;
540 }
541 rc_out(bp, CD180_IER, port->IER);
542 }
543#endif /* RISCOM_BRAIN_DAMAGED_CTS */
Alan Cox9492e132008-04-30 00:54:15 -0700544
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 /* Clear change bits */
546 rc_out(bp, CD180_MCR, 0);
Alan Cox6ff1ab22009-09-19 13:13:22 -0700547 tty_kref_put(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700548}
549
550/* The main interrupt processing routine */
Alan Cox9492e132008-04-30 00:54:15 -0700551static irqreturn_t rc_interrupt(int dummy, void *dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552{
553 unsigned char status;
554 unsigned char ack;
Jeff Garzikf07ef392007-10-23 19:12:11 -0400555 struct riscom_board *bp = dev_id;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556 unsigned long loop = 0;
557 int handled = 0;
558
Jeff Garzikc7bec5a2006-10-06 15:00:58 -0400559 if (!(bp->flags & RC_BOARD_ACTIVE))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700560 return IRQ_NONE;
Jeff Garzikc7bec5a2006-10-06 15:00:58 -0400561
Linus Torvalds1da177e2005-04-16 15:20:36 -0700562 while ((++loop < 16) && ((status = ~(rc_in(bp, RC_BSR))) &
563 (RC_BSR_TOUT | RC_BSR_TINT |
564 RC_BSR_MINT | RC_BSR_RINT))) {
565 handled = 1;
Alan Cox9492e132008-04-30 00:54:15 -0700566 if (status & RC_BSR_TOUT)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700567 printk(KERN_WARNING "rc%d: Got timeout. Hardware "
568 "error?\n", board_No(bp));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700569 else if (status & RC_BSR_RINT) {
570 ack = rc_in(bp, RC_ACK_RINT);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700571 if (ack == (RC_ID | GIVR_IT_RCV))
572 rc_receive(bp);
573 else if (ack == (RC_ID | GIVR_IT_REXC))
574 rc_receive_exc(bp);
575 else
576 printk(KERN_WARNING "rc%d: Bad receive ack "
577 "0x%02x.\n",
578 board_No(bp), ack);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579 } else if (status & RC_BSR_TINT) {
580 ack = rc_in(bp, RC_ACK_TINT);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581 if (ack == (RC_ID | GIVR_IT_TX))
582 rc_transmit(bp);
583 else
584 printk(KERN_WARNING "rc%d: Bad transmit ack "
585 "0x%02x.\n",
586 board_No(bp), ack);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700587 } else /* if (status & RC_BSR_MINT) */ {
588 ack = rc_in(bp, RC_ACK_MINT);
Alan Cox9492e132008-04-30 00:54:15 -0700589 if (ack == (RC_ID | GIVR_IT_MODEM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590 rc_check_modem(bp);
591 else
592 printk(KERN_WARNING "rc%d: Bad modem ack "
593 "0x%02x.\n",
594 board_No(bp), ack);
Alan Cox9492e132008-04-30 00:54:15 -0700595 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596 rc_out(bp, CD180_EOIR, 0); /* Mark end of interrupt */
597 rc_out(bp, RC_CTOUT, 0); /* Clear timeout flag */
598 }
599 return IRQ_RETVAL(handled);
600}
601
602/*
603 * Routines for open & close processing.
604 */
605
606/* Called with disabled interrupts */
Alan Cox9492e132008-04-30 00:54:15 -0700607static int rc_setup_board(struct riscom_board *bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700608{
609 int error;
610
Alan Cox9492e132008-04-30 00:54:15 -0700611 if (bp->flags & RC_BOARD_ACTIVE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700612 return 0;
Alan Cox9492e132008-04-30 00:54:15 -0700613
Thomas Gleixner0f2ed4c2006-07-01 19:29:33 -0700614 error = request_irq(bp->irq, rc_interrupt, IRQF_DISABLED,
Jeff Garzikf07ef392007-10-23 19:12:11 -0400615 "RISCom/8", bp);
Alan Cox9492e132008-04-30 00:54:15 -0700616 if (error)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617 return error;
Alan Cox9492e132008-04-30 00:54:15 -0700618
Linus Torvalds1da177e2005-04-16 15:20:36 -0700619 rc_out(bp, RC_CTOUT, 0); /* Just in case */
620 bp->DTR = ~0;
621 rc_out(bp, RC_DTR, bp->DTR); /* Drop DTR on all ports */
Alan Cox9492e132008-04-30 00:54:15 -0700622
Linus Torvalds1da177e2005-04-16 15:20:36 -0700623 bp->flags |= RC_BOARD_ACTIVE;
Alan Cox9492e132008-04-30 00:54:15 -0700624
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625 return 0;
626}
627
628/* Called with disabled interrupts */
Jeff Garzikf07ef392007-10-23 19:12:11 -0400629static void rc_shutdown_board(struct riscom_board *bp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700630{
631 if (!(bp->flags & RC_BOARD_ACTIVE))
632 return;
Alan Cox9492e132008-04-30 00:54:15 -0700633
Linus Torvalds1da177e2005-04-16 15:20:36 -0700634 bp->flags &= ~RC_BOARD_ACTIVE;
Alan Cox9492e132008-04-30 00:54:15 -0700635
Linus Torvalds1da177e2005-04-16 15:20:36 -0700636 free_irq(bp->irq, NULL);
Alan Cox9492e132008-04-30 00:54:15 -0700637
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638 bp->DTR = ~0;
639 rc_out(bp, RC_DTR, bp->DTR); /* Drop DTR on all ports */
Alan Cox9492e132008-04-30 00:54:15 -0700640
Linus Torvalds1da177e2005-04-16 15:20:36 -0700641}
642
643/*
Alan Cox9492e132008-04-30 00:54:15 -0700644 * Setting up port characteristics.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700645 * Must be called with disabled interrupts
646 */
Alan Cox6ff1ab22009-09-19 13:13:22 -0700647static void rc_change_speed(struct tty_struct *tty, struct riscom_board *bp,
648 struct riscom_port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700649{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700650 unsigned long baud;
651 long tmp;
652 unsigned char cor1 = 0, cor3 = 0;
653 unsigned char mcor1 = 0, mcor2 = 0;
Alan Cox9492e132008-04-30 00:54:15 -0700654
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655 port->IER = 0;
656 port->COR2 = 0;
657 port->MSVR = MSVR_RTS;
Alan Cox9492e132008-04-30 00:54:15 -0700658
Alan Coxc7bce302006-09-30 23:27:24 -0700659 baud = tty_get_baud_rate(tty);
Alan Cox9492e132008-04-30 00:54:15 -0700660
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661 /* Select port on the board */
662 rc_out(bp, CD180_CAR, port_No(port));
Alan Cox9492e132008-04-30 00:54:15 -0700663
Alan Coxc7bce302006-09-30 23:27:24 -0700664 if (!baud) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700665 /* Drop DTR & exit */
666 bp->DTR |= (1u << port_No(port));
667 rc_out(bp, RC_DTR, bp->DTR);
668 return;
669 } else {
670 /* Set DTR on */
671 bp->DTR &= ~(1u << port_No(port));
672 rc_out(bp, RC_DTR, bp->DTR);
673 }
Alan Cox9492e132008-04-30 00:54:15 -0700674
Linus Torvalds1da177e2005-04-16 15:20:36 -0700675 /*
Alan Cox9492e132008-04-30 00:54:15 -0700676 * Now we must calculate some speed depended things
Linus Torvalds1da177e2005-04-16 15:20:36 -0700677 */
Alan Cox9492e132008-04-30 00:54:15 -0700678
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679 /* Set baud rate for port */
Alan Coxc7bce302006-09-30 23:27:24 -0700680 tmp = (((RC_OSCFREQ + baud/2) / baud +
Linus Torvalds1da177e2005-04-16 15:20:36 -0700681 CD180_TPC/2) / CD180_TPC);
682
Alan Cox9492e132008-04-30 00:54:15 -0700683 rc_out(bp, CD180_RBPRH, (tmp >> 8) & 0xff);
684 rc_out(bp, CD180_TBPRH, (tmp >> 8) & 0xff);
685 rc_out(bp, CD180_RBPRL, tmp & 0xff);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700686 rc_out(bp, CD180_TBPRL, tmp & 0xff);
Alan Cox9492e132008-04-30 00:54:15 -0700687
Alan Coxc7bce302006-09-30 23:27:24 -0700688 baud = (baud + 5) / 10; /* Estimated CPS */
Alan Cox9492e132008-04-30 00:54:15 -0700689
Linus Torvalds1da177e2005-04-16 15:20:36 -0700690 /* Two timer ticks seems enough to wakeup something like SLIP driver */
Alan Cox9492e132008-04-30 00:54:15 -0700691 tmp = ((baud + HZ/2) / HZ) * 2 - CD180_NFIFO;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692 port->wakeup_chars = (tmp < 0) ? 0 : ((tmp >= SERIAL_XMIT_SIZE) ?
693 SERIAL_XMIT_SIZE - 1 : tmp);
Alan Cox9492e132008-04-30 00:54:15 -0700694
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 /* Receiver timeout will be transmission time for 1.5 chars */
696 tmp = (RISCOM_TPS + RISCOM_TPS/2 + baud/2) / baud;
697 tmp = (tmp > 0xff) ? 0xff : tmp;
698 rc_out(bp, CD180_RTPR, tmp);
Alan Cox9492e132008-04-30 00:54:15 -0700699
700 switch (C_CSIZE(tty)) {
701 case CS5:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 cor1 |= COR1_5BITS;
703 break;
Alan Cox9492e132008-04-30 00:54:15 -0700704 case CS6:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705 cor1 |= COR1_6BITS;
706 break;
Alan Cox9492e132008-04-30 00:54:15 -0700707 case CS7:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700708 cor1 |= COR1_7BITS;
709 break;
Alan Cox9492e132008-04-30 00:54:15 -0700710 case CS8:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700711 cor1 |= COR1_8BITS;
712 break;
713 }
Alan Cox9492e132008-04-30 00:54:15 -0700714 if (C_CSTOPB(tty))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715 cor1 |= COR1_2SB;
Alan Cox9492e132008-04-30 00:54:15 -0700716
Linus Torvalds1da177e2005-04-16 15:20:36 -0700717 cor1 |= COR1_IGNORE;
Alan Cox9492e132008-04-30 00:54:15 -0700718 if (C_PARENB(tty)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719 cor1 |= COR1_NORMPAR;
Alan Cox9492e132008-04-30 00:54:15 -0700720 if (C_PARODD(tty))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700721 cor1 |= COR1_ODDP;
Alan Cox9492e132008-04-30 00:54:15 -0700722 if (I_INPCK(tty))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700723 cor1 &= ~COR1_IGNORE;
724 }
725 /* Set marking of some errors */
726 port->mark_mask = RCSR_OE | RCSR_TOUT;
Alan Cox9492e132008-04-30 00:54:15 -0700727 if (I_INPCK(tty))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700728 port->mark_mask |= RCSR_FE | RCSR_PE;
Alan Cox9492e132008-04-30 00:54:15 -0700729 if (I_BRKINT(tty) || I_PARMRK(tty))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700730 port->mark_mask |= RCSR_BREAK;
Alan Cox9492e132008-04-30 00:54:15 -0700731 if (I_IGNPAR(tty))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732 port->mark_mask &= ~(RCSR_FE | RCSR_PE);
Alan Cox9492e132008-04-30 00:54:15 -0700733 if (I_IGNBRK(tty)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700734 port->mark_mask &= ~RCSR_BREAK;
Alan Cox9492e132008-04-30 00:54:15 -0700735 if (I_IGNPAR(tty))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700736 /* Real raw mode. Ignore all */
737 port->mark_mask &= ~RCSR_OE;
738 }
739 /* Enable Hardware Flow Control */
740 if (C_CRTSCTS(tty)) {
741#ifdef RISCOM_BRAIN_DAMAGED_CTS
742 port->IER |= IER_DSR | IER_CTS;
743 mcor1 |= MCOR1_DSRZD | MCOR1_CTSZD;
744 mcor2 |= MCOR2_DSROD | MCOR2_CTSOD;
Alan Cox9492e132008-04-30 00:54:15 -0700745 tty->hw_stopped = !(rc_in(bp, CD180_MSVR) &
746 (MSVR_CTS|MSVR_DSR));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700747#else
748 port->COR2 |= COR2_CTSAE;
749#endif
750 }
751 /* Enable Software Flow Control. FIXME: I'm not sure about this */
752 /* Some people reported that it works, but I still doubt */
753 if (I_IXON(tty)) {
754 port->COR2 |= COR2_TXIBE;
755 cor3 |= (COR3_FCT | COR3_SCDE);
756 if (I_IXANY(tty))
757 port->COR2 |= COR2_IXM;
758 rc_out(bp, CD180_SCHR1, START_CHAR(tty));
759 rc_out(bp, CD180_SCHR2, STOP_CHAR(tty));
760 rc_out(bp, CD180_SCHR3, START_CHAR(tty));
761 rc_out(bp, CD180_SCHR4, STOP_CHAR(tty));
762 }
763 if (!C_CLOCAL(tty)) {
764 /* Enable CD check */
765 port->IER |= IER_CD;
766 mcor1 |= MCOR1_CDZD;
767 mcor2 |= MCOR2_CDOD;
768 }
Alan Cox9492e132008-04-30 00:54:15 -0700769
770 if (C_CREAD(tty))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771 /* Enable receiver */
772 port->IER |= IER_RXD;
Alan Cox9492e132008-04-30 00:54:15 -0700773
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774 /* Set input FIFO size (1-8 bytes) */
Alan Cox9492e132008-04-30 00:54:15 -0700775 cor3 |= RISCOM_RXFIFO;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700776 /* Setting up CD180 channel registers */
777 rc_out(bp, CD180_COR1, cor1);
778 rc_out(bp, CD180_COR2, port->COR2);
779 rc_out(bp, CD180_COR3, cor3);
780 /* Make CD180 know about registers change */
781 rc_wait_CCR(bp);
782 rc_out(bp, CD180_CCR, CCR_CORCHG1 | CCR_CORCHG2 | CCR_CORCHG3);
783 /* Setting up modem option registers */
784 rc_out(bp, CD180_MCOR1, mcor1);
785 rc_out(bp, CD180_MCOR2, mcor2);
786 /* Enable CD180 transmitter & receiver */
787 rc_wait_CCR(bp);
788 rc_out(bp, CD180_CCR, CCR_TXEN | CCR_RXEN);
789 /* Enable interrupts */
790 rc_out(bp, CD180_IER, port->IER);
791 /* And finally set RTS on */
792 rc_out(bp, CD180_MSVR, port->MSVR);
793}
794
795/* Must be called with interrupts enabled */
Alan Cox6ff1ab22009-09-19 13:13:22 -0700796static int rc_setup_port(struct tty_struct *tty, struct riscom_board *bp,
797 struct riscom_port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700798{
799 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -0700800
Alan Cox85f8f812008-07-16 21:55:29 +0100801 if (port->port.flags & ASYNC_INITIALIZED)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802 return 0;
Alan Cox9492e132008-04-30 00:54:15 -0700803
Alan Cox85f8f812008-07-16 21:55:29 +0100804 if (tty_port_alloc_xmit_buf(&port->port) < 0)
805 return -ENOMEM;
806
Jeff Garzikd9afa432008-02-06 01:36:11 -0800807 spin_lock_irqsave(&riscom_lock, flags);
808
Alan Cox6ff1ab22009-09-19 13:13:22 -0700809 clear_bit(TTY_IO_ERROR, &tty->flags);
Alan Cox85f8f812008-07-16 21:55:29 +0100810 if (port->port.count == 1)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811 bp->count++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700812 port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
Alan Cox6ff1ab22009-09-19 13:13:22 -0700813 rc_change_speed(tty, bp, port);
Alan Cox85f8f812008-07-16 21:55:29 +0100814 port->port.flags |= ASYNC_INITIALIZED;
Alan Cox9492e132008-04-30 00:54:15 -0700815
Jeff Garzikd9afa432008-02-06 01:36:11 -0800816 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700817 return 0;
818}
819
820/* Must be called with interrupts disabled */
Alan Coxd99101f2008-07-16 21:55:37 +0100821static void rc_shutdown_port(struct tty_struct *tty,
822 struct riscom_board *bp, struct riscom_port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700823{
Alan Cox85f8f812008-07-16 21:55:29 +0100824 if (!(port->port.flags & ASYNC_INITIALIZED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825 return;
Alan Cox9492e132008-04-30 00:54:15 -0700826
Linus Torvalds1da177e2005-04-16 15:20:36 -0700827#ifdef RC_REPORT_OVERRUN
828 printk(KERN_INFO "rc%d: port %d: Total %ld overruns were detected.\n",
829 board_No(bp), port_No(port), port->overrun);
Alan Cox9492e132008-04-30 00:54:15 -0700830#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700831#ifdef RC_REPORT_FIFO
832 {
833 int i;
Alan Cox9492e132008-04-30 00:54:15 -0700834
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835 printk(KERN_INFO "rc%d: port %d: FIFO hits [ ",
836 board_No(bp), port_No(port));
Alan Cox9492e132008-04-30 00:54:15 -0700837 for (i = 0; i < 10; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838 printk("%ld ", port->hits[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839 printk("].\n");
840 }
Alan Cox9492e132008-04-30 00:54:15 -0700841#endif
Alan Cox85f8f812008-07-16 21:55:29 +0100842 tty_port_free_xmit_buf(&port->port);
Alan Coxd99101f2008-07-16 21:55:37 +0100843 if (C_HUPCL(tty)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 /* Drop DTR */
845 bp->DTR |= (1u << port_No(port));
846 rc_out(bp, RC_DTR, bp->DTR);
847 }
Alan Cox9492e132008-04-30 00:54:15 -0700848
849 /* Select port */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850 rc_out(bp, CD180_CAR, port_No(port));
851 /* Reset port */
852 rc_wait_CCR(bp);
853 rc_out(bp, CD180_CCR, CCR_SOFTRESET);
854 /* Disable all interrupts from this port */
855 port->IER = 0;
856 rc_out(bp, CD180_IER, port->IER);
Alan Cox9492e132008-04-30 00:54:15 -0700857
Alan Coxd99101f2008-07-16 21:55:37 +0100858 set_bit(TTY_IO_ERROR, &tty->flags);
Alan Cox85f8f812008-07-16 21:55:29 +0100859 port->port.flags &= ~ASYNC_INITIALIZED;
Alan Cox9492e132008-04-30 00:54:15 -0700860
Linus Torvalds1da177e2005-04-16 15:20:36 -0700861 if (--bp->count < 0) {
862 printk(KERN_INFO "rc%d: rc_shutdown_port: "
863 "bad board count: %d\n",
864 board_No(bp), bp->count);
865 bp->count = 0;
866 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700867 /*
868 * If this is the last opened port on the board
869 * shutdown whole board
870 */
Alan Cox9492e132008-04-30 00:54:15 -0700871 if (!bp->count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700872 rc_shutdown_board(bp);
873}
874
Alan Cox31f35932009-01-02 13:45:05 +0000875static int carrier_raised(struct tty_port *port)
876{
877 struct riscom_port *p = container_of(port, struct riscom_port, port);
878 struct riscom_board *bp = port_Board(p);
879 unsigned long flags;
880 int CD;
881
882 spin_lock_irqsave(&riscom_lock, flags);
883 rc_out(bp, CD180_CAR, port_No(p));
884 CD = rc_in(bp, CD180_MSVR) & MSVR_CD;
885 rc_out(bp, CD180_MSVR, MSVR_RTS);
886 bp->DTR &= ~(1u << port_No(p));
887 rc_out(bp, RC_DTR, bp->DTR);
888 spin_unlock_irqrestore(&riscom_lock, flags);
889 return CD;
890}
891
Alan Cox9492e132008-04-30 00:54:15 -0700892static int rc_open(struct tty_struct *tty, struct file *filp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700893{
894 int board;
895 int error;
Alan Cox9492e132008-04-30 00:54:15 -0700896 struct riscom_port *port;
897 struct riscom_board *bp;
898
Linus Torvalds1da177e2005-04-16 15:20:36 -0700899 board = RC_BOARD(tty->index);
900 if (board >= RC_NBOARD || !(rc_board[board].flags & RC_BOARD_PRESENT))
901 return -ENODEV;
Alan Cox9492e132008-04-30 00:54:15 -0700902
Linus Torvalds1da177e2005-04-16 15:20:36 -0700903 bp = &rc_board[board];
904 port = rc_port + board * RC_NPORT + RC_PORT(tty->index);
905 if (rc_paranoia_check(port, tty->name, "rc_open"))
906 return -ENODEV;
Alan Cox9492e132008-04-30 00:54:15 -0700907
908 error = rc_setup_board(bp);
909 if (error)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910 return error;
Alan Cox9492e132008-04-30 00:54:15 -0700911
Alan Cox85f8f812008-07-16 21:55:29 +0100912 port->port.count++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700913 tty->driver_data = port;
Alan Cox6ff1ab22009-09-19 13:13:22 -0700914 tty_port_tty_set(&port->port, tty);
Alan Cox9492e132008-04-30 00:54:15 -0700915
Alan Cox6ff1ab22009-09-19 13:13:22 -0700916 error = rc_setup_port(tty, bp, port);
Alan Cox9492e132008-04-30 00:54:15 -0700917 if (error == 0)
Alan Cox36c621d2009-01-02 13:46:10 +0000918 error = tty_port_block_til_ready(&port->port, tty, filp);
Alan Cox9492e132008-04-30 00:54:15 -0700919 return error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700920}
921
Alan Cox978e5952008-04-30 00:53:59 -0700922static void rc_flush_buffer(struct tty_struct *tty)
923{
Alan Coxc9f19e92009-01-02 13:47:26 +0000924 struct riscom_port *port = tty->driver_data;
Alan Cox978e5952008-04-30 00:53:59 -0700925 unsigned long flags;
926
927 if (rc_paranoia_check(port, tty->name, "rc_flush_buffer"))
928 return;
929
930 spin_lock_irqsave(&riscom_lock, flags);
Alan Cox978e5952008-04-30 00:53:59 -0700931 port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
Alan Cox978e5952008-04-30 00:53:59 -0700932 spin_unlock_irqrestore(&riscom_lock, flags);
933
934 tty_wakeup(tty);
935}
936
Jiri Slaby90387f52009-08-22 09:04:42 +0200937static void rc_close_port(struct tty_port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700938{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700939 unsigned long flags;
Alan Coxc1469422009-09-19 13:13:21 -0700940 struct riscom_port *rp = container_of(port, struct riscom_port, port);
941 struct riscom_board *bp = port_Board(rp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700942 unsigned long timeout;
Alan Coxa6614992009-01-02 13:46:50 +0000943
Linus Torvalds1da177e2005-04-16 15:20:36 -0700944 /*
945 * At this point we stop accepting input. To do this, we
946 * disable the receive line status interrupts, and tell the
947 * interrupt driver to stop checking the data ready bit in the
948 * line status register.
949 */
Alan Coxc2ba38c2009-01-02 13:45:50 +0000950
951 spin_lock_irqsave(&riscom_lock, flags);
Alan Coxc1469422009-09-19 13:13:21 -0700952 rp->IER &= ~IER_RXD;
953 if (port->flags & ASYNC_INITIALIZED) {
954 rp->IER &= ~IER_TXRDY;
955 rp->IER |= IER_TXEMPTY;
956 rc_out(bp, CD180_CAR, port_No(rp));
957 rc_out(bp, CD180_IER, rp->IER);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700958 /*
959 * Before we drop DTR, make sure the UART transmitter
960 * has completely drained; this is especially
961 * important if there is a transmit FIFO!
962 */
Alan Cox9492e132008-04-30 00:54:15 -0700963 timeout = jiffies + HZ;
Alan Coxc1469422009-09-19 13:13:21 -0700964 while (rp->IER & IER_TXEMPTY) {
Alan Coxc2ba38c2009-01-02 13:45:50 +0000965 spin_unlock_irqrestore(&riscom_lock, flags);
Alan Coxc1469422009-09-19 13:13:21 -0700966 msleep_interruptible(jiffies_to_msecs(rp->timeout));
Alan Coxc2ba38c2009-01-02 13:45:50 +0000967 spin_lock_irqsave(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700968 if (time_after(jiffies, timeout))
969 break;
970 }
971 }
Jiri Slaby90387f52009-08-22 09:04:42 +0200972 rc_shutdown_port(port->tty, bp, rp);
Alan Coxc2ba38c2009-01-02 13:45:50 +0000973 spin_unlock_irqrestore(&riscom_lock, flags);
Alan Coxc1469422009-09-19 13:13:21 -0700974}
975
976static void rc_close(struct tty_struct *tty, struct file *filp)
977{
978 struct riscom_port *port = tty->driver_data;
979
980 if (!port || rc_paranoia_check(port, tty->name, "close"))
981 return;
Alan Cox6ff1ab22009-09-19 13:13:22 -0700982 tty_port_close(&port->port, tty, filp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983}
984
Alan Cox9492e132008-04-30 00:54:15 -0700985static int rc_write(struct tty_struct *tty,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700986 const unsigned char *buf, int count)
987{
Alan Coxc9f19e92009-01-02 13:47:26 +0000988 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700989 struct riscom_board *bp;
990 int c, total = 0;
991 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -0700992
Linus Torvalds1da177e2005-04-16 15:20:36 -0700993 if (rc_paranoia_check(port, tty->name, "rc_write"))
994 return 0;
Alan Cox9492e132008-04-30 00:54:15 -0700995
Linus Torvalds1da177e2005-04-16 15:20:36 -0700996 bp = port_Board(port);
997
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998 while (1) {
Jeff Garzikd9afa432008-02-06 01:36:11 -0800999 spin_lock_irqsave(&riscom_lock, flags);
1000
Linus Torvalds1da177e2005-04-16 15:20:36 -07001001 c = min_t(int, count, min(SERIAL_XMIT_SIZE - port->xmit_cnt - 1,
1002 SERIAL_XMIT_SIZE - port->xmit_head));
Jeff Garzikd9afa432008-02-06 01:36:11 -08001003 if (c <= 0)
1004 break; /* lock continues to be held */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005
Alan Cox85f8f812008-07-16 21:55:29 +01001006 memcpy(port->port.xmit_buf + port->xmit_head, buf, c);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001007 port->xmit_head = (port->xmit_head + c) & (SERIAL_XMIT_SIZE-1);
1008 port->xmit_cnt += c;
Jeff Garzikd9afa432008-02-06 01:36:11 -08001009
1010 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001011
1012 buf += c;
1013 count -= c;
1014 total += c;
1015 }
1016
Linus Torvalds1da177e2005-04-16 15:20:36 -07001017 if (port->xmit_cnt && !tty->stopped && !tty->hw_stopped &&
1018 !(port->IER & IER_TXRDY)) {
1019 port->IER |= IER_TXRDY;
1020 rc_out(bp, CD180_CAR, port_No(port));
1021 rc_out(bp, CD180_IER, port->IER);
1022 }
Jeff Garzikd9afa432008-02-06 01:36:11 -08001023
1024 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001025
1026 return total;
1027}
1028
Alan Cox9492e132008-04-30 00:54:15 -07001029static int rc_put_char(struct tty_struct *tty, unsigned char ch)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001030{
Alan Coxc9f19e92009-01-02 13:47:26 +00001031 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001032 unsigned long flags;
Alan Coxbbbbb962008-04-30 00:54:05 -07001033 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001034
1035 if (rc_paranoia_check(port, tty->name, "rc_put_char"))
Alan Coxbbbbb962008-04-30 00:54:05 -07001036 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001037
Jeff Garzikd9afa432008-02-06 01:36:11 -08001038 spin_lock_irqsave(&riscom_lock, flags);
Alan Cox9492e132008-04-30 00:54:15 -07001039
Linus Torvalds1da177e2005-04-16 15:20:36 -07001040 if (port->xmit_cnt >= SERIAL_XMIT_SIZE - 1)
1041 goto out;
1042
Alan Cox85f8f812008-07-16 21:55:29 +01001043 port->port.xmit_buf[port->xmit_head++] = ch;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001044 port->xmit_head &= SERIAL_XMIT_SIZE - 1;
1045 port->xmit_cnt++;
Alan Coxbbbbb962008-04-30 00:54:05 -07001046 ret = 1;
Jeff Garzikd9afa432008-02-06 01:36:11 -08001047
1048out:
1049 spin_unlock_irqrestore(&riscom_lock, flags);
Alan Coxbbbbb962008-04-30 00:54:05 -07001050 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051}
1052
Alan Cox9492e132008-04-30 00:54:15 -07001053static void rc_flush_chars(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001054{
Alan Coxc9f19e92009-01-02 13:47:26 +00001055 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001056 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -07001057
Linus Torvalds1da177e2005-04-16 15:20:36 -07001058 if (rc_paranoia_check(port, tty->name, "rc_flush_chars"))
1059 return;
Alan Cox9492e132008-04-30 00:54:15 -07001060
Alan Coxd99101f2008-07-16 21:55:37 +01001061 if (port->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001062 return;
1063
Jeff Garzikd9afa432008-02-06 01:36:11 -08001064 spin_lock_irqsave(&riscom_lock, flags);
1065
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066 port->IER |= IER_TXRDY;
1067 rc_out(port_Board(port), CD180_CAR, port_No(port));
1068 rc_out(port_Board(port), CD180_IER, port->IER);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001069
1070 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001071}
1072
Alan Cox9492e132008-04-30 00:54:15 -07001073static int rc_write_room(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001074{
Alan Coxc9f19e92009-01-02 13:47:26 +00001075 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001076 int ret;
Alan Cox9492e132008-04-30 00:54:15 -07001077
Linus Torvalds1da177e2005-04-16 15:20:36 -07001078 if (rc_paranoia_check(port, tty->name, "rc_write_room"))
1079 return 0;
1080
1081 ret = SERIAL_XMIT_SIZE - port->xmit_cnt - 1;
1082 if (ret < 0)
1083 ret = 0;
1084 return ret;
1085}
1086
1087static int rc_chars_in_buffer(struct tty_struct *tty)
1088{
Alan Coxc9f19e92009-01-02 13:47:26 +00001089 struct riscom_port *port = tty->driver_data;
Alan Cox9492e132008-04-30 00:54:15 -07001090
Linus Torvalds1da177e2005-04-16 15:20:36 -07001091 if (rc_paranoia_check(port, tty->name, "rc_chars_in_buffer"))
1092 return 0;
Alan Cox9492e132008-04-30 00:54:15 -07001093
Linus Torvalds1da177e2005-04-16 15:20:36 -07001094 return port->xmit_cnt;
1095}
1096
Linus Torvalds1da177e2005-04-16 15:20:36 -07001097static int rc_tiocmget(struct tty_struct *tty, struct file *file)
1098{
Alan Coxc9f19e92009-01-02 13:47:26 +00001099 struct riscom_port *port = tty->driver_data;
Alan Cox9492e132008-04-30 00:54:15 -07001100 struct riscom_board *bp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001101 unsigned char status;
1102 unsigned int result;
1103 unsigned long flags;
1104
Harvey Harrisonbf9d8922008-04-30 00:55:10 -07001105 if (rc_paranoia_check(port, tty->name, __func__))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001106 return -ENODEV;
1107
1108 bp = port_Board(port);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001109
1110 spin_lock_irqsave(&riscom_lock, flags);
1111
Linus Torvalds1da177e2005-04-16 15:20:36 -07001112 rc_out(bp, CD180_CAR, port_No(port));
1113 status = rc_in(bp, CD180_MSVR);
1114 result = rc_in(bp, RC_RI) & (1u << port_No(port)) ? 0 : TIOCM_RNG;
Jeff Garzikd9afa432008-02-06 01:36:11 -08001115
1116 spin_unlock_irqrestore(&riscom_lock, flags);
1117
Linus Torvalds1da177e2005-04-16 15:20:36 -07001118 result |= ((status & MSVR_RTS) ? TIOCM_RTS : 0)
1119 | ((status & MSVR_DTR) ? TIOCM_DTR : 0)
1120 | ((status & MSVR_CD) ? TIOCM_CAR : 0)
1121 | ((status & MSVR_DSR) ? TIOCM_DSR : 0)
1122 | ((status & MSVR_CTS) ? TIOCM_CTS : 0);
1123 return result;
1124}
1125
1126static int rc_tiocmset(struct tty_struct *tty, struct file *file,
1127 unsigned int set, unsigned int clear)
1128{
Alan Coxc9f19e92009-01-02 13:47:26 +00001129 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001130 unsigned long flags;
1131 struct riscom_board *bp;
1132
Harvey Harrisonbf9d8922008-04-30 00:55:10 -07001133 if (rc_paranoia_check(port, tty->name, __func__))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001134 return -ENODEV;
1135
1136 bp = port_Board(port);
1137
Jeff Garzikd9afa432008-02-06 01:36:11 -08001138 spin_lock_irqsave(&riscom_lock, flags);
1139
Linus Torvalds1da177e2005-04-16 15:20:36 -07001140 if (set & TIOCM_RTS)
1141 port->MSVR |= MSVR_RTS;
1142 if (set & TIOCM_DTR)
1143 bp->DTR &= ~(1u << port_No(port));
1144
1145 if (clear & TIOCM_RTS)
1146 port->MSVR &= ~MSVR_RTS;
1147 if (clear & TIOCM_DTR)
1148 bp->DTR |= (1u << port_No(port));
1149
1150 rc_out(bp, CD180_CAR, port_No(port));
1151 rc_out(bp, CD180_MSVR, port->MSVR);
1152 rc_out(bp, RC_DTR, bp->DTR);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001153
1154 spin_unlock_irqrestore(&riscom_lock, flags);
1155
Linus Torvalds1da177e2005-04-16 15:20:36 -07001156 return 0;
1157}
1158
Alan Cox781cff52008-07-22 11:18:30 +01001159static int rc_send_break(struct tty_struct *tty, int length)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001160{
Alan Coxc9f19e92009-01-02 13:47:26 +00001161 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001162 struct riscom_board *bp = port_Board(port);
1163 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -07001164
Alan Cox781cff52008-07-22 11:18:30 +01001165 if (length == 0 || length == -1)
1166 return -EOPNOTSUPP;
1167
Jeff Garzikd9afa432008-02-06 01:36:11 -08001168 spin_lock_irqsave(&riscom_lock, flags);
1169
Linus Torvalds1da177e2005-04-16 15:20:36 -07001170 port->break_length = RISCOM_TPS / HZ * length;
1171 port->COR2 |= COR2_ETC;
1172 port->IER |= IER_TXRDY;
1173 rc_out(bp, CD180_CAR, port_No(port));
1174 rc_out(bp, CD180_COR2, port->COR2);
1175 rc_out(bp, CD180_IER, port->IER);
1176 rc_wait_CCR(bp);
1177 rc_out(bp, CD180_CCR, CCR_CORCHG2);
1178 rc_wait_CCR(bp);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001179
1180 spin_unlock_irqrestore(&riscom_lock, flags);
Alan Cox781cff52008-07-22 11:18:30 +01001181 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001182}
1183
Alan Cox6ff1ab22009-09-19 13:13:22 -07001184static int rc_set_serial_info(struct tty_struct *tty, struct riscom_port *port,
Alan Cox9492e132008-04-30 00:54:15 -07001185 struct serial_struct __user *newinfo)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001186{
1187 struct serial_struct tmp;
1188 struct riscom_board *bp = port_Board(port);
1189 int change_speed;
Alan Cox9492e132008-04-30 00:54:15 -07001190
Linus Torvalds1da177e2005-04-16 15:20:36 -07001191 if (copy_from_user(&tmp, newinfo, sizeof(tmp)))
1192 return -EFAULT;
Alan Cox9492e132008-04-30 00:54:15 -07001193
Alan Cox85f8f812008-07-16 21:55:29 +01001194 change_speed = ((port->port.flags & ASYNC_SPD_MASK) !=
Linus Torvalds1da177e2005-04-16 15:20:36 -07001195 (tmp.flags & ASYNC_SPD_MASK));
Alan Cox9492e132008-04-30 00:54:15 -07001196
Linus Torvalds1da177e2005-04-16 15:20:36 -07001197 if (!capable(CAP_SYS_ADMIN)) {
Alan Cox44b7d1b2008-07-16 21:57:18 +01001198 if ((tmp.close_delay != port->port.close_delay) ||
1199 (tmp.closing_wait != port->port.closing_wait) ||
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200 ((tmp.flags & ~ASYNC_USR_MASK) !=
Alan Cox85f8f812008-07-16 21:55:29 +01001201 (port->port.flags & ~ASYNC_USR_MASK)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001202 return -EPERM;
Alan Cox85f8f812008-07-16 21:55:29 +01001203 port->port.flags = ((port->port.flags & ~ASYNC_USR_MASK) |
Linus Torvalds1da177e2005-04-16 15:20:36 -07001204 (tmp.flags & ASYNC_USR_MASK));
1205 } else {
Alan Cox85f8f812008-07-16 21:55:29 +01001206 port->port.flags = ((port->port.flags & ~ASYNC_FLAGS) |
Linus Torvalds1da177e2005-04-16 15:20:36 -07001207 (tmp.flags & ASYNC_FLAGS));
Alan Cox44b7d1b2008-07-16 21:57:18 +01001208 port->port.close_delay = tmp.close_delay;
1209 port->port.closing_wait = tmp.closing_wait;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001210 }
1211 if (change_speed) {
Jeff Garzikd9afa432008-02-06 01:36:11 -08001212 unsigned long flags;
1213
1214 spin_lock_irqsave(&riscom_lock, flags);
Alan Cox6ff1ab22009-09-19 13:13:22 -07001215 rc_change_speed(tty, bp, port);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001216 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001217 }
1218 return 0;
1219}
1220
Alan Cox9492e132008-04-30 00:54:15 -07001221static int rc_get_serial_info(struct riscom_port *port,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001222 struct serial_struct __user *retinfo)
1223{
1224 struct serial_struct tmp;
1225 struct riscom_board *bp = port_Board(port);
Alan Cox9492e132008-04-30 00:54:15 -07001226
Linus Torvalds1da177e2005-04-16 15:20:36 -07001227 memset(&tmp, 0, sizeof(tmp));
1228 tmp.type = PORT_CIRRUS;
1229 tmp.line = port - rc_port;
1230 tmp.port = bp->base;
1231 tmp.irq = bp->irq;
Alan Cox85f8f812008-07-16 21:55:29 +01001232 tmp.flags = port->port.flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001233 tmp.baud_base = (RC_OSCFREQ + CD180_TPC/2) / CD180_TPC;
Alan Cox44b7d1b2008-07-16 21:57:18 +01001234 tmp.close_delay = port->port.close_delay * HZ/100;
1235 tmp.closing_wait = port->port.closing_wait * HZ/100;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001236 tmp.xmit_fifo_size = CD180_NFIFO;
1237 return copy_to_user(retinfo, &tmp, sizeof(tmp)) ? -EFAULT : 0;
1238}
1239
Alan Cox9492e132008-04-30 00:54:15 -07001240static int rc_ioctl(struct tty_struct *tty, struct file *filp,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241 unsigned int cmd, unsigned long arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001242{
Alan Coxc9f19e92009-01-02 13:47:26 +00001243 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001244 void __user *argp = (void __user *)arg;
Alan Cox781cff52008-07-22 11:18:30 +01001245 int retval;
Alan Cox9492e132008-04-30 00:54:15 -07001246
Linus Torvalds1da177e2005-04-16 15:20:36 -07001247 if (rc_paranoia_check(port, tty->name, "rc_ioctl"))
1248 return -ENODEV;
Alan Cox9492e132008-04-30 00:54:15 -07001249
Linus Torvalds1da177e2005-04-16 15:20:36 -07001250 switch (cmd) {
Alan Cox9492e132008-04-30 00:54:15 -07001251 case TIOCGSERIAL:
1252 lock_kernel();
Alan Coxeb174552008-04-30 00:53:21 -07001253 retval = rc_get_serial_info(port, argp);
1254 unlock_kernel();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001255 break;
Alan Cox9492e132008-04-30 00:54:15 -07001256 case TIOCSSERIAL:
1257 lock_kernel();
Alan Cox6ff1ab22009-09-19 13:13:22 -07001258 retval = rc_set_serial_info(tty, port, argp);
Alan Coxeb174552008-04-30 00:53:21 -07001259 unlock_kernel();
1260 break;
Alan Cox9492e132008-04-30 00:54:15 -07001261 default:
Alan Coxeb174552008-04-30 00:53:21 -07001262 retval = -ENOIOCTLCMD;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001263 }
Alan Coxeb174552008-04-30 00:53:21 -07001264 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001265}
1266
Alan Cox9492e132008-04-30 00:54:15 -07001267static void rc_throttle(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001268{
Alan Coxc9f19e92009-01-02 13:47:26 +00001269 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001270 struct riscom_board *bp;
1271 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -07001272
Linus Torvalds1da177e2005-04-16 15:20:36 -07001273 if (rc_paranoia_check(port, tty->name, "rc_throttle"))
1274 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001275 bp = port_Board(port);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001276
1277 spin_lock_irqsave(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001278 port->MSVR &= ~MSVR_RTS;
1279 rc_out(bp, CD180_CAR, port_No(port));
Jeff Garzikd9afa432008-02-06 01:36:11 -08001280 if (I_IXOFF(tty)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001281 rc_wait_CCR(bp);
1282 rc_out(bp, CD180_CCR, CCR_SSCH2);
1283 rc_wait_CCR(bp);
1284 }
1285 rc_out(bp, CD180_MSVR, port->MSVR);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001286 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001287}
1288
Alan Cox9492e132008-04-30 00:54:15 -07001289static void rc_unthrottle(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001290{
Alan Coxc9f19e92009-01-02 13:47:26 +00001291 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001292 struct riscom_board *bp;
1293 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -07001294
Linus Torvalds1da177e2005-04-16 15:20:36 -07001295 if (rc_paranoia_check(port, tty->name, "rc_unthrottle"))
1296 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001297 bp = port_Board(port);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001298
Alan Cox9492e132008-04-30 00:54:15 -07001299 spin_lock_irqsave(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001300 port->MSVR |= MSVR_RTS;
1301 rc_out(bp, CD180_CAR, port_No(port));
1302 if (I_IXOFF(tty)) {
1303 rc_wait_CCR(bp);
1304 rc_out(bp, CD180_CCR, CCR_SSCH1);
1305 rc_wait_CCR(bp);
1306 }
1307 rc_out(bp, CD180_MSVR, port->MSVR);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001308 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001309}
1310
Alan Cox9492e132008-04-30 00:54:15 -07001311static void rc_stop(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001312{
Alan Coxc9f19e92009-01-02 13:47:26 +00001313 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001314 struct riscom_board *bp;
1315 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -07001316
Linus Torvalds1da177e2005-04-16 15:20:36 -07001317 if (rc_paranoia_check(port, tty->name, "rc_stop"))
1318 return;
Jeff Garzikd9afa432008-02-06 01:36:11 -08001319
Alan Cox9492e132008-04-30 00:54:15 -07001320 bp = port_Board(port);
1321
1322 spin_lock_irqsave(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001323 port->IER &= ~IER_TXRDY;
1324 rc_out(bp, CD180_CAR, port_No(port));
1325 rc_out(bp, CD180_IER, port->IER);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001326 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001327}
1328
Alan Cox9492e132008-04-30 00:54:15 -07001329static void rc_start(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001330{
Alan Coxc9f19e92009-01-02 13:47:26 +00001331 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332 struct riscom_board *bp;
1333 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -07001334
Linus Torvalds1da177e2005-04-16 15:20:36 -07001335 if (rc_paranoia_check(port, tty->name, "rc_start"))
1336 return;
Alan Cox9492e132008-04-30 00:54:15 -07001337
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338 bp = port_Board(port);
Alan Cox9492e132008-04-30 00:54:15 -07001339
Jeff Garzikd9afa432008-02-06 01:36:11 -08001340 spin_lock_irqsave(&riscom_lock, flags);
1341
Alan Cox85f8f812008-07-16 21:55:29 +01001342 if (port->xmit_cnt && port->port.xmit_buf && !(port->IER & IER_TXRDY)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001343 port->IER |= IER_TXRDY;
1344 rc_out(bp, CD180_CAR, port_No(port));
1345 rc_out(bp, CD180_IER, port->IER);
1346 }
Jeff Garzikd9afa432008-02-06 01:36:11 -08001347 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001348}
1349
Alan Cox9492e132008-04-30 00:54:15 -07001350static void rc_hangup(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001351{
Alan Coxc9f19e92009-01-02 13:47:26 +00001352 struct riscom_port *port = tty->driver_data;
Alan Cox9492e132008-04-30 00:54:15 -07001353
Linus Torvalds1da177e2005-04-16 15:20:36 -07001354 if (rc_paranoia_check(port, tty->name, "rc_hangup"))
1355 return;
Alan Cox9492e132008-04-30 00:54:15 -07001356
Alan Cox6ff1ab22009-09-19 13:13:22 -07001357 rc_shutdown_port(tty, port_Board(port), port);
1358 tty_port_hangup(&port->port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001359}
1360
Alan Cox9492e132008-04-30 00:54:15 -07001361static void rc_set_termios(struct tty_struct *tty,
1362 struct ktermios *old_termios)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001363{
Alan Coxc9f19e92009-01-02 13:47:26 +00001364 struct riscom_port *port = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001365 unsigned long flags;
Alan Cox9492e132008-04-30 00:54:15 -07001366
Linus Torvalds1da177e2005-04-16 15:20:36 -07001367 if (rc_paranoia_check(port, tty->name, "rc_set_termios"))
1368 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001369
Jeff Garzikd9afa432008-02-06 01:36:11 -08001370 spin_lock_irqsave(&riscom_lock, flags);
Alan Cox6ff1ab22009-09-19 13:13:22 -07001371 rc_change_speed(tty, port_Board(port), port);
Jeff Garzikd9afa432008-02-06 01:36:11 -08001372 spin_unlock_irqrestore(&riscom_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001373
1374 if ((old_termios->c_cflag & CRTSCTS) &&
1375 !(tty->termios->c_cflag & CRTSCTS)) {
1376 tty->hw_stopped = 0;
1377 rc_start(tty);
1378 }
1379}
1380
Jeff Dikeb68e31d2006-10-02 02:17:18 -07001381static const struct tty_operations riscom_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001382 .open = rc_open,
1383 .close = rc_close,
1384 .write = rc_write,
1385 .put_char = rc_put_char,
1386 .flush_chars = rc_flush_chars,
1387 .write_room = rc_write_room,
1388 .chars_in_buffer = rc_chars_in_buffer,
1389 .flush_buffer = rc_flush_buffer,
1390 .ioctl = rc_ioctl,
1391 .throttle = rc_throttle,
1392 .unthrottle = rc_unthrottle,
1393 .set_termios = rc_set_termios,
1394 .stop = rc_stop,
1395 .start = rc_start,
1396 .hangup = rc_hangup,
1397 .tiocmget = rc_tiocmget,
1398 .tiocmset = rc_tiocmset,
Alan Cox781cff52008-07-22 11:18:30 +01001399 .break_ctl = rc_send_break,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001400};
1401
Alan Cox31f35932009-01-02 13:45:05 +00001402static const struct tty_port_operations riscom_port_ops = {
1403 .carrier_raised = carrier_raised,
Alan Cox6ff1ab22009-09-19 13:13:22 -07001404 .shutdown = rc_close_port,
Alan Cox31f35932009-01-02 13:45:05 +00001405};
1406
1407
Jiri Slaby1386a822008-02-07 00:16:36 -08001408static int __init rc_init_drivers(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001409{
1410 int error;
1411 int i;
1412
1413 riscom_driver = alloc_tty_driver(RC_NBOARD * RC_NPORT);
Alan Cox9492e132008-04-30 00:54:15 -07001414 if (!riscom_driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001415 return -ENOMEM;
Alan Cox9492e132008-04-30 00:54:15 -07001416
Linus Torvalds1da177e2005-04-16 15:20:36 -07001417 riscom_driver->owner = THIS_MODULE;
1418 riscom_driver->name = "ttyL";
Linus Torvalds1da177e2005-04-16 15:20:36 -07001419 riscom_driver->major = RISCOM8_NORMAL_MAJOR;
1420 riscom_driver->type = TTY_DRIVER_TYPE_SERIAL;
1421 riscom_driver->subtype = SERIAL_TYPE_NORMAL;
1422 riscom_driver->init_termios = tty_std_termios;
1423 riscom_driver->init_termios.c_cflag =
1424 B9600 | CS8 | CREAD | HUPCL | CLOCAL;
Alan Cox606d0992006-12-08 02:38:45 -08001425 riscom_driver->init_termios.c_ispeed = 9600;
1426 riscom_driver->init_termios.c_ospeed = 9600;
Alan Cox781cff52008-07-22 11:18:30 +01001427 riscom_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_HARDWARE_BREAK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001428 tty_set_operations(riscom_driver, &riscom_ops);
Alan Cox9492e132008-04-30 00:54:15 -07001429 error = tty_register_driver(riscom_driver);
1430 if (error != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001431 put_tty_driver(riscom_driver);
1432 printk(KERN_ERR "rc: Couldn't register RISCom/8 driver, "
Alan Cox9492e132008-04-30 00:54:15 -07001433 "error = %d\n", error);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001434 return 1;
1435 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001436 memset(rc_port, 0, sizeof(rc_port));
1437 for (i = 0; i < RC_NPORT * RC_NBOARD; i++) {
Alan Cox85f8f812008-07-16 21:55:29 +01001438 tty_port_init(&rc_port[i].port);
Alan Cox31f35932009-01-02 13:45:05 +00001439 rc_port[i].port.ops = &riscom_port_ops;
Alan Cox44b7d1b2008-07-16 21:57:18 +01001440 rc_port[i].magic = RISCOM8_MAGIC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001441 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442 return 0;
1443}
1444
1445static void rc_release_drivers(void)
1446{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001447 tty_unregister_driver(riscom_driver);
1448 put_tty_driver(riscom_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001449}
1450
1451#ifndef MODULE
1452/*
1453 * Called at boot time.
Alan Cox9492e132008-04-30 00:54:15 -07001454 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07001455 * You can specify IO base for up to RC_NBOARD cards,
1456 * using line "riscom8=0xiobase1,0xiobase2,.." at LILO prompt.
1457 * Note that there will be no probing at default
1458 * addresses in this case.
1459 *
Alan Cox9492e132008-04-30 00:54:15 -07001460 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461static int __init riscom8_setup(char *str)
1462{
1463 int ints[RC_NBOARD];
1464 int i;
1465
1466 str = get_options(str, ARRAY_SIZE(ints), ints);
1467
1468 for (i = 0; i < RC_NBOARD; i++) {
1469 if (i < ints[0])
1470 rc_board[i].base = ints[i+1];
Alan Cox9492e132008-04-30 00:54:15 -07001471 else
Linus Torvalds1da177e2005-04-16 15:20:36 -07001472 rc_board[i].base = 0;
1473 }
1474 return 1;
1475}
1476
1477__setup("riscom8=", riscom8_setup);
1478#endif
1479
1480static char banner[] __initdata =
1481 KERN_INFO "rc: SDL RISCom/8 card driver v1.1, (c) D.Gorodchanin "
1482 "1994-1996.\n";
1483static char no_boards_msg[] __initdata =
1484 KERN_INFO "rc: No RISCom/8 boards detected.\n";
1485
Alan Cox9492e132008-04-30 00:54:15 -07001486/*
1487 * This routine must be called by kernel at boot time
Linus Torvalds1da177e2005-04-16 15:20:36 -07001488 */
1489static int __init riscom8_init(void)
1490{
1491 int i;
1492 int found = 0;
1493
1494 printk(banner);
1495
Alan Cox9492e132008-04-30 00:54:15 -07001496 if (rc_init_drivers())
Linus Torvalds1da177e2005-04-16 15:20:36 -07001497 return -EIO;
1498
Alan Cox9492e132008-04-30 00:54:15 -07001499 for (i = 0; i < RC_NBOARD; i++)
1500 if (rc_board[i].base && !rc_probe(&rc_board[i]))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001501 found++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001502 if (!found) {
1503 rc_release_drivers();
1504 printk(no_boards_msg);
1505 return -EIO;
1506 }
1507 return 0;
1508}
1509
1510#ifdef MODULE
1511static int iobase;
1512static int iobase1;
1513static int iobase2;
1514static int iobase3;
Rusty Russell8d3b33f2006-03-25 03:07:05 -08001515module_param(iobase, int, 0);
1516module_param(iobase1, int, 0);
1517module_param(iobase2, int, 0);
1518module_param(iobase3, int, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001519
1520MODULE_LICENSE("GPL");
Scott James Remnant5c9f5802009-04-06 17:33:26 +01001521MODULE_ALIAS_CHARDEV_MAJOR(RISCOM8_NORMAL_MAJOR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001522#endif /* MODULE */
1523
1524/*
1525 * You can setup up to 4 boards (current value of RC_NBOARD)
1526 * by specifying "iobase=0xXXX iobase1=0xXXX ..." as insmod parameter.
1527 *
1528 */
Alan Cox9492e132008-04-30 00:54:15 -07001529static int __init riscom8_init_module(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001530{
1531#ifdef MODULE
1532 int i;
1533
1534 if (iobase || iobase1 || iobase2 || iobase3) {
Alan Cox9492e132008-04-30 00:54:15 -07001535 for (i = 0; i < RC_NBOARD; i++)
Jiri Slaby9efda792008-03-13 12:32:39 -07001536 rc_board[i].base = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001537 }
1538
1539 if (iobase)
1540 rc_board[0].base = iobase;
1541 if (iobase1)
1542 rc_board[1].base = iobase1;
1543 if (iobase2)
1544 rc_board[2].base = iobase2;
1545 if (iobase3)
1546 rc_board[3].base = iobase3;
1547#endif /* MODULE */
1548
1549 return riscom8_init();
1550}
Alan Cox9492e132008-04-30 00:54:15 -07001551
1552static void __exit riscom8_exit_module(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001553{
1554 int i;
Alan Cox9492e132008-04-30 00:54:15 -07001555
Linus Torvalds1da177e2005-04-16 15:20:36 -07001556 rc_release_drivers();
Alan Cox9492e132008-04-30 00:54:15 -07001557 for (i = 0; i < RC_NBOARD; i++)
1558 if (rc_board[i].flags & RC_BOARD_PRESENT)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001559 rc_release_io_range(&rc_board[i]);
Alan Cox9492e132008-04-30 00:54:15 -07001560
Linus Torvalds1da177e2005-04-16 15:20:36 -07001561}
1562
1563module_init(riscom8_init_module);
1564module_exit(riscom8_exit_module);