riscom8.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:49k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  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
  7.  *      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 
  10.  * 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. #include <linux/module.h>
  34. #include <asm/io.h>
  35. #include <linux/kernel.h>
  36. #include <linux/sched.h>
  37. #include <linux/ioport.h>
  38. #include <linux/interrupt.h>
  39. #include <linux/errno.h>
  40. #include <linux/tty.h>
  41. #include <linux/mm.h>
  42. #include <linux/serial.h>
  43. #include <linux/fcntl.h>
  44. #include <linux/major.h>
  45. #include <linux/init.h>
  46. #include <asm/uaccess.h>
  47. #include "riscom8.h"
  48. #include "riscom8_reg.h"
  49. /* Am I paranoid or not ? ;-) */
  50. #define RISCOM_PARANOIA_CHECK
  51. /* 
  52.  * Crazy InteliCom/8 boards sometimes has swapped CTS & DSR signals.
  53.  * You can slightly speed up things by #undefing the following option,
  54.  * if you are REALLY sure that your board is correct one. 
  55.  */
  56. #define RISCOM_BRAIN_DAMAGED_CTS
  57. /* 
  58.  * The following defines are mostly for testing purposes. But if you need
  59.  * some nice reporting in your syslog, you can define them also.
  60.  */
  61. #undef RC_REPORT_FIFO
  62. #undef RC_REPORT_OVERRUN
  63. #define RISCOM_LEGAL_FLAGS 
  64. (ASYNC_HUP_NOTIFY   | ASYNC_SAK          | ASYNC_SPLIT_TERMIOS   | 
  65.  ASYNC_SPD_HI       | ASYNC_SPEED_VHI    | ASYNC_SESSION_LOCKOUT | 
  66.  ASYNC_PGRP_LOCKOUT | ASYNC_CALLOUT_NOHUP)
  67. #ifndef MIN
  68. #define MIN(a,b) ((a) < (b) ? (a) : (b))
  69. #endif
  70. #define RS_EVENT_WRITE_WAKEUP 0
  71. static DECLARE_TASK_QUEUE(tq_riscom);
  72. #define RISCOM_TYPE_NORMAL 1
  73. #define RISCOM_TYPE_CALLOUT 2
  74. static struct riscom_board * IRQ_to_board[16];
  75. static struct tty_driver riscom_driver, riscom_callout_driver;
  76. static int    riscom_refcount;
  77. static struct tty_struct * riscom_table[RC_NBOARD * RC_NPORT];
  78. static struct termios * riscom_termios[RC_NBOARD * RC_NPORT];
  79. static struct termios * riscom_termios_locked[RC_NBOARD * RC_NPORT];
  80. static unsigned char * tmp_buf;
  81. static DECLARE_MUTEX(tmp_buf_sem);
  82. static unsigned long baud_table[] =  {
  83. 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
  84. 9600, 19200, 38400, 57600, 76800, 0, 
  85. };
  86. static struct riscom_board rc_board[RC_NBOARD] =  {
  87. {
  88. base: RC_IOBASE1,
  89. },
  90. {
  91. base: RC_IOBASE2,
  92. },
  93. {
  94. base: RC_IOBASE3,
  95. },
  96. {
  97. base: RC_IOBASE4,
  98. },
  99. };
  100. static struct riscom_port rc_port[RC_NBOARD * RC_NPORT];
  101. /* RISCom/8 I/O ports addresses (without address translation) */
  102. static unsigned short rc_ioport[] =  {
  103. #if 1
  104. 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x09, 0x0a, 0x0b, 0x0c,
  105. #else
  106. 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x09, 0x0a, 0x0b, 0x0c, 0x10,
  107. 0x11, 0x12, 0x18, 0x28, 0x31, 0x32, 0x39, 0x3a, 0x40, 0x41, 0x61, 0x62,
  108. 0x63, 0x64, 0x6b, 0x70, 0x71, 0x78, 0x7a, 0x7b, 0x7f, 0x100, 0x101
  109. #endif
  110. };
  111. #define RC_NIOPORT (sizeof(rc_ioport) / sizeof(rc_ioport[0]))
  112. static inline int rc_paranoia_check(struct riscom_port const * port,
  113.     kdev_t device, const char *routine)
  114. {
  115. #ifdef RISCOM_PARANOIA_CHECK
  116. static const char badmagic[] = KERN_INFO
  117. "rc: Warning: bad riscom port magic number for device %s in %sn";
  118. static const char badinfo[] = KERN_INFO
  119. "rc: Warning: null riscom port for device %s in %sn";
  120. if (!port) {
  121. printk(badinfo, kdevname(device), routine);
  122. return 1;
  123. }
  124. if (port->magic != RISCOM8_MAGIC) {
  125. printk(badmagic, kdevname(device), routine);
  126. return 1;
  127. }
  128. #endif
  129. return 0;
  130. }
  131. /*
  132.  * 
  133.  *  Service functions for RISCom/8 driver.
  134.  * 
  135.  */
  136. /* Get board number from pointer */
  137. static inline int board_No (struct riscom_board const * bp)
  138. {
  139. return bp - rc_board;
  140. }
  141. /* Get port number from pointer */
  142. static inline int port_No (struct riscom_port const * port)
  143. {
  144. return RC_PORT(port - rc_port); 
  145. }
  146. /* Get pointer to board from pointer to port */
  147. static inline struct riscom_board * port_Board(struct riscom_port const * port)
  148. {
  149. return &rc_board[RC_BOARD(port - rc_port)];
  150. }
  151. /* Input Byte from CL CD180 register */
  152. static inline unsigned char rc_in(struct riscom_board const * bp, unsigned short reg)
  153. {
  154. return inb(bp->base + RC_TO_ISA(reg));
  155. }
  156. /* Output Byte to CL CD180 register */
  157. static inline void rc_out(struct riscom_board const * bp, unsigned short reg,
  158.   unsigned char val)
  159. {
  160. outb(val, bp->base + RC_TO_ISA(reg));
  161. }
  162. /* Wait for Channel Command Register ready */
  163. static inline void rc_wait_CCR(struct riscom_board const * bp)
  164. {
  165. unsigned long delay;
  166. /* FIXME: need something more descriptive then 100000 :) */
  167. for (delay = 100000; delay; delay--) 
  168. if (!rc_in(bp, CD180_CCR))
  169. return;
  170. printk(KERN_INFO "rc%d: Timeout waiting for CCR.n", board_No(bp));
  171. }
  172. /*
  173.  *  RISCom/8 probe functions.
  174.  */
  175. static inline int rc_request_io_range(struct riscom_board * const bp)
  176. {
  177. int i;
  178. for (i = 0; i < RC_NIOPORT; i++)  
  179. if (!request_region(RC_TO_ISA(rc_ioport[i]) + bp->base, 1,
  180.    "RISCom/8"))  {
  181. goto out_release;
  182. }
  183. return 0;
  184. out_release:
  185. printk(KERN_INFO "rc%d: Skipping probe at 0x%03x. IO address in use.n",
  186.  board_No(bp), bp->base);
  187. while(--i >= 0)
  188. release_region(RC_TO_ISA(rc_ioport[i]) + bp->base, 1);
  189. return 1;
  190. }
  191. static inline void rc_release_io_range(struct riscom_board * const bp)
  192. {
  193. int i;
  194. for (i = 0; i < RC_NIOPORT; i++)  
  195. release_region(RC_TO_ISA(rc_ioport[i]) + bp->base, 1);
  196. }
  197. /* Must be called with enabled interrupts */
  198. static inline void rc_long_delay(unsigned long delay)
  199. {
  200. unsigned long i;
  201. for (i = jiffies + delay; time_after(i,jiffies); ) ;
  202. }
  203. /* Reset and setup CD180 chip */
  204. static void __init rc_init_CD180(struct riscom_board const * bp)
  205. {
  206. unsigned long flags;
  207. save_flags(flags); cli();
  208. rc_out(bp, RC_CTOUT, 0);                 /* Clear timeout             */
  209. rc_wait_CCR(bp);    /* Wait for CCR ready        */
  210. rc_out(bp, CD180_CCR, CCR_HARDRESET);      /* Reset CD180 chip          */
  211. sti();
  212. rc_long_delay(HZ/20);                      /* Delay 0.05 sec            */
  213. cli();
  214. rc_out(bp, CD180_GIVR, RC_ID);             /* Set ID for this chip      */
  215. rc_out(bp, CD180_GICR, 0);                 /* Clear all bits            */
  216. rc_out(bp, CD180_PILR1, RC_ACK_MINT);      /* Prio for modem intr       */
  217. rc_out(bp, CD180_PILR2, RC_ACK_TINT);      /* Prio for transmitter intr */
  218. rc_out(bp, CD180_PILR3, RC_ACK_RINT);      /* Prio for receiver intr    */
  219. /* Setting up prescaler. We need 4 ticks per 1 ms */
  220. rc_out(bp, CD180_PPRH, (RC_OSCFREQ/(1000000/RISCOM_TPS)) >> 8);
  221. rc_out(bp, CD180_PPRL, (RC_OSCFREQ/(1000000/RISCOM_TPS)) & 0xff);
  222. restore_flags(flags);
  223. }
  224. /* Main probing routine, also sets irq. */
  225. static int __init rc_probe(struct riscom_board *bp)
  226. {
  227. unsigned char val1, val2;
  228. int irqs = 0;
  229. int retries;
  230. bp->irq = 0;
  231. if (rc_request_io_range(bp))
  232. return 1;
  233. /* Are the I/O ports here ? */
  234. rc_out(bp, CD180_PPRL, 0x5a);
  235. outb(0xff, 0x80);
  236. val1 = rc_in(bp, CD180_PPRL);
  237. rc_out(bp, CD180_PPRL, 0xa5);
  238. outb(0x00, 0x80);
  239. val2 = rc_in(bp, CD180_PPRL);
  240. if ((val1 != 0x5a) || (val2 != 0xa5))  {
  241. printk(KERN_ERR "rc%d: RISCom/8 Board at 0x%03x not found.n",
  242.        board_No(bp), bp->base);
  243. goto out_release;
  244. }
  245. /* It's time to find IRQ for this board */
  246. for (retries = 0; retries < 5 && irqs <= 0; retries++)  {
  247. irqs = probe_irq_on();
  248. rc_init_CD180(bp);         /* Reset CD180 chip       */
  249. rc_out(bp, CD180_CAR, 2);               /* Select port 2          */
  250. rc_wait_CCR(bp);
  251. rc_out(bp, CD180_CCR, CCR_TXEN);        /* Enable transmitter     */
  252. rc_out(bp, CD180_IER, IER_TXRDY);       /* Enable tx empty intr   */
  253. rc_long_delay(HZ/20);        
  254. irqs = probe_irq_off(irqs);
  255. val1 = rc_in(bp, RC_BSR); /* Get Board Status reg   */
  256. val2 = rc_in(bp, RC_ACK_TINT);          /* ACK interrupt          */
  257. rc_init_CD180(bp);         /* Reset CD180 again      */
  258. if ((val1 & RC_BSR_TINT) || (val2 != (RC_ID | GIVR_IT_TX)))  {
  259. printk(KERN_ERR "rc%d: RISCom/8 Board at 0x%03x not "
  260. "found.n", board_No(bp), bp->base);
  261. goto out_release;
  262. }
  263. }
  264. if (irqs <= 0)  {
  265. printk(KERN_ERR "rc%d: Can't find IRQ for RISCom/8 board "
  266. "at 0x%03x.n", board_No(bp), bp->base);
  267. goto out_release;
  268. }
  269. bp->irq = irqs;
  270. bp->flags |= RC_BOARD_PRESENT;
  271. printk(KERN_INFO "rc%d: RISCom/8 Rev. %c board detected at "
  272.  "0x%03x, IRQ %d.n",
  273.        board_No(bp),
  274.        (rc_in(bp, CD180_GFRCR) & 0x0f) + 'A',   /* Board revision */
  275.        bp->base, bp->irq);
  276. return 0;
  277. out_release:
  278. rc_release_io_range(bp);
  279. return 1;
  280. }
  281. /* 
  282.  * 
  283.  *  Interrupt processing routines.
  284.  * 
  285.  */
  286. static inline void rc_mark_event(struct riscom_port * port, int event)
  287. {
  288. /* 
  289.          * I'm not quite happy with current scheme all serial
  290.  * drivers use their own BH routine.
  291.          * It seems this easily can be done with one BH routine
  292.  * serving for all serial drivers.
  293.  * For now I must introduce another one - RISCOM8_BH.
  294.  * Still hope this will be changed in near future.
  295.          */
  296. set_bit(event, &port->event);
  297. queue_task(&port->tqueue, &tq_riscom);
  298. mark_bh(RISCOM8_BH);
  299. }
  300. static inline struct riscom_port * rc_get_port(struct riscom_board const * bp,
  301.        unsigned char const * what)
  302. {
  303. unsigned char channel;
  304. struct riscom_port * port;
  305. channel = rc_in(bp, CD180_GICR) >> GICR_CHAN_OFF;
  306. if (channel < CD180_NCH)  {
  307. port = &rc_port[board_No(bp) * RC_NPORT + channel];
  308. if (port->flags & ASYNC_INITIALIZED)  {
  309. return port;
  310. }
  311. }
  312. printk(KERN_ERR "rc%d: %s interrupt from invalid port %dn", 
  313.        board_No(bp), what, channel);
  314. return NULL;
  315. }
  316. static inline void rc_receive_exc(struct riscom_board const * bp)
  317. {
  318. struct riscom_port *port;
  319. struct tty_struct *tty;
  320. unsigned char status;
  321. unsigned char ch;
  322. if (!(port = rc_get_port(bp, "Receive")))
  323. return;
  324. tty = port->tty;
  325. if (tty->flip.count >= TTY_FLIPBUF_SIZE)  {
  326. printk(KERN_WARNING "rc%d: port %d: Working around flip "
  327.     "buffer overflow.n",
  328.        board_No(bp), port_No(port));
  329. return;
  330. }
  331. #ifdef RC_REPORT_OVERRUN
  332. status = rc_in(bp, CD180_RCSR);
  333. if (status & RCSR_OE)  {
  334. port->overrun++;
  335. #if 0
  336. printk(KERN_ERR "rc%d: port %d: Overrun. Total %ld overrunsn", 
  337.        board_No(bp), port_No(port), port->overrun);
  338. #endif
  339. }
  340. status &= port->mark_mask;
  341. #else
  342. status = rc_in(bp, CD180_RCSR) & port->mark_mask;
  343. #endif
  344. ch = rc_in(bp, CD180_RDR);
  345. if (!status)  {
  346. return;
  347. }
  348. if (status & RCSR_TOUT)  {
  349. printk(KERN_WARNING "rc%d: port %d: Receiver timeout. "
  350.     "Hardware problems ?n", 
  351.        board_No(bp), port_No(port));
  352. return;
  353. } else if (status & RCSR_BREAK)  {
  354. printk(KERN_INFO "rc%d: port %d: Handling break...n",
  355.        board_No(bp), port_No(port));
  356. *tty->flip.flag_buf_ptr++ = TTY_BREAK;
  357. if (port->flags & ASYNC_SAK)
  358. do_SAK(tty);
  359. } else if (status & RCSR_PE) 
  360. *tty->flip.flag_buf_ptr++ = TTY_PARITY;
  361. else if (status & RCSR_FE) 
  362. *tty->flip.flag_buf_ptr++ = TTY_FRAME;
  363.         else if (status & RCSR_OE)
  364. *tty->flip.flag_buf_ptr++ = TTY_OVERRUN;
  365. else
  366. *tty->flip.flag_buf_ptr++ = 0;
  367. *tty->flip.char_buf_ptr++ = ch;
  368. tty->flip.count++;
  369. queue_task(&tty->flip.tqueue, &tq_timer);
  370. }
  371. static inline void rc_receive(struct riscom_board const * bp)
  372. {
  373. struct riscom_port *port;
  374. struct tty_struct *tty;
  375. unsigned char count;
  376. if (!(port = rc_get_port(bp, "Receive")))
  377. return;
  378. tty = port->tty;
  379. count = rc_in(bp, CD180_RDCR);
  380. #ifdef RC_REPORT_FIFO
  381. port->hits[count > 8 ? 9 : count]++;
  382. #endif
  383. while (count--)  {
  384. if (tty->flip.count >= TTY_FLIPBUF_SIZE)  {
  385. printk(KERN_WARNING "rc%d: port %d: Working around "
  386.     "flip buffer overflow.n",
  387.        board_No(bp), port_No(port));
  388. break;
  389. }
  390. *tty->flip.char_buf_ptr++ = rc_in(bp, CD180_RDR);
  391. *tty->flip.flag_buf_ptr++ = 0;
  392. tty->flip.count++;
  393. }
  394. queue_task(&tty->flip.tqueue, &tq_timer);
  395. }
  396. static inline void rc_transmit(struct riscom_board const * bp)
  397. {
  398. struct riscom_port *port;
  399. struct tty_struct *tty;
  400. unsigned char count;
  401. if (!(port = rc_get_port(bp, "Transmit")))
  402. return;
  403. tty = port->tty;
  404. if (port->IER & IER_TXEMPTY)  {
  405. /* FIFO drained */
  406. rc_out(bp, CD180_CAR, port_No(port));
  407. port->IER &= ~IER_TXEMPTY;
  408. rc_out(bp, CD180_IER, port->IER);
  409. return;
  410. }
  411. if ((port->xmit_cnt <= 0 && !port->break_length)
  412.     || tty->stopped || tty->hw_stopped)  {
  413. rc_out(bp, CD180_CAR, port_No(port));
  414. port->IER &= ~IER_TXRDY;
  415. rc_out(bp, CD180_IER, port->IER);
  416. return;
  417. }
  418. if (port->break_length)  {
  419. if (port->break_length > 0)  {
  420. if (port->COR2 & COR2_ETC)  {
  421. rc_out(bp, CD180_TDR, CD180_C_ESC);
  422. rc_out(bp, CD180_TDR, CD180_C_SBRK);
  423. port->COR2 &= ~COR2_ETC;
  424. }
  425. count = MIN(port->break_length, 0xff);
  426. rc_out(bp, CD180_TDR, CD180_C_ESC);
  427. rc_out(bp, CD180_TDR, CD180_C_DELAY);
  428. rc_out(bp, CD180_TDR, count);
  429. if (!(port->break_length -= count))
  430. port->break_length--;
  431. } else  {
  432. rc_out(bp, CD180_TDR, CD180_C_ESC);
  433. rc_out(bp, CD180_TDR, CD180_C_EBRK);
  434. rc_out(bp, CD180_COR2, port->COR2);
  435. rc_wait_CCR(bp);
  436. rc_out(bp, CD180_CCR, CCR_CORCHG2);
  437. port->break_length = 0;
  438. }
  439. return;
  440. }
  441. count = CD180_NFIFO;
  442. do {
  443. rc_out(bp, CD180_TDR, port->xmit_buf[port->xmit_tail++]);
  444. port->xmit_tail = port->xmit_tail & (SERIAL_XMIT_SIZE-1);
  445. if (--port->xmit_cnt <= 0)
  446. break;
  447. } while (--count > 0);
  448. if (port->xmit_cnt <= 0)  {
  449. rc_out(bp, CD180_CAR, port_No(port));
  450. port->IER &= ~IER_TXRDY;
  451. rc_out(bp, CD180_IER, port->IER);
  452. }
  453. if (port->xmit_cnt <= port->wakeup_chars)
  454. rc_mark_event(port, RS_EVENT_WRITE_WAKEUP);
  455. }
  456. static inline void rc_check_modem(struct riscom_board const * bp)
  457. {
  458. struct riscom_port *port;
  459. struct tty_struct *tty;
  460. unsigned char mcr;
  461. if (!(port = rc_get_port(bp, "Modem")))
  462. return;
  463. tty = port->tty;
  464. mcr = rc_in(bp, CD180_MCR);
  465. if (mcr & MCR_CDCHG)  {
  466. if (rc_in(bp, CD180_MSVR) & MSVR_CD) 
  467. wake_up_interruptible(&port->open_wait);
  468. else if (!((port->flags & ASYNC_CALLOUT_ACTIVE) &&
  469.    (port->flags & ASYNC_CALLOUT_NOHUP))) {
  470. MOD_INC_USE_COUNT;
  471. if (schedule_task(&port->tqueue_hangup) == 0)
  472. MOD_DEC_USE_COUNT;
  473. }
  474. }
  475. #ifdef RISCOM_BRAIN_DAMAGED_CTS
  476. if (mcr & MCR_CTSCHG)  {
  477. if (rc_in(bp, CD180_MSVR) & MSVR_CTS)  {
  478. tty->hw_stopped = 0;
  479. port->IER |= IER_TXRDY;
  480. if (port->xmit_cnt <= port->wakeup_chars)
  481. rc_mark_event(port, RS_EVENT_WRITE_WAKEUP);
  482. } else  {
  483. tty->hw_stopped = 1;
  484. port->IER &= ~IER_TXRDY;
  485. }
  486. rc_out(bp, CD180_IER, port->IER);
  487. }
  488. if (mcr & MCR_DSRCHG)  {
  489. if (rc_in(bp, CD180_MSVR) & MSVR_DSR)  {
  490. tty->hw_stopped = 0;
  491. port->IER |= IER_TXRDY;
  492. if (port->xmit_cnt <= port->wakeup_chars)
  493. rc_mark_event(port, RS_EVENT_WRITE_WAKEUP);
  494. } else  {
  495. tty->hw_stopped = 1;
  496. port->IER &= ~IER_TXRDY;
  497. }
  498. rc_out(bp, CD180_IER, port->IER);
  499. }
  500. #endif /* RISCOM_BRAIN_DAMAGED_CTS */
  501. /* Clear change bits */
  502. rc_out(bp, CD180_MCR, 0);
  503. }
  504. /* The main interrupt processing routine */
  505. static void rc_interrupt(int irq, void * dev_id, struct pt_regs * regs)
  506. {
  507. unsigned char status;
  508. unsigned char ack;
  509. struct riscom_board *bp;
  510. unsigned long loop = 0;
  511. bp = IRQ_to_board[irq];
  512. if (!bp || !(bp->flags & RC_BOARD_ACTIVE))  {
  513. return;
  514. }
  515. while ((++loop < 16) && ((status = ~(rc_in(bp, RC_BSR))) &
  516.  (RC_BSR_TOUT | RC_BSR_TINT |
  517.   RC_BSR_MINT | RC_BSR_RINT))) {
  518. if (status & RC_BSR_TOUT) 
  519. printk(KERN_WARNING "rc%d: Got timeout. Hardware "
  520.     "error?n", board_No(bp));
  521. else if (status & RC_BSR_RINT) {
  522. ack = rc_in(bp, RC_ACK_RINT);
  523. if (ack == (RC_ID | GIVR_IT_RCV))
  524. rc_receive(bp);
  525. else if (ack == (RC_ID | GIVR_IT_REXC))
  526. rc_receive_exc(bp);
  527. else
  528. printk(KERN_WARNING "rc%d: Bad receive ack "
  529.     "0x%02x.n",
  530.        board_No(bp), ack);
  531. } else if (status & RC_BSR_TINT) {
  532. ack = rc_in(bp, RC_ACK_TINT);
  533. if (ack == (RC_ID | GIVR_IT_TX))
  534. rc_transmit(bp);
  535. else
  536. printk(KERN_WARNING "rc%d: Bad transmit ack "
  537.     "0x%02x.n",
  538.        board_No(bp), ack);
  539. } else /* if (status & RC_BSR_MINT) */ {
  540. ack = rc_in(bp, RC_ACK_MINT);
  541. if (ack == (RC_ID | GIVR_IT_MODEM)) 
  542. rc_check_modem(bp);
  543. else
  544. printk(KERN_WARNING "rc%d: Bad modem ack "
  545.     "0x%02x.n",
  546.        board_No(bp), ack);
  547. rc_out(bp, CD180_EOIR, 0);   /* Mark end of interrupt */
  548. rc_out(bp, RC_CTOUT, 0);     /* Clear timeout flag    */
  549. }
  550. }
  551. /*
  552.  *  Routines for open & close processing.
  553.  */
  554. /* Called with disabled interrupts */
  555. static inline int rc_setup_board(struct riscom_board * bp)
  556. {
  557. int error;
  558. if (bp->flags & RC_BOARD_ACTIVE) 
  559. return 0;
  560. error = request_irq(bp->irq, rc_interrupt, SA_INTERRUPT,
  561.     "RISCom/8", NULL);
  562. if (error) 
  563. return error;
  564. rc_out(bp, RC_CTOUT, 0);        /* Just in case         */
  565. bp->DTR = ~0;
  566. rc_out(bp, RC_DTR, bp->DTR);         /* Drop DTR on all ports */
  567. IRQ_to_board[bp->irq] = bp;
  568. bp->flags |= RC_BOARD_ACTIVE;
  569. MOD_INC_USE_COUNT;
  570. return 0;
  571. }
  572. /* Called with disabled interrupts */
  573. static inline void rc_shutdown_board(struct riscom_board *bp)
  574. {
  575. if (!(bp->flags & RC_BOARD_ACTIVE))
  576. return;
  577. bp->flags &= ~RC_BOARD_ACTIVE;
  578. free_irq(bp->irq, NULL);
  579. IRQ_to_board[bp->irq] = NULL;
  580. bp->DTR = ~0;
  581. rc_out(bp, RC_DTR, bp->DTR);        /* Drop DTR on all ports */
  582. MOD_DEC_USE_COUNT;
  583. }
  584. /*
  585.  * Setting up port characteristics. 
  586.  * Must be called with disabled interrupts
  587.  */
  588. static void rc_change_speed(struct riscom_board *bp, struct riscom_port *port)
  589. {
  590. struct tty_struct *tty;
  591. unsigned long baud;
  592. long tmp;
  593. unsigned char cor1 = 0, cor3 = 0;
  594. unsigned char mcor1 = 0, mcor2 = 0;
  595. if (!(tty = port->tty) || !tty->termios)
  596. return;
  597. port->IER  = 0;
  598. port->COR2 = 0;
  599. port->MSVR = MSVR_RTS;
  600. baud = C_BAUD(tty);
  601. if (baud & CBAUDEX) {
  602. baud &= ~CBAUDEX;
  603. if (baud < 1 || baud > 2) 
  604. port->tty->termios->c_cflag &= ~CBAUDEX;
  605. else
  606. baud += 15;
  607. }
  608. if (baud == 15)  {
  609. if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
  610. baud ++;
  611. if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
  612. baud += 2;
  613. }
  614. /* Select port on the board */
  615. rc_out(bp, CD180_CAR, port_No(port));
  616. if (!baud_table[baud])  {
  617. /* Drop DTR & exit */
  618. bp->DTR |= (1u << port_No(port));
  619. rc_out(bp, RC_DTR, bp->DTR);
  620. return;
  621. } else  {
  622. /* Set DTR on */
  623. bp->DTR &= ~(1u << port_No(port));
  624. rc_out(bp, RC_DTR, bp->DTR);
  625. }
  626. /*
  627.  * Now we must calculate some speed depended things 
  628.  */
  629. /* Set baud rate for port */
  630. tmp = (((RC_OSCFREQ + baud_table[baud]/2) / baud_table[baud] +
  631. CD180_TPC/2) / CD180_TPC);
  632. rc_out(bp, CD180_RBPRH, (tmp >> 8) & 0xff); 
  633. rc_out(bp, CD180_TBPRH, (tmp >> 8) & 0xff); 
  634. rc_out(bp, CD180_RBPRL, tmp & 0xff); 
  635. rc_out(bp, CD180_TBPRL, tmp & 0xff);
  636. baud = (baud_table[baud] + 5) / 10;   /* Estimated CPS */
  637. /* Two timer ticks seems enough to wakeup something like SLIP driver */
  638. tmp = ((baud + HZ/2) / HZ) * 2 - CD180_NFIFO;
  639. port->wakeup_chars = (tmp < 0) ? 0 : ((tmp >= SERIAL_XMIT_SIZE) ?
  640.       SERIAL_XMIT_SIZE - 1 : tmp);
  641. /* Receiver timeout will be transmission time for 1.5 chars */
  642. tmp = (RISCOM_TPS + RISCOM_TPS/2 + baud/2) / baud;
  643. tmp = (tmp > 0xff) ? 0xff : tmp;
  644. rc_out(bp, CD180_RTPR, tmp);
  645. switch (C_CSIZE(tty))  {
  646.  case CS5:
  647. cor1 |= COR1_5BITS;
  648. break;
  649.  case CS6:
  650. cor1 |= COR1_6BITS;
  651. break;
  652.  case CS7:
  653. cor1 |= COR1_7BITS;
  654. break;
  655.  case CS8:
  656. cor1 |= COR1_8BITS;
  657. break;
  658. }
  659. if (C_CSTOPB(tty)) 
  660. cor1 |= COR1_2SB;
  661. cor1 |= COR1_IGNORE;
  662. if (C_PARENB(tty))  {
  663. cor1 |= COR1_NORMPAR;
  664. if (C_PARODD(tty)) 
  665. cor1 |= COR1_ODDP;
  666. if (I_INPCK(tty)) 
  667. cor1 &= ~COR1_IGNORE;
  668. }
  669. /* Set marking of some errors */
  670. port->mark_mask = RCSR_OE | RCSR_TOUT;
  671. if (I_INPCK(tty)) 
  672. port->mark_mask |= RCSR_FE | RCSR_PE;
  673. if (I_BRKINT(tty) || I_PARMRK(tty)) 
  674. port->mark_mask |= RCSR_BREAK;
  675. if (I_IGNPAR(tty)) 
  676. port->mark_mask &= ~(RCSR_FE | RCSR_PE);
  677. if (I_IGNBRK(tty))  {
  678. port->mark_mask &= ~RCSR_BREAK;
  679. if (I_IGNPAR(tty)) 
  680. /* Real raw mode. Ignore all */
  681. port->mark_mask &= ~RCSR_OE;
  682. }
  683. /* Enable Hardware Flow Control */
  684. if (C_CRTSCTS(tty))  {
  685. #ifdef RISCOM_BRAIN_DAMAGED_CTS
  686. port->IER |= IER_DSR | IER_CTS;
  687. mcor1 |= MCOR1_DSRZD | MCOR1_CTSZD;
  688. mcor2 |= MCOR2_DSROD | MCOR2_CTSOD;
  689. tty->hw_stopped = !(rc_in(bp, CD180_MSVR) & (MSVR_CTS|MSVR_DSR));
  690. #else
  691. port->COR2 |= COR2_CTSAE;
  692. #endif
  693. }
  694. /* Enable Software Flow Control. FIXME: I'm not sure about this */
  695. /* Some people reported that it works, but I still doubt */
  696. if (I_IXON(tty))  {
  697. port->COR2 |= COR2_TXIBE;
  698. cor3 |= (COR3_FCT | COR3_SCDE);
  699. if (I_IXANY(tty))
  700. port->COR2 |= COR2_IXM;
  701. rc_out(bp, CD180_SCHR1, START_CHAR(tty));
  702. rc_out(bp, CD180_SCHR2, STOP_CHAR(tty));
  703. rc_out(bp, CD180_SCHR3, START_CHAR(tty));
  704. rc_out(bp, CD180_SCHR4, STOP_CHAR(tty));
  705. }
  706. if (!C_CLOCAL(tty))  {
  707. /* Enable CD check */
  708. port->IER |= IER_CD;
  709. mcor1 |= MCOR1_CDZD;
  710. mcor2 |= MCOR2_CDOD;
  711. }
  712. if (C_CREAD(tty)) 
  713. /* Enable receiver */
  714. port->IER |= IER_RXD;
  715. /* Set input FIFO size (1-8 bytes) */
  716. cor3 |= RISCOM_RXFIFO; 
  717. /* Setting up CD180 channel registers */
  718. rc_out(bp, CD180_COR1, cor1);
  719. rc_out(bp, CD180_COR2, port->COR2);
  720. rc_out(bp, CD180_COR3, cor3);
  721. /* Make CD180 know about registers change */
  722. rc_wait_CCR(bp);
  723. rc_out(bp, CD180_CCR, CCR_CORCHG1 | CCR_CORCHG2 | CCR_CORCHG3);
  724. /* Setting up modem option registers */
  725. rc_out(bp, CD180_MCOR1, mcor1);
  726. rc_out(bp, CD180_MCOR2, mcor2);
  727. /* Enable CD180 transmitter & receiver */
  728. rc_wait_CCR(bp);
  729. rc_out(bp, CD180_CCR, CCR_TXEN | CCR_RXEN);
  730. /* Enable interrupts */
  731. rc_out(bp, CD180_IER, port->IER);
  732. /* And finally set RTS on */
  733. rc_out(bp, CD180_MSVR, port->MSVR);
  734. }
  735. /* Must be called with interrupts enabled */
  736. static int rc_setup_port(struct riscom_board *bp, struct riscom_port *port)
  737. {
  738. unsigned long flags;
  739. if (port->flags & ASYNC_INITIALIZED)
  740. return 0;
  741. if (!port->xmit_buf) {
  742. /* We may sleep in get_free_page() */
  743. unsigned long tmp;
  744. if (!(tmp = get_free_page(GFP_KERNEL)))
  745. return -ENOMEM;
  746.     
  747. if (port->xmit_buf) {
  748. free_page(tmp);
  749. return -ERESTARTSYS;
  750. }
  751. port->xmit_buf = (unsigned char *) tmp;
  752. }
  753. save_flags(flags); cli();
  754. if (port->tty) 
  755. clear_bit(TTY_IO_ERROR, &port->tty->flags);
  756. if (port->count == 1) 
  757. bp->count++;
  758. port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
  759. rc_change_speed(bp, port);
  760. port->flags |= ASYNC_INITIALIZED;
  761. restore_flags(flags);
  762. return 0;
  763. }
  764. /* Must be called with interrupts disabled */
  765. static void rc_shutdown_port(struct riscom_board *bp, struct riscom_port *port)
  766. {
  767. struct tty_struct *tty;
  768. if (!(port->flags & ASYNC_INITIALIZED)) 
  769. return;
  770. #ifdef RC_REPORT_OVERRUN
  771. printk(KERN_INFO "rc%d: port %d: Total %ld overruns were detected.n",
  772.        board_No(bp), port_No(port), port->overrun);
  773. #endif
  774. #ifdef RC_REPORT_FIFO
  775. {
  776. int i;
  777. printk(KERN_INFO "rc%d: port %d: FIFO hits [ ",
  778.        board_No(bp), port_No(port));
  779. for (i = 0; i < 10; i++)  {
  780. printk("%ld ", port->hits[i]);
  781. }
  782. printk("].n");
  783. }
  784. #endif
  785. if (port->xmit_buf)  {
  786. free_page((unsigned long) port->xmit_buf);
  787. port->xmit_buf = NULL;
  788. }
  789. if (!(tty = port->tty) || C_HUPCL(tty))  {
  790. /* Drop DTR */
  791. bp->DTR |= (1u << port_No(port));
  792. rc_out(bp, RC_DTR, bp->DTR);
  793. }
  794.         /* Select port */
  795. rc_out(bp, CD180_CAR, port_No(port));
  796. /* Reset port */
  797. rc_wait_CCR(bp);
  798. rc_out(bp, CD180_CCR, CCR_SOFTRESET);
  799. /* Disable all interrupts from this port */
  800. port->IER = 0;
  801. rc_out(bp, CD180_IER, port->IER);
  802. if (tty)  
  803. set_bit(TTY_IO_ERROR, &tty->flags);
  804. port->flags &= ~ASYNC_INITIALIZED;
  805. if (--bp->count < 0)  {
  806. printk(KERN_INFO "rc%d: rc_shutdown_port: "
  807.  "bad board count: %dn",
  808.        board_No(bp), bp->count);
  809. bp->count = 0;
  810. }
  811. /*
  812.  * If this is the last opened port on the board
  813.  * shutdown whole board
  814.  */
  815. if (!bp->count) 
  816. rc_shutdown_board(bp);
  817. }
  818. static int block_til_ready(struct tty_struct *tty, struct file * filp,
  819.    struct riscom_port *port)
  820. {
  821. DECLARE_WAITQUEUE(wait, current);
  822. struct riscom_board *bp = port_Board(port);
  823. int    retval;
  824. int    do_clocal = 0;
  825. int    CD;
  826. /*
  827.  * If the device is in the middle of being closed, then block
  828.  * until it's done, and then try again.
  829.  */
  830. if (tty_hung_up_p(filp) || port->flags & ASYNC_CLOSING) {
  831. interruptible_sleep_on(&port->close_wait);
  832. if (port->flags & ASYNC_HUP_NOTIFY)
  833. return -EAGAIN;
  834. else
  835. return -ERESTARTSYS;
  836. }
  837. /*
  838.  * If this is a callout device, then just make sure the normal
  839.  * device isn't being used.
  840.  */
  841. if (tty->driver.subtype == RISCOM_TYPE_CALLOUT) {
  842. if (port->flags & ASYNC_NORMAL_ACTIVE)
  843. return -EBUSY;
  844. if ((port->flags & ASYNC_CALLOUT_ACTIVE) &&
  845.     (port->flags & ASYNC_SESSION_LOCKOUT) &&
  846.     (port->session != current->session))
  847.     return -EBUSY;
  848. if ((port->flags & ASYNC_CALLOUT_ACTIVE) &&
  849.     (port->flags & ASYNC_PGRP_LOCKOUT) &&
  850.     (port->pgrp != current->pgrp))
  851.     return -EBUSY;
  852. port->flags |= ASYNC_CALLOUT_ACTIVE;
  853. return 0;
  854. }
  855. /*
  856.  * If non-blocking mode is set, or the port is not enabled,
  857.  * then make the check up front and then exit.
  858.  */
  859. if ((filp->f_flags & O_NONBLOCK) ||
  860.     (tty->flags & (1 << TTY_IO_ERROR))) {
  861. if (port->flags & ASYNC_CALLOUT_ACTIVE)
  862. return -EBUSY;
  863. port->flags |= ASYNC_NORMAL_ACTIVE;
  864. return 0;
  865. }
  866. if (port->flags & ASYNC_CALLOUT_ACTIVE) {
  867. if (port->normal_termios.c_cflag & CLOCAL) 
  868. do_clocal = 1;
  869. } else {
  870. if (C_CLOCAL(tty))  
  871. do_clocal = 1;
  872. }
  873. /*
  874.  * Block waiting for the carrier detect and the line to become
  875.  * free (i.e., not in use by the callout).  While we are in
  876.  * this loop, info->count is dropped by one, so that
  877.  * rs_close() knows when to free things.  We restore it upon
  878.  * exit, either normal or abnormal.
  879.  */
  880. retval = 0;
  881. add_wait_queue(&port->open_wait, &wait);
  882. cli();
  883. if (!tty_hung_up_p(filp))
  884. port->count--;
  885. sti();
  886. port->blocked_open++;
  887. while (1) {
  888. cli();
  889. rc_out(bp, CD180_CAR, port_No(port));
  890. CD = rc_in(bp, CD180_MSVR) & MSVR_CD;
  891. if (!(port->flags & ASYNC_CALLOUT_ACTIVE))  {
  892. rc_out(bp, CD180_MSVR, MSVR_RTS);
  893. bp->DTR &= ~(1u << port_No(port));
  894. rc_out(bp, RC_DTR, bp->DTR);
  895. }
  896. sti();
  897. set_current_state(TASK_INTERRUPTIBLE);
  898. if (tty_hung_up_p(filp) ||
  899.     !(port->flags & ASYNC_INITIALIZED)) {
  900. if (port->flags & ASYNC_HUP_NOTIFY)
  901. retval = -EAGAIN;
  902. else
  903. retval = -ERESTARTSYS;
  904. break;
  905. }
  906. if (!(port->flags & ASYNC_CALLOUT_ACTIVE) &&
  907.     !(port->flags & ASYNC_CLOSING) &&
  908.     (do_clocal || CD))
  909. break;
  910. if (signal_pending(current)) {
  911. retval = -ERESTARTSYS;
  912. break;
  913. }
  914. schedule();
  915. }
  916. current->state = TASK_RUNNING;
  917. remove_wait_queue(&port->open_wait, &wait);
  918. if (!tty_hung_up_p(filp))
  919. port->count++;
  920. port->blocked_open--;
  921. if (retval)
  922. return retval;
  923. port->flags |= ASYNC_NORMAL_ACTIVE;
  924. return 0;
  925. }
  926. static int rc_open(struct tty_struct * tty, struct file * filp)
  927. {
  928. int board;
  929. int error;
  930. struct riscom_port * port;
  931. struct riscom_board * bp;
  932. unsigned long flags;
  933. board = RC_BOARD(MINOR(tty->device));
  934. if (board > RC_NBOARD || !(rc_board[board].flags & RC_BOARD_PRESENT))
  935. return -ENODEV;
  936. bp = &rc_board[board];
  937. port = rc_port + board * RC_NPORT + RC_PORT(MINOR(tty->device));
  938. if (rc_paranoia_check(port, tty->device, "rc_open"))
  939. return -ENODEV;
  940. if ((error = rc_setup_board(bp))) 
  941. return error;
  942. port->count++;
  943. tty->driver_data = port;
  944. port->tty = tty;
  945. if ((error = rc_setup_port(bp, port))) 
  946. return error;
  947. if ((error = block_til_ready(tty, filp, port)))
  948. return error;
  949. if ((port->count == 1) && (port->flags & ASYNC_SPLIT_TERMIOS)) {
  950. if (tty->driver.subtype == RISCOM_TYPE_NORMAL)
  951. *tty->termios = port->normal_termios;
  952. else
  953. *tty->termios = port->callout_termios;
  954. save_flags(flags); cli();
  955. rc_change_speed(bp, port);
  956. restore_flags(flags);
  957. }
  958. port->session = current->session;
  959. port->pgrp = current->pgrp;
  960. return 0;
  961. }
  962. static void rc_close(struct tty_struct * tty, struct file * filp)
  963. {
  964. struct riscom_port *port = (struct riscom_port *) tty->driver_data;
  965. struct riscom_board *bp;
  966. unsigned long flags;
  967. unsigned long timeout;
  968. if (!port || rc_paranoia_check(port, tty->device, "close"))
  969. return;
  970. save_flags(flags); cli();
  971. if (tty_hung_up_p(filp))
  972. goto out;
  973. bp = port_Board(port);
  974. if ((tty->count == 1) && (port->count != 1))  {
  975. printk(KERN_INFO "rc%d: rc_close: bad port count;"
  976.        " tty->count is 1, port count is %dn",
  977.        board_No(bp), port->count);
  978. port->count = 1;
  979. }
  980. if (--port->count < 0)  {
  981. printk(KERN_INFO "rc%d: rc_close: bad port count "
  982.  "for tty%d: %dn",
  983.        board_No(bp), port_No(port), port->count);
  984. port->count = 0;
  985. }
  986. if (port->count)
  987. goto out;
  988. port->flags |= ASYNC_CLOSING;
  989. /*
  990.  * Save the termios structure, since this port may have
  991.  * separate termios for callout and dialin.
  992.  */
  993. if (port->flags & ASYNC_NORMAL_ACTIVE)
  994. port->normal_termios = *tty->termios;
  995. if (port->flags & ASYNC_CALLOUT_ACTIVE)
  996. port->callout_termios = *tty->termios;
  997. /*
  998.  * Now we wait for the transmit buffer to clear; and we notify 
  999.  * the line discipline to only process XON/XOFF characters.
  1000.  */
  1001. tty->closing = 1;
  1002. if (port->closing_wait != ASYNC_CLOSING_WAIT_NONE)
  1003. tty_wait_until_sent(tty, port->closing_wait);
  1004. /*
  1005.  * At this point we stop accepting input.  To do this, we
  1006.  * disable the receive line status interrupts, and tell the
  1007.  * interrupt driver to stop checking the data ready bit in the
  1008.  * line status register.
  1009.  */
  1010. port->IER &= ~IER_RXD;
  1011. if (port->flags & ASYNC_INITIALIZED) {
  1012. port->IER &= ~IER_TXRDY;
  1013. port->IER |= IER_TXEMPTY;
  1014. rc_out(bp, CD180_CAR, port_No(port));
  1015. rc_out(bp, CD180_IER, port->IER);
  1016. /*
  1017.  * Before we drop DTR, make sure the UART transmitter
  1018.  * has completely drained; this is especially
  1019.  * important if there is a transmit FIFO!
  1020.  */
  1021. timeout = jiffies+HZ;
  1022. while(port->IER & IER_TXEMPTY)  {
  1023. current->state = TASK_INTERRUPTIBLE;
  1024.   schedule_timeout(port->timeout);
  1025. if (time_after(jiffies, timeout))
  1026. break;
  1027. }
  1028. }
  1029. rc_shutdown_port(bp, port);
  1030. if (tty->driver.flush_buffer)
  1031. tty->driver.flush_buffer(tty);
  1032. if (tty->ldisc.flush_buffer)
  1033. tty->ldisc.flush_buffer(tty);
  1034. tty->closing = 0;
  1035. port->event = 0;
  1036. port->tty = 0;
  1037. if (port->blocked_open) {
  1038. if (port->close_delay) {
  1039. current->state = TASK_INTERRUPTIBLE;
  1040. schedule_timeout(port->close_delay);
  1041. }
  1042. wake_up_interruptible(&port->open_wait);
  1043. }
  1044. port->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CALLOUT_ACTIVE|
  1045.  ASYNC_CLOSING);
  1046. wake_up_interruptible(&port->close_wait);
  1047. out: restore_flags(flags);
  1048. }
  1049. static int rc_write(struct tty_struct * tty, int from_user, 
  1050.     const unsigned char *buf, int count)
  1051. {
  1052. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1053. struct riscom_board *bp;
  1054. int c, total = 0;
  1055. unsigned long flags;
  1056. if (rc_paranoia_check(port, tty->device, "rc_write"))
  1057. return 0;
  1058. bp = port_Board(port);
  1059. if (!tty || !port->xmit_buf || !tmp_buf)
  1060. return 0;
  1061. save_flags(flags);
  1062. if (from_user) {
  1063. down(&tmp_buf_sem);
  1064. while (1) {
  1065. cli();
  1066. c = MIN(count, MIN(SERIAL_XMIT_SIZE - port->xmit_cnt - 1,
  1067.    SERIAL_XMIT_SIZE - port->xmit_head));
  1068. if (c <= 0)
  1069. break;
  1070. c -= copy_from_user(tmp_buf, buf, c);
  1071. if (!c) {
  1072. if (!total)
  1073. total = -EFAULT;
  1074. break;
  1075. }
  1076. cli();
  1077. c = MIN(c, MIN(SERIAL_XMIT_SIZE - port->xmit_cnt - 1,
  1078.        SERIAL_XMIT_SIZE - port->xmit_head));
  1079. memcpy(port->xmit_buf + port->xmit_head, tmp_buf, c);
  1080. port->xmit_head = (port->xmit_head + c) & (SERIAL_XMIT_SIZE-1);
  1081. port->xmit_cnt += c;
  1082. restore_flags(flags);
  1083. buf += c;
  1084. count -= c;
  1085. total += c;
  1086. }
  1087. up(&tmp_buf_sem);
  1088. } else {
  1089. while (1) {
  1090. cli();
  1091. c = MIN(count, MIN(SERIAL_XMIT_SIZE - port->xmit_cnt - 1,
  1092.    SERIAL_XMIT_SIZE - port->xmit_head));
  1093. if (c <= 0) {
  1094. restore_flags(flags);
  1095. break;
  1096. }
  1097. memcpy(port->xmit_buf + port->xmit_head, buf, c);
  1098. port->xmit_head = (port->xmit_head + c) & (SERIAL_XMIT_SIZE-1);
  1099. port->xmit_cnt += c;
  1100. restore_flags(flags);
  1101. buf += c;
  1102. count -= c;
  1103. total += c;
  1104. }
  1105. }
  1106. cli();
  1107. if (port->xmit_cnt && !tty->stopped && !tty->hw_stopped &&
  1108.     !(port->IER & IER_TXRDY)) {
  1109. port->IER |= IER_TXRDY;
  1110. rc_out(bp, CD180_CAR, port_No(port));
  1111. rc_out(bp, CD180_IER, port->IER);
  1112. }
  1113. restore_flags(flags);
  1114. return total;
  1115. }
  1116. static void rc_put_char(struct tty_struct * tty, unsigned char ch)
  1117. {
  1118. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1119. unsigned long flags;
  1120. if (rc_paranoia_check(port, tty->device, "rc_put_char"))
  1121. return;
  1122. if (!tty || !port->xmit_buf)
  1123. return;
  1124. save_flags(flags); cli();
  1125. if (port->xmit_cnt >= SERIAL_XMIT_SIZE - 1)
  1126. goto out;
  1127. port->xmit_buf[port->xmit_head++] = ch;
  1128. port->xmit_head &= SERIAL_XMIT_SIZE - 1;
  1129. port->xmit_cnt++;
  1130. out: restore_flags(flags);
  1131. }
  1132. static void rc_flush_chars(struct tty_struct * tty)
  1133. {
  1134. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1135. unsigned long flags;
  1136. if (rc_paranoia_check(port, tty->device, "rc_flush_chars"))
  1137. return;
  1138. if (port->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped ||
  1139.     !port->xmit_buf)
  1140. return;
  1141. save_flags(flags); cli();
  1142. port->IER |= IER_TXRDY;
  1143. rc_out(port_Board(port), CD180_CAR, port_No(port));
  1144. rc_out(port_Board(port), CD180_IER, port->IER);
  1145. restore_flags(flags);
  1146. }
  1147. static int rc_write_room(struct tty_struct * tty)
  1148. {
  1149. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1150. int ret;
  1151. if (rc_paranoia_check(port, tty->device, "rc_write_room"))
  1152. return 0;
  1153. ret = SERIAL_XMIT_SIZE - port->xmit_cnt - 1;
  1154. if (ret < 0)
  1155. ret = 0;
  1156. return ret;
  1157. }
  1158. static int rc_chars_in_buffer(struct tty_struct *tty)
  1159. {
  1160. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1161. if (rc_paranoia_check(port, tty->device, "rc_chars_in_buffer"))
  1162. return 0;
  1163. return port->xmit_cnt;
  1164. }
  1165. static void rc_flush_buffer(struct tty_struct *tty)
  1166. {
  1167. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1168. unsigned long flags;
  1169. if (rc_paranoia_check(port, tty->device, "rc_flush_buffer"))
  1170. return;
  1171. save_flags(flags); cli();
  1172. port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
  1173. restore_flags(flags);
  1174. wake_up_interruptible(&tty->write_wait);
  1175. if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
  1176.     tty->ldisc.write_wakeup)
  1177. (tty->ldisc.write_wakeup)(tty);
  1178. }
  1179. static int rc_get_modem_info(struct riscom_port * port, unsigned int *value)
  1180. {
  1181. struct riscom_board * bp;
  1182. unsigned char status;
  1183. unsigned int result;
  1184. unsigned long flags;
  1185. bp = port_Board(port);
  1186. save_flags(flags); cli();
  1187. rc_out(bp, CD180_CAR, port_No(port));
  1188. status = rc_in(bp, CD180_MSVR);
  1189. result = rc_in(bp, RC_RI) & (1u << port_No(port)) ? 0 : TIOCM_RNG;
  1190. restore_flags(flags);
  1191. result |= ((status & MSVR_RTS) ? TIOCM_RTS : 0)
  1192. | ((status & MSVR_DTR) ? TIOCM_DTR : 0)
  1193. | ((status & MSVR_CD)  ? TIOCM_CAR : 0)
  1194. | ((status & MSVR_DSR) ? TIOCM_DSR : 0)
  1195. | ((status & MSVR_CTS) ? TIOCM_CTS : 0);
  1196. return put_user(result, value);
  1197. }
  1198. static int rc_set_modem_info(struct riscom_port * port, unsigned int cmd,
  1199.      unsigned int *value)
  1200. {
  1201. unsigned int arg;
  1202. unsigned long flags;
  1203. struct riscom_board *bp = port_Board(port);
  1204. if (get_user(arg, value))
  1205. return -EFAULT;
  1206. switch (cmd) {
  1207.  case TIOCMBIS: 
  1208. if (arg & TIOCM_RTS) 
  1209. port->MSVR |= MSVR_RTS;
  1210. if (arg & TIOCM_DTR)
  1211. bp->DTR &= ~(1u << port_No(port));
  1212. break;
  1213. case TIOCMBIC:
  1214. if (arg & TIOCM_RTS)
  1215. port->MSVR &= ~MSVR_RTS;
  1216. if (arg & TIOCM_DTR)
  1217. bp->DTR |= (1u << port_No(port));
  1218. break;
  1219. case TIOCMSET:
  1220. port->MSVR = (arg & TIOCM_RTS) ? (port->MSVR | MSVR_RTS) : 
  1221.          (port->MSVR & ~MSVR_RTS);
  1222. bp->DTR = arg & TIOCM_DTR ? (bp->DTR &= ~(1u << port_No(port))) :
  1223.     (bp->DTR |=  (1u << port_No(port)));
  1224. break;
  1225.  default:
  1226. return -EINVAL;
  1227. }
  1228. save_flags(flags); cli();
  1229. rc_out(bp, CD180_CAR, port_No(port));
  1230. rc_out(bp, CD180_MSVR, port->MSVR);
  1231. rc_out(bp, RC_DTR, bp->DTR);
  1232. restore_flags(flags);
  1233. return 0;
  1234. }
  1235. static inline void rc_send_break(struct riscom_port * port, unsigned long length)
  1236. {
  1237. struct riscom_board *bp = port_Board(port);
  1238. unsigned long flags;
  1239. save_flags(flags); cli();
  1240. port->break_length = RISCOM_TPS / HZ * length;
  1241. port->COR2 |= COR2_ETC;
  1242. port->IER  |= IER_TXRDY;
  1243. rc_out(bp, CD180_CAR, port_No(port));
  1244. rc_out(bp, CD180_COR2, port->COR2);
  1245. rc_out(bp, CD180_IER, port->IER);
  1246. rc_wait_CCR(bp);
  1247. rc_out(bp, CD180_CCR, CCR_CORCHG2);
  1248. rc_wait_CCR(bp);
  1249. restore_flags(flags);
  1250. }
  1251. static inline int rc_set_serial_info(struct riscom_port * port,
  1252.      struct serial_struct * newinfo)
  1253. {
  1254. struct serial_struct tmp;
  1255. struct riscom_board *bp = port_Board(port);
  1256. int change_speed;
  1257. unsigned long flags;
  1258. if (copy_from_user(&tmp, newinfo, sizeof(tmp)))
  1259. return -EFAULT;
  1260. #if 0
  1261. if ((tmp.irq != bp->irq) ||
  1262.     (tmp.port != bp->base) ||
  1263.     (tmp.type != PORT_CIRRUS) ||
  1264.     (tmp.baud_base != (RC_OSCFREQ + CD180_TPC/2) / CD180_TPC) ||
  1265.     (tmp.custom_divisor != 0) ||
  1266.     (tmp.xmit_fifo_size != CD180_NFIFO) ||
  1267.     (tmp.flags & ~RISCOM_LEGAL_FLAGS))
  1268. return -EINVAL;
  1269. #endif
  1270. change_speed = ((port->flags & ASYNC_SPD_MASK) !=
  1271. (tmp.flags & ASYNC_SPD_MASK));
  1272. if (!capable(CAP_SYS_ADMIN)) {
  1273. if ((tmp.close_delay != port->close_delay) ||
  1274.     (tmp.closing_wait != port->closing_wait) ||
  1275.     ((tmp.flags & ~ASYNC_USR_MASK) !=
  1276.      (port->flags & ~ASYNC_USR_MASK)))  
  1277. return -EPERM;
  1278. port->flags = ((port->flags & ~ASYNC_USR_MASK) |
  1279.        (tmp.flags & ASYNC_USR_MASK));
  1280. } else  {
  1281. port->flags = ((port->flags & ~ASYNC_FLAGS) |
  1282.        (tmp.flags & ASYNC_FLAGS));
  1283. port->close_delay = tmp.close_delay;
  1284. port->closing_wait = tmp.closing_wait;
  1285. }
  1286. if (change_speed)  {
  1287. save_flags(flags); cli();
  1288. rc_change_speed(bp, port);
  1289. restore_flags(flags);
  1290. }
  1291. return 0;
  1292. }
  1293. static inline int rc_get_serial_info(struct riscom_port * port,
  1294.      struct serial_struct * retinfo)
  1295. {
  1296. struct serial_struct tmp;
  1297. struct riscom_board *bp = port_Board(port);
  1298. memset(&tmp, 0, sizeof(tmp));
  1299. tmp.type = PORT_CIRRUS;
  1300. tmp.line = port - rc_port;
  1301. tmp.port = bp->base;
  1302. tmp.irq  = bp->irq;
  1303. tmp.flags = port->flags;
  1304. tmp.baud_base = (RC_OSCFREQ + CD180_TPC/2) / CD180_TPC;
  1305. tmp.close_delay = port->close_delay * HZ/100;
  1306. tmp.closing_wait = port->closing_wait * HZ/100;
  1307. tmp.xmit_fifo_size = CD180_NFIFO;
  1308. return copy_to_user(retinfo, &tmp, sizeof(tmp)) ? -EFAULT : 0;
  1309. }
  1310. static int rc_ioctl(struct tty_struct * tty, struct file * filp, 
  1311.     unsigned int cmd, unsigned long arg)
  1312.     
  1313. {
  1314. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1315. int retval;
  1316. if (rc_paranoia_check(port, tty->device, "rc_ioctl"))
  1317. return -ENODEV;
  1318. switch (cmd) {
  1319.  case TCSBRK: /* SVID version: non-zero arg --> no break */
  1320. retval = tty_check_change(tty);
  1321. if (retval)
  1322. return retval;
  1323. tty_wait_until_sent(tty, 0);
  1324. if (!arg)
  1325. rc_send_break(port, HZ/4); /* 1/4 second */
  1326. break;
  1327.  case TCSBRKP: /* support for POSIX tcsendbreak() */
  1328. retval = tty_check_change(tty);
  1329. if (retval)
  1330. return retval;
  1331. tty_wait_until_sent(tty, 0);
  1332. rc_send_break(port, arg ? arg*(HZ/10) : HZ/4);
  1333. break;
  1334.  case TIOCGSOFTCAR:
  1335. return put_user(C_CLOCAL(tty) ? 1 : 0, (unsigned int *) arg);
  1336.  case TIOCSSOFTCAR:
  1337. if (get_user(arg,(unsigned int *) arg))
  1338. return -EFAULT;
  1339. tty->termios->c_cflag =
  1340. ((tty->termios->c_cflag & ~CLOCAL) |
  1341. (arg ? CLOCAL : 0));
  1342. break;
  1343.  case TIOCMGET:
  1344. return rc_get_modem_info(port, (unsigned int *) arg);
  1345.  case TIOCMBIS:
  1346.  case TIOCMBIC:
  1347.  case TIOCMSET:
  1348. return rc_set_modem_info(port, cmd, (unsigned int *) arg);
  1349.  case TIOCGSERIAL:
  1350. return rc_get_serial_info(port, (struct serial_struct *) arg);
  1351.  case TIOCSSERIAL:
  1352. return rc_set_serial_info(port, (struct serial_struct *) arg);
  1353.  default:
  1354. return -ENOIOCTLCMD;
  1355. }
  1356. return 0;
  1357. }
  1358. static void rc_throttle(struct tty_struct * tty)
  1359. {
  1360. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1361. struct riscom_board *bp;
  1362. unsigned long flags;
  1363. if (rc_paranoia_check(port, tty->device, "rc_throttle"))
  1364. return;
  1365. bp = port_Board(port);
  1366. save_flags(flags); cli();
  1367. port->MSVR &= ~MSVR_RTS;
  1368. rc_out(bp, CD180_CAR, port_No(port));
  1369. if (I_IXOFF(tty))  {
  1370. rc_wait_CCR(bp);
  1371. rc_out(bp, CD180_CCR, CCR_SSCH2);
  1372. rc_wait_CCR(bp);
  1373. }
  1374. rc_out(bp, CD180_MSVR, port->MSVR);
  1375. restore_flags(flags);
  1376. }
  1377. static void rc_unthrottle(struct tty_struct * tty)
  1378. {
  1379. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1380. struct riscom_board *bp;
  1381. unsigned long flags;
  1382. if (rc_paranoia_check(port, tty->device, "rc_unthrottle"))
  1383. return;
  1384. bp = port_Board(port);
  1385. save_flags(flags); cli();
  1386. port->MSVR |= MSVR_RTS;
  1387. rc_out(bp, CD180_CAR, port_No(port));
  1388. if (I_IXOFF(tty))  {
  1389. rc_wait_CCR(bp);
  1390. rc_out(bp, CD180_CCR, CCR_SSCH1);
  1391. rc_wait_CCR(bp);
  1392. }
  1393. rc_out(bp, CD180_MSVR, port->MSVR);
  1394. restore_flags(flags);
  1395. }
  1396. static void rc_stop(struct tty_struct * tty)
  1397. {
  1398. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1399. struct riscom_board *bp;
  1400. unsigned long flags;
  1401. if (rc_paranoia_check(port, tty->device, "rc_stop"))
  1402. return;
  1403. bp = port_Board(port);
  1404. save_flags(flags); cli();
  1405. port->IER &= ~IER_TXRDY;
  1406. rc_out(bp, CD180_CAR, port_No(port));
  1407. rc_out(bp, CD180_IER, port->IER);
  1408. restore_flags(flags);
  1409. }
  1410. static void rc_start(struct tty_struct * tty)
  1411. {
  1412. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1413. struct riscom_board *bp;
  1414. unsigned long flags;
  1415. if (rc_paranoia_check(port, tty->device, "rc_start"))
  1416. return;
  1417. bp = port_Board(port);
  1418. save_flags(flags); cli();
  1419. if (port->xmit_cnt && port->xmit_buf && !(port->IER & IER_TXRDY))  {
  1420. port->IER |= IER_TXRDY;
  1421. rc_out(bp, CD180_CAR, port_No(port));
  1422. rc_out(bp, CD180_IER, port->IER);
  1423. }
  1424. restore_flags(flags);
  1425. }
  1426. /*
  1427.  * This routine is called from the scheduler tqueue when the interrupt
  1428.  * routine has signalled that a hangup has occurred.  The path of
  1429.  * hangup processing is:
  1430.  *
  1431.  *  serial interrupt routine -> (scheduler tqueue) ->
  1432.  *  do_rc_hangup() -> tty->hangup() -> rc_hangup()
  1433.  * 
  1434.  */
  1435. static void do_rc_hangup(void *private_)
  1436. {
  1437. struct riscom_port *port = (struct riscom_port *) private_;
  1438. struct tty_struct *tty;
  1439. tty = port->tty;
  1440. if (tty)
  1441. tty_hangup(tty); /* FIXME: module removal race still here */
  1442. MOD_DEC_USE_COUNT;
  1443. }
  1444. static void rc_hangup(struct tty_struct * tty)
  1445. {
  1446. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1447. struct riscom_board *bp;
  1448. if (rc_paranoia_check(port, tty->device, "rc_hangup"))
  1449. return;
  1450. bp = port_Board(port);
  1451. rc_shutdown_port(bp, port);
  1452. port->event = 0;
  1453. port->count = 0;
  1454. port->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CALLOUT_ACTIVE);
  1455. port->tty = 0;
  1456. wake_up_interruptible(&port->open_wait);
  1457. }
  1458. static void rc_set_termios(struct tty_struct * tty, struct termios * old_termios)
  1459. {
  1460. struct riscom_port *port = (struct riscom_port *)tty->driver_data;
  1461. unsigned long flags;
  1462. if (rc_paranoia_check(port, tty->device, "rc_set_termios"))
  1463. return;
  1464. if (tty->termios->c_cflag == old_termios->c_cflag &&
  1465.     tty->termios->c_iflag == old_termios->c_iflag)
  1466. return;
  1467. save_flags(flags); cli();
  1468. rc_change_speed(port_Board(port), port);
  1469. restore_flags(flags);
  1470. if ((old_termios->c_cflag & CRTSCTS) &&
  1471.     !(tty->termios->c_cflag & CRTSCTS)) {
  1472. tty->hw_stopped = 0;
  1473. rc_start(tty);
  1474. }
  1475. }
  1476. static void do_riscom_bh(void)
  1477. {
  1478.  run_task_queue(&tq_riscom);
  1479. }
  1480. static void do_softint(void *private_)
  1481. {
  1482. struct riscom_port *port = (struct riscom_port *) private_;
  1483. struct tty_struct *tty;
  1484. if(!(tty = port->tty)) 
  1485. return;
  1486. if (test_and_clear_bit(RS_EVENT_WRITE_WAKEUP, &port->event)) {
  1487. if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
  1488.     tty->ldisc.write_wakeup)
  1489. (tty->ldisc.write_wakeup)(tty);
  1490. wake_up_interruptible(&tty->write_wait);
  1491. }
  1492. }
  1493. static inline int rc_init_drivers(void)
  1494. {
  1495. int error;
  1496. int i;
  1497. if (!(tmp_buf = (unsigned char *) get_free_page(GFP_KERNEL))) {
  1498. printk(KERN_ERR "rc: Couldn't get free page.n");
  1499. return 1;
  1500. }
  1501. init_bh(RISCOM8_BH, do_riscom_bh);
  1502. memset(IRQ_to_board, 0, sizeof(IRQ_to_board));
  1503. memset(&riscom_driver, 0, sizeof(riscom_driver));
  1504. riscom_driver.magic = TTY_DRIVER_MAGIC;
  1505. riscom_driver.name = "ttyL";
  1506. riscom_driver.major = RISCOM8_NORMAL_MAJOR;
  1507. riscom_driver.num = RC_NBOARD * RC_NPORT;
  1508. riscom_driver.type = TTY_DRIVER_TYPE_SERIAL;
  1509. riscom_driver.subtype = RISCOM_TYPE_NORMAL;
  1510. riscom_driver.init_termios = tty_std_termios;
  1511. riscom_driver.init_termios.c_cflag =
  1512. B9600 | CS8 | CREAD | HUPCL | CLOCAL;
  1513. riscom_driver.flags = TTY_DRIVER_REAL_RAW;
  1514. riscom_driver.refcount = &riscom_refcount;
  1515. riscom_driver.table = riscom_table;
  1516. riscom_driver.termios = riscom_termios;
  1517. riscom_driver.termios_locked = riscom_termios_locked;
  1518. riscom_driver.open  = rc_open;
  1519. riscom_driver.close = rc_close;
  1520. riscom_driver.write = rc_write;
  1521. riscom_driver.put_char = rc_put_char;
  1522. riscom_driver.flush_chars = rc_flush_chars;
  1523. riscom_driver.write_room = rc_write_room;
  1524. riscom_driver.chars_in_buffer = rc_chars_in_buffer;
  1525. riscom_driver.flush_buffer = rc_flush_buffer;
  1526. riscom_driver.ioctl = rc_ioctl;
  1527. riscom_driver.throttle = rc_throttle;
  1528. riscom_driver.unthrottle = rc_unthrottle;
  1529. riscom_driver.set_termios = rc_set_termios;
  1530. riscom_driver.stop = rc_stop;
  1531. riscom_driver.start = rc_start;
  1532. riscom_driver.hangup = rc_hangup;
  1533. riscom_callout_driver = riscom_driver;
  1534. riscom_callout_driver.name = "cul";
  1535. riscom_callout_driver.major = RISCOM8_CALLOUT_MAJOR;
  1536. riscom_callout_driver.subtype = RISCOM_TYPE_CALLOUT;
  1537. if ((error = tty_register_driver(&riscom_driver)))  {
  1538. free_page((unsigned long)tmp_buf);
  1539. printk(KERN_ERR "rc: Couldn't register RISCom/8 driver, "
  1540. "error = %dn",
  1541.        error);
  1542. return 1;
  1543. }
  1544. if ((error = tty_register_driver(&riscom_callout_driver)))  {
  1545. free_page((unsigned long)tmp_buf);
  1546. tty_unregister_driver(&riscom_driver);
  1547. printk(KERN_ERR "rc: Couldn't register RISCom/8 callout "
  1548. "driver, error = %dn",
  1549.        error);
  1550. return 1;
  1551. }
  1552. memset(rc_port, 0, sizeof(rc_port));
  1553. for (i = 0; i < RC_NPORT * RC_NBOARD; i++)  {
  1554. rc_port[i].callout_termios = riscom_callout_driver.init_termios;
  1555. rc_port[i].normal_termios  = riscom_driver.init_termios;
  1556. rc_port[i].magic = RISCOM8_MAGIC;
  1557. rc_port[i].tqueue.routine = do_softint;
  1558. rc_port[i].tqueue.data = &rc_port[i];
  1559. rc_port[i].tqueue_hangup.routine = do_rc_hangup;
  1560. rc_port[i].tqueue_hangup.data = &rc_port[i];
  1561. rc_port[i].close_delay = 50 * HZ/100;
  1562. rc_port[i].closing_wait = 3000 * HZ/100;
  1563. init_waitqueue_head(&rc_port[i].open_wait);
  1564. init_waitqueue_head(&rc_port[i].close_wait);
  1565. }
  1566. return 0;
  1567. }
  1568. static void rc_release_drivers(void)
  1569. {
  1570. unsigned long flags;
  1571. save_flags(flags);
  1572. cli();
  1573. remove_bh(RISCOM8_BH);
  1574. free_page((unsigned long)tmp_buf);
  1575. tty_unregister_driver(&riscom_driver);
  1576. tty_unregister_driver(&riscom_callout_driver);
  1577. restore_flags(flags);
  1578. }
  1579. #ifndef MODULE
  1580. /*
  1581.  * Called at boot time.
  1582.  * 
  1583.  * You can specify IO base for up to RC_NBOARD cards,
  1584.  * using line "riscom8=0xiobase1,0xiobase2,.." at LILO prompt.
  1585.  * Note that there will be no probing at default
  1586.  * addresses in this case.
  1587.  *
  1588.  */ 
  1589. static int __init riscom8_setup(char *str)
  1590. {
  1591. int ints[RC_NBOARD];
  1592. int i;
  1593. str = get_options(str, ARRAY_SIZE(ints), ints);
  1594. for (i = 0; i < RC_NBOARD; i++) {
  1595. if (i < ints[0])
  1596. rc_board[i].base = ints[i+1];
  1597. else 
  1598. rc_board[i].base = 0;
  1599. }
  1600. return 1;
  1601. }
  1602. __setup("riscom8=", riscom8_setup);
  1603. #endif
  1604. static char banner[] __initdata =
  1605. KERN_INFO "rc: SDL RISCom/8 card driver v1.1, (c) D.Gorodchanin "
  1606.   "1994-1996.n";
  1607. static char no_boards_msg[] __initdata =
  1608. KERN_INFO "rc: No RISCom/8 boards detected.n";
  1609. /* 
  1610.  * This routine must be called by kernel at boot time 
  1611.  */
  1612. static int __init riscom8_init(void)
  1613. {
  1614. int i;
  1615. int found = 0;
  1616. printk(banner);
  1617. if (rc_init_drivers()) 
  1618. return -EIO;
  1619. for (i = 0; i < RC_NBOARD; i++) 
  1620. if (rc_board[i].base && !rc_probe(&rc_board[i]))  
  1621. found++;
  1622. if (!found)  {
  1623. rc_release_drivers();
  1624. printk(no_boards_msg);
  1625. return -EIO;
  1626. }
  1627. return 0;
  1628. }
  1629. #ifdef MODULE
  1630. static int iobase;
  1631. static int iobase1;
  1632. static int iobase2;
  1633. static int iobase3;
  1634. MODULE_PARM(iobase, "i");
  1635. MODULE_PARM(iobase1, "i");
  1636. MODULE_PARM(iobase2, "i");
  1637. MODULE_PARM(iobase3, "i");
  1638. MODULE_LICENSE("GPL");
  1639. #endif /* MODULE */
  1640. /*
  1641.  * You can setup up to 4 boards (current value of RC_NBOARD)
  1642.  * by specifying "iobase=0xXXX iobase1=0xXXX ..." as insmod parameter.
  1643.  *
  1644.  */
  1645. static int __init riscom8_init_module (void)
  1646. {
  1647. #ifdef MODULE
  1648. int i;
  1649. if (iobase || iobase1 || iobase2 || iobase3) {
  1650. for(i = 0; i < RC_NBOARD; i++)
  1651. rc_board[0].base = 0;
  1652. }
  1653. if (iobase)
  1654. rc_board[0].base = iobase;
  1655. if (iobase1)
  1656. rc_board[1].base = iobase1;
  1657. if (iobase2)
  1658. rc_board[2].base = iobase2;
  1659. if (iobase3)
  1660. rc_board[3].base = iobase3;
  1661. #endif /* MODULE */
  1662. return riscom8_init();
  1663. }
  1664. static void __exit riscom8_exit_module (void)
  1665. {
  1666. int i;
  1667. rc_release_drivers();
  1668. for (i = 0; i < RC_NBOARD; i++)  
  1669. if (rc_board[i].flags & RC_BOARD_PRESENT) 
  1670. rc_release_io_range(&rc_board[i]);
  1671. }
  1672. module_init(riscom8_init_module);
  1673. module_exit(riscom8_exit_module);