Cleanup usbnet_probe() return value handling
[linux-2.6] / drivers / char / ser_a2232.c
1 /* drivers/char/ser_a2232.c */
2
3 /* $Id: ser_a2232.c,v 0.4 2000/01/25 12:00:00 ehaase Exp $ */
4
5 /* Linux serial driver for the Amiga A2232 board */
6
7 /* This driver is MAINTAINED. Before applying any changes, please contact
8  * the author.
9  */
10
11 /* Copyright (c) 2000-2001 Enver Haase    <ehaase@inf.fu-berlin.de>
12  *                   alias The A2232 driver project <A2232@gmx.net>
13  * All rights reserved.
14  *
15  *   This program is free software; you can redistribute it and/or modify
16  *   it under the terms of the GNU General Public License as published by
17  *   the Free Software Foundation; either version 2 of the License, or
18  *   (at your option) any later version.
19  *
20  *   This program is distributed in the hope that it will be useful,
21  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
22  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
23  *   GNU General Public License for more details.
24  *
25  *   You should have received a copy of the GNU General Public License
26  *   along with this program; if not, write to the Free Software
27  *   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
28  *
29  */
30 /***************************** Documentation ************************/
31 /*
32  * This driver is in EXPERIMENTAL state. That means I could not find
33  * someone with five A2232 boards with 35 ports running at 19200 bps
34  * at the same time and test the machine's behaviour.
35  * However, I know that you can performance-tweak this driver (see
36  * the source code).
37  * One thing to consider is the time this driver consumes during the
38  * Amiga's vertical blank interrupt. Everything that is to be done
39  * _IS DONE_ when entering the vertical blank interrupt handler of
40  * this driver.
41  * However, it would be more sane to only do the job for only ONE card
42  * instead of ALL cards at a time; or, more generally, to handle only
43  * SOME ports instead of ALL ports at a time.
44  * However, as long as no-one runs into problems I guess I shouldn't
45  * change the driver as it runs fine for me :) .
46  *
47  * Version history of this file:
48  * 0.4  Resolved licensing issues.
49  * 0.3  Inclusion in the Linux/m68k tree, small fixes.
50  * 0.2  Added documentation, minor typo fixes.
51  * 0.1  Initial release.
52  *
53  * TO DO:
54  * -    Handle incoming BREAK events. I guess "Stevens: Advanced
55  *      Programming in the UNIX(R) Environment" is a good reference
56  *      on what is to be done.
57  * -    When installing as a module, don't simply 'printk' text, but
58  *      send it to the TTY used by the user.
59  *
60  * THANKS TO:
61  * -    Jukka Marin (65EC02 code).
62  * -    The other NetBSD developers on whose A2232 driver I had a
63  *      pretty close look. However, I didn't copy any code so it
64  *      is okay to put my code under the GPL and include it into
65  *      Linux.
66  */
67 /***************************** End of Documentation *****************/
68
69 /***************************** Defines ******************************/
70 /*
71  * Enables experimental 115200 (normal) 230400 (turbo) baud rate.
72  * The A2232 specification states it can only operate at speeds up to
73  * 19200 bits per second, and I was not able to send a file via
74  * "sz"/"rz" and a null-modem cable from one A2232 port to another
75  * at 115200 bits per second.
76  * However, this might work for you.
77  */
78 #undef A2232_SPEEDHACK
79 /*
80  * Default is not to use RTS/CTS so you could be talked to death.
81  */
82 #define A2232_SUPPRESS_RTSCTS_WARNING
83 /************************* End of Defines ***************************/
84
85 /***************************** Includes *****************************/
86 #include <linux/module.h>
87
88 #include <linux/types.h>
89 #include <linux/interrupt.h>
90 #include <linux/kernel.h>
91 #include <linux/errno.h>
92 #include <linux/tty.h>
93
94 #include <asm/setup.h>
95 #include <asm/amigaints.h>
96 #include <asm/amigahw.h>
97 #include <linux/zorro.h>
98 #include <asm/irq.h>
99 #include <linux/mutex.h>
100
101 #include <linux/delay.h>
102
103 #include <linux/serial.h>
104 #include <linux/generic_serial.h>
105 #include <linux/tty_flip.h>
106
107 #include "ser_a2232.h"
108 #include "ser_a2232fw.h"
109 /************************* End of Includes **************************/
110
111 /***************************** Prototypes ***************************/
112 /* The interrupt service routine */
113 static irqreturn_t a2232_vbl_inter(int irq, void *data);
114 /* Initialize the port structures */
115 static void a2232_init_portstructs(void);
116 /* Initialize and register TTY drivers. */
117 /* returns 0 IFF successful */
118 static int a2232_init_drivers(void); 
119
120 /* BEGIN GENERIC_SERIAL PROTOTYPES */
121 static void a2232_disable_tx_interrupts(void *ptr);
122 static void a2232_enable_tx_interrupts(void *ptr);
123 static void a2232_disable_rx_interrupts(void *ptr);
124 static void a2232_enable_rx_interrupts(void *ptr);
125 static int  a2232_get_CD(void *ptr);
126 static void a2232_shutdown_port(void *ptr);
127 static int  a2232_set_real_termios(void *ptr);
128 static int  a2232_chars_in_buffer(void *ptr);
129 static void a2232_close(void *ptr);
130 static void a2232_hungup(void *ptr);
131 /* static void a2232_getserial (void *ptr, struct serial_struct *sp); */
132 /* END GENERIC_SERIAL PROTOTYPES */
133
134 /* Functions that the TTY driver struct expects */
135 static int  a2232_ioctl(struct tty_struct *tty, struct file *file,
136                                                                                 unsigned int cmd, unsigned long arg);
137 static void a2232_throttle(struct tty_struct *tty);
138 static void a2232_unthrottle(struct tty_struct *tty);
139 static int  a2232_open(struct tty_struct * tty, struct file * filp);
140 /************************* End of Prototypes ************************/
141
142 /***************************** Global variables *********************/
143 /*---------------------------------------------------------------------------
144  * Interface from generic_serial.c back here
145  *--------------------------------------------------------------------------*/
146 static struct real_driver a2232_real_driver = {
147         a2232_disable_tx_interrupts,
148         a2232_enable_tx_interrupts,
149         a2232_disable_rx_interrupts,
150         a2232_enable_rx_interrupts,
151         a2232_get_CD,
152         a2232_shutdown_port,
153         a2232_set_real_termios,
154         a2232_chars_in_buffer,
155         a2232_close,
156         a2232_hungup,
157         NULL    /* a2232_getserial */
158 };
159
160 static void *a2232_driver_ID = &a2232_driver_ID; // Some memory address WE own.
161
162 /* Ports structs */
163 static struct a2232_port a2232_ports[MAX_A2232_BOARDS*NUMLINES];
164
165 /* TTY driver structs */
166 static struct tty_driver *a2232_driver;
167
168 /* nr of cards completely (all ports) and correctly configured */
169 static int nr_a2232; 
170
171 /* zorro_dev structs for the A2232's */
172 static struct zorro_dev *zd_a2232[MAX_A2232_BOARDS]; 
173 /***************************** End of Global variables **************/
174
175 /* Helper functions */
176
177 static inline volatile struct a2232memory *a2232mem(unsigned int board)
178 {
179         return (volatile struct a2232memory *)ZTWO_VADDR(zd_a2232[board]->resource.start);
180 }
181
182 static inline volatile struct a2232status *a2232stat(unsigned int board,
183                                                      unsigned int portonboard)
184 {
185         volatile struct a2232memory *mem = a2232mem(board);
186         return &(mem->Status[portonboard]);
187 }
188
189 static inline void a2232_receive_char(struct a2232_port *port, int ch, int err)
190 {
191 /*      Mostly stolen from other drivers.
192         Maybe one could implement a more efficient version by not only
193         transferring one character at a time.
194 */
195         struct tty_struct *tty = port->gs.tty;
196
197 #if 0
198         switch(err) {
199         case TTY_BREAK:
200                 break;
201         case TTY_PARITY:
202                 break;
203         case TTY_OVERRUN:
204                 break;
205         case TTY_FRAME:
206                 break;
207         }
208 #endif
209
210         tty_insert_flip_char(tty, ch, err);
211         tty_flip_buffer_push(tty);
212 }
213
214 /***************************** Functions ****************************/
215 /*** BEGIN OF REAL_DRIVER FUNCTIONS ***/
216
217 static void a2232_disable_tx_interrupts(void *ptr)
218 {
219         struct a2232_port *port;
220         volatile struct a2232status *stat;
221         unsigned long flags;
222   
223         port = ptr;
224         stat = a2232stat(port->which_a2232, port->which_port_on_a2232);
225         stat->OutDisable = -1;
226
227         /* Does this here really have to be? */
228         local_irq_save(flags);
229         port->gs.flags &= ~GS_TX_INTEN;
230         local_irq_restore(flags);
231 }
232
233 static void a2232_enable_tx_interrupts(void *ptr)
234 {
235         struct a2232_port *port;
236         volatile struct a2232status *stat;
237         unsigned long flags;
238
239         port = ptr;
240         stat = a2232stat(port->which_a2232, port->which_port_on_a2232);
241         stat->OutDisable = 0;
242
243         /* Does this here really have to be? */
244         local_irq_save(flags);
245         port->gs.flags |= GS_TX_INTEN;
246         local_irq_restore(flags);
247 }
248
249 static void a2232_disable_rx_interrupts(void *ptr)
250 {
251         struct a2232_port *port;
252         port = ptr;
253         port->disable_rx = -1;
254 }
255
256 static void a2232_enable_rx_interrupts(void *ptr)
257 {
258         struct a2232_port *port;
259         port = ptr;
260         port->disable_rx = 0;
261 }
262
263 static int  a2232_get_CD(void *ptr)
264 {
265         return ((struct a2232_port *) ptr)->cd_status;
266 }
267
268 static void a2232_shutdown_port(void *ptr)
269 {
270         struct a2232_port *port;
271         volatile struct a2232status *stat;
272         unsigned long flags;
273
274         port = ptr;
275         stat = a2232stat(port->which_a2232, port->which_port_on_a2232);
276
277         local_irq_save(flags);
278
279         port->gs.flags &= ~GS_ACTIVE;
280         
281         if (port->gs.tty && port->gs.tty->termios->c_cflag & HUPCL) {
282                 /* Set DTR and RTS to Low, flush output.
283                    The NetBSD driver "msc.c" does it this way. */
284                 stat->Command = (       (stat->Command & ~A2232CMD_CMask) | 
285                                         A2232CMD_Close );
286                 stat->OutFlush = -1;
287                 stat->Setup = -1;
288         }
289
290         local_irq_restore(flags);
291         
292         /* After analyzing control flow, I think a2232_shutdown_port
293                 is actually the last call from the system when at application
294                 level someone issues a "echo Hello >>/dev/ttyY0".
295                 Therefore I think the MOD_DEC_USE_COUNT should be here and
296                 not in "a2232_close()". See the comment in "sx.c", too.
297                 If you run into problems, compile this driver into the
298                 kernel instead of compiling it as a module. */
299 }
300
301 static int  a2232_set_real_termios(void *ptr)
302 {
303         unsigned int cflag, baud, chsize, stopb, parity, softflow;
304         int rate;
305         int a2232_param, a2232_cmd;
306         unsigned long flags;
307         unsigned int i;
308         struct a2232_port *port = ptr;
309         volatile struct a2232status *status;
310         volatile struct a2232memory *mem;
311
312         if (!port->gs.tty || !port->gs.tty->termios) return 0;
313
314         status = a2232stat(port->which_a2232, port->which_port_on_a2232);
315         mem = a2232mem(port->which_a2232);
316         
317         a2232_param = a2232_cmd = 0;
318
319         // get baud rate
320         baud = port->gs.baud;
321         if (baud == 0) {
322                 /* speed == 0 -> drop DTR, do nothing else */
323                 local_irq_save(flags);
324                 // Clear DTR (and RTS... mhhh).
325                 status->Command = (     (status->Command & ~A2232CMD_CMask) |
326                                         A2232CMD_Close );
327                 status->OutFlush = -1;
328                 status->Setup = -1;
329                 
330                 local_irq_restore(flags);
331                 return 0;
332         }
333         
334         rate = A2232_BAUD_TABLE_NOAVAIL;
335         for (i=0; i < A2232_BAUD_TABLE_NUM_RATES * 3; i += 3){
336                 if (a2232_baud_table[i] == baud){
337                         if (mem->Common.Crystal == A2232_TURBO) rate = a2232_baud_table[i+2];
338                         else                                    rate = a2232_baud_table[i+1];
339                 }
340         }
341         if (rate == A2232_BAUD_TABLE_NOAVAIL){
342                 printk("a2232: Board %d Port %d unsupported baud rate: %d baud. Using another.\n",port->which_a2232,port->which_port_on_a2232,baud);
343                 // This is useful for both (turbo or normal) Crystal versions.
344                 rate = A2232PARAM_B9600;
345         }
346         a2232_param |= rate;
347
348         cflag  = port->gs.tty->termios->c_cflag;
349
350         // get character size
351         chsize = cflag & CSIZE;
352         switch (chsize){
353                 case CS8:       a2232_param |= A2232PARAM_8Bit; break;
354                 case CS7:       a2232_param |= A2232PARAM_7Bit; break;
355                 case CS6:       a2232_param |= A2232PARAM_6Bit; break;
356                 case CS5:       a2232_param |= A2232PARAM_5Bit; break;
357                 default:        printk("a2232: Board %d Port %d unsupported character size: %d. Using 8 data bits.\n",
358                                         port->which_a2232,port->which_port_on_a2232,chsize);
359                                 a2232_param |= A2232PARAM_8Bit; break;
360         }
361
362         // get number of stop bits
363         stopb  = cflag & CSTOPB;
364         if (stopb){ // two stop bits instead of one
365                 printk("a2232: Board %d Port %d 2 stop bits unsupported. Using 1 stop bit.\n",
366                         port->which_a2232,port->which_port_on_a2232);
367         }
368
369         // Warn if RTS/CTS not wanted
370         if (!(cflag & CRTSCTS)){
371 #ifndef A2232_SUPPRESS_RTSCTS_WARNING
372                 printk("a2232: Board %d Port %d cannot switch off firmware-implemented RTS/CTS hardware flow control.\n",
373                         port->which_a2232,port->which_port_on_a2232);
374 #endif
375         }
376
377         /*      I think this is correct.
378                 However, IXOFF means _input_ flow control and I wonder
379                 if one should care about IXON _output_ flow control,
380                 too. If this makes problems, one should turn the A2232
381                 firmware XON/XOFF "SoftFlow" flow control off and use
382                 the conventional way of inserting START/STOP characters
383                 by hand in throttle()/unthrottle().
384         */
385         softflow = !!( port->gs.tty->termios->c_iflag & IXOFF );
386
387         // get Parity (Enabled/Disabled? If Enabled, Odd or Even?)
388         parity = cflag & (PARENB | PARODD);
389         if (parity & PARENB){
390                 if (parity & PARODD){
391                         a2232_cmd |= A2232CMD_OddParity;
392                 }
393                 else{
394                         a2232_cmd |= A2232CMD_EvenParity;
395                 }
396         }
397         else a2232_cmd |= A2232CMD_NoParity;
398
399
400         /*      Hmm. Maybe an own a2232_port structure
401                 member would be cleaner?        */
402         if (cflag & CLOCAL)
403                 port->gs.flags &= ~ASYNC_CHECK_CD;
404         else
405                 port->gs.flags |= ASYNC_CHECK_CD;
406
407
408         /* Now we have all parameters and can go to set them: */
409         local_irq_save(flags);
410
411         status->Param = a2232_param | A2232PARAM_RcvBaud;
412         status->Command = a2232_cmd | A2232CMD_Open |  A2232CMD_Enable;
413         status->SoftFlow = softflow;
414         status->OutDisable = 0;
415         status->Setup = -1;
416
417         local_irq_restore(flags);
418         return 0;
419 }
420
421 static int  a2232_chars_in_buffer(void *ptr)
422 {
423         struct a2232_port *port;
424         volatile struct a2232status *status; 
425         unsigned char ret; /* we need modulo-256 arithmetics */
426         port = ptr;
427         status = a2232stat(port->which_a2232, port->which_port_on_a2232);
428 #if A2232_IOBUFLEN != 256
429 #error "Re-Implement a2232_chars_in_buffer()!"
430 #endif
431         ret = (status->OutHead - status->OutTail);
432         return ret;
433 }
434
435 static void a2232_close(void *ptr)
436 {
437         a2232_disable_tx_interrupts(ptr);
438         a2232_disable_rx_interrupts(ptr);
439         /* see the comment in a2232_shutdown_port above. */
440 }
441
442 static void a2232_hungup(void *ptr)
443 {
444         a2232_close(ptr);
445 }
446 /*** END   OF REAL_DRIVER FUNCTIONS ***/
447
448 /*** BEGIN  FUNCTIONS EXPECTED BY TTY DRIVER STRUCTS ***/
449 static int a2232_ioctl( struct tty_struct *tty, struct file *file,
450                         unsigned int cmd, unsigned long arg)
451 {
452         return -ENOIOCTLCMD;
453 }
454
455 static void a2232_throttle(struct tty_struct *tty)
456 {
457 /* Throttle: System cannot take another chars: Drop RTS or
458              send the STOP char or whatever.
459    The A2232 firmware does RTS/CTS anyway, and XON/XOFF
460    if switched on. So the only thing we can do at this
461    layer here is not taking any characters out of the
462    A2232 buffer any more. */
463         struct a2232_port *port = (struct a2232_port *) tty->driver_data;
464         port->throttle_input = -1;
465 }
466
467 static void a2232_unthrottle(struct tty_struct *tty)
468 {
469 /* Unthrottle: dual to "throttle()" above. */
470         struct a2232_port *port = (struct a2232_port *) tty->driver_data;
471         port->throttle_input = 0;
472 }
473
474 static int  a2232_open(struct tty_struct * tty, struct file * filp)
475 {
476 /* More or less stolen from other drivers. */
477         int line;
478         int retval;
479         struct a2232_port *port;
480
481         line = tty->index;
482         port = &a2232_ports[line];
483         
484         tty->driver_data = port;
485         port->gs.tty = tty;
486         port->gs.count++;
487         retval = gs_init_port(&port->gs);
488         if (retval) {
489                 port->gs.count--;
490                 return retval;
491         }
492         port->gs.flags |= GS_ACTIVE;
493         retval = gs_block_til_ready(port, filp);
494
495         if (retval) {
496                 port->gs.count--;
497                 return retval;
498         }
499
500         a2232_enable_rx_interrupts(port);
501         
502         return 0;
503 }
504 /*** END OF FUNCTIONS EXPECTED BY TTY DRIVER STRUCTS ***/
505
506 static irqreturn_t a2232_vbl_inter(int irq, void *data)
507 {
508 #if A2232_IOBUFLEN != 256
509 #error "Re-Implement a2232_vbl_inter()!"
510 #endif
511
512 struct a2232_port *port;
513 volatile struct a2232memory *mem;
514 volatile struct a2232status *status;
515 unsigned char newhead;
516 unsigned char bufpos; /* Must be unsigned char. We need the modulo-256 arithmetics */
517 unsigned char ncd, ocd, ccd; /* names consistent with the NetBSD driver */
518 volatile u_char *ibuf, *cbuf, *obuf;
519 int ch, err, n, p;
520         for (n = 0; n < nr_a2232; n++){         /* for every completely initialized A2232 board */
521                 mem = a2232mem(n);
522                 for (p = 0; p < NUMLINES; p++){ /* for every port on this board */
523                         err = 0;
524                         port = &a2232_ports[n*NUMLINES+p];
525                         if ( port->gs.flags & GS_ACTIVE ){ /* if the port is used */
526
527                                 status = a2232stat(n,p);
528
529                                 if (!port->disable_rx && !port->throttle_input){ /* If input is not disabled */
530                                         newhead = status->InHead;               /* 65EC02 write pointer */
531                                         bufpos = status->InTail;
532
533                                         /* check for input for this port */
534                                         if (newhead != bufpos) {
535                                                 /* buffer for input chars/events */
536                                                 ibuf = mem->InBuf[p];
537  
538                                                 /* data types of bytes in ibuf */
539                                                 cbuf = mem->InCtl[p];
540  
541                                                 /* do for all chars */
542                                                 while (bufpos != newhead) {
543                                                         /* which type of input data? */
544                                                         switch (cbuf[bufpos]) {
545                                                                 /* switch on input event (CD, BREAK, etc.) */
546                                                         case A2232INCTL_EVENT:
547                                                                 switch (ibuf[bufpos++]) {
548                                                                 case A2232EVENT_Break:
549                                                                         /* TODO: Handle BREAK signal */
550                                                                         break;
551                                                                         /*      A2232EVENT_CarrierOn and A2232EVENT_CarrierOff are
552                                                                                 handled in a separate queue and should not occur here. */
553                                                                 case A2232EVENT_Sync:
554                                                                         printk("A2232: 65EC02 software sent SYNC event, don't know what to do. Ignoring.");
555                                                                         break;
556                                                                 default:
557                                                                         printk("A2232: 65EC02 software broken, unknown event type %d occurred.\n",ibuf[bufpos-1]);
558                                                                 } /* event type switch */
559                                                                 break;
560                                                         case A2232INCTL_CHAR:
561                                                                 /* Receive incoming char */
562                                                                 a2232_receive_char(port, ibuf[bufpos], err);
563                                                                 bufpos++;
564                                                                 break;
565                                                         default:
566                                                                 printk("A2232: 65EC02 software broken, unknown data type %d occurred.\n",cbuf[bufpos]);
567                                                                 bufpos++;
568                                                         } /* switch on input data type */
569                                                 } /* while there's something in the buffer */
570
571                                                 status->InTail = bufpos;            /* tell 65EC02 what we've read */
572                                                 
573                                         } /* if there was something in the buffer */                          
574                                 } /* If input is not disabled */
575
576                                 /* Now check if there's something to output */
577                                 obuf = mem->OutBuf[p];
578                                 bufpos = status->OutHead;
579                                 while ( (port->gs.xmit_cnt > 0)         &&
580                                         (!port->gs.tty->stopped)        &&
581                                         (!port->gs.tty->hw_stopped) ){  /* While there are chars to transmit */
582                                         if (((bufpos+1) & A2232_IOBUFLENMASK) != status->OutTail) { /* If the A2232 buffer is not full */
583                                                 ch = port->gs.xmit_buf[port->gs.xmit_tail];                                     /* get the next char to transmit */
584                                                 port->gs.xmit_tail = (port->gs.xmit_tail+1) & (SERIAL_XMIT_SIZE-1); /* modulo-addition for the gs.xmit_buf ring-buffer */
585                                                 obuf[bufpos++] = ch;                                                                                                                            /* put it into the A2232 buffer */
586                                                 port->gs.xmit_cnt--;
587                                         }
588                                         else{                                                                                                                                                                                                   /* If A2232 the buffer is full */
589                                                 break;                                                                                                                                                                                  /* simply stop filling it. */
590                                         }                                                                                                       
591                                 }                                       
592                                 status->OutHead = bufpos;
593                                         
594                                 /* WakeUp if output buffer runs low */
595                                 if ((port->gs.xmit_cnt <= port->gs.wakeup_chars) && port->gs.tty) {
596                                         tty_wakeup(port->gs.tty);
597                                 }
598                         } // if the port is used
599                 } // for every port on the board
600                         
601                 /* Now check the CD message queue */
602                 newhead = mem->Common.CDHead;
603                 bufpos = mem->Common.CDTail;
604                 if (newhead != bufpos){                         /* There are CD events in queue */
605                         ocd = mem->Common.CDStatus;             /* get old status bits */
606                         while (newhead != bufpos){              /* read all events */
607                                 ncd = mem->CDBuf[bufpos++];     /* get one event */
608                                 ccd = ncd ^ ocd;                /* mask of changed lines */
609                                 ocd = ncd;                      /* save new status bits */
610                                 for(p=0; p < NUMLINES; p++){    /* for all ports */
611                                         if (ccd & 1){           /* this one changed */
612
613                                                 struct a2232_port *port = &a2232_ports[n*7+p];
614                                                 port->cd_status = !(ncd & 1); /* ncd&1 <=> CD is now off */
615
616                                                 if (!(port->gs.flags & ASYNC_CHECK_CD))
617                                                         ;       /* Don't report DCD changes */
618                                                 else if (port->cd_status) { // if DCD on: DCD went UP!
619                                                         
620                                                         /* Are we blocking in open?*/
621                                                         wake_up_interruptible(&port->gs.open_wait);
622                                                 }
623                                                 else { // if DCD off: DCD went DOWN!
624                                                         if (port->gs.tty)
625                                                                 tty_hangup (port->gs.tty);
626                                                 }
627                                                 
628                                         } // if CD changed for this port
629                                         ccd >>= 1;
630                                         ncd >>= 1;                                                                      /* Shift bits for next line */
631                                 } // for every port
632                         } // while CD events in queue
633                         mem->Common.CDStatus = ocd; /* save new status */
634                         mem->Common.CDTail = bufpos; /* remove events */
635                 } // if events in CD queue
636                 
637         } // for every completely initialized A2232 board
638         return IRQ_HANDLED;
639 }
640
641 static void a2232_init_portstructs(void)
642 {
643         struct a2232_port *port;
644         int i;
645
646         for (i = 0; i < MAX_A2232_BOARDS*NUMLINES; i++) {
647                 port = a2232_ports + i;
648                 port->which_a2232 = i/NUMLINES;
649                 port->which_port_on_a2232 = i%NUMLINES;
650                 port->disable_rx = port->throttle_input = port->cd_status = 0;
651                 port->gs.magic = A2232_MAGIC;
652                 port->gs.close_delay = HZ/2;
653                 port->gs.closing_wait = 30 * HZ;
654                 port->gs.rd = &a2232_real_driver;
655 #ifdef NEW_WRITE_LOCKING
656                 init_MUTEX(&(port->gs.port_write_mutex));
657 #endif
658                 init_waitqueue_head(&port->gs.open_wait);
659                 init_waitqueue_head(&port->gs.close_wait);
660         }
661 }
662
663 static const struct tty_operations a2232_ops = {
664         .open = a2232_open,
665         .close = gs_close,
666         .write = gs_write,
667         .put_char = gs_put_char,
668         .flush_chars = gs_flush_chars,
669         .write_room = gs_write_room,
670         .chars_in_buffer = gs_chars_in_buffer,
671         .flush_buffer = gs_flush_buffer,
672         .ioctl = a2232_ioctl,
673         .throttle = a2232_throttle,
674         .unthrottle = a2232_unthrottle,
675         .set_termios = gs_set_termios,
676         .stop = gs_stop,
677         .start = gs_start,
678         .hangup = gs_hangup,
679 };
680
681 static int a2232_init_drivers(void)
682 {
683         int error;
684
685         a2232_driver = alloc_tty_driver(NUMLINES * nr_a2232);
686         if (!a2232_driver)
687                 return -ENOMEM;
688         a2232_driver->owner = THIS_MODULE;
689         a2232_driver->driver_name = "commodore_a2232";
690         a2232_driver->name = "ttyY";
691         a2232_driver->major = A2232_NORMAL_MAJOR;
692         a2232_driver->type = TTY_DRIVER_TYPE_SERIAL;
693         a2232_driver->subtype = SERIAL_TYPE_NORMAL;
694         a2232_driver->init_termios = tty_std_termios;
695         a2232_driver->init_termios.c_cflag =
696                 B9600 | CS8 | CREAD | HUPCL | CLOCAL;
697         a2232_driver->init_termios.c_ispeed = 9600;
698         a2232_driver->init_termios.c_ospeed = 9600;
699         a2232_driver->flags = TTY_DRIVER_REAL_RAW;
700         tty_set_operations(a2232_driver, &a2232_ops);
701         if ((error = tty_register_driver(a2232_driver))) {
702                 printk(KERN_ERR "A2232: Couldn't register A2232 driver, error = %d\n",
703                        error);
704                 put_tty_driver(a2232_driver);
705                 return 1;
706         }
707         return 0;
708 }
709
710 static int __init a2232board_init(void)
711 {
712         struct zorro_dev *z;
713
714         unsigned int boardaddr;
715         int bcount;
716         short start;
717         u_char *from;
718         volatile u_char *to;
719         volatile struct a2232memory *mem;
720
721 #ifdef CONFIG_SMP
722         return -ENODEV; /* This driver is not SMP aware. Is there an SMP ZorroII-bus-machine? */
723 #endif
724
725         if (!MACH_IS_AMIGA){
726                 return -ENODEV;
727         }
728
729         printk("Commodore A2232 driver initializing.\n"); /* Say that we're alive. */
730
731         z = NULL;
732         nr_a2232 = 0;
733         while ( (z = zorro_find_device(ZORRO_WILDCARD, z)) ){
734                 if (    (z->id != ZORRO_PROD_CBM_A2232_PROTOTYPE) && 
735                         (z->id != ZORRO_PROD_CBM_A2232) ){
736                         continue;       // The board found was no A2232
737                 }
738                 if (!zorro_request_device(z,"A2232 driver"))
739                         continue;
740
741                 printk("Commodore A2232 found (#%d).\n",nr_a2232);
742
743                 zd_a2232[nr_a2232] = z;
744
745                 boardaddr = ZTWO_VADDR( z->resource.start );
746                 printk("Board is located at address 0x%x, size is 0x%x.\n", boardaddr, (unsigned int) ((z->resource.end+1) - (z->resource.start)));
747
748                 mem = (volatile struct a2232memory *) boardaddr;
749
750                 (void) mem->Enable6502Reset;   /* copy the code across to the board */
751                 to = (u_char *)mem;  from = a2232_65EC02code; bcount = sizeof(a2232_65EC02code) - 2;
752                 start = *(short *)from;
753                 from += sizeof(start);
754                 to += start;
755                 while(bcount--) *to++ = *from++;
756                 printk("65EC02 software uploaded to the A2232 memory.\n");
757   
758                 mem->Common.Crystal = A2232_UNKNOWN;  /* use automatic speed check */
759   
760                 /* start 6502 running */
761                 (void) mem->ResetBoard;
762                 printk("A2232's 65EC02 CPU up and running.\n");
763   
764                 /* wait until speed detector has finished */
765                 for (bcount = 0; bcount < 2000; bcount++) {
766                         udelay(1000);
767                         if (mem->Common.Crystal)
768                                 break;
769                 }
770                 printk((mem->Common.Crystal?"A2232 oscillator crystal detected by 65EC02 software: ":"65EC02 software could not determine A2232 oscillator crystal: "));
771                 switch (mem->Common.Crystal){
772                 case A2232_UNKNOWN:
773                         printk("Unknown crystal.\n");
774                         break;
775                 case A2232_NORMAL:
776                         printk ("Normal crystal.\n");
777                         break;
778                 case A2232_TURBO:
779                         printk ("Turbo crystal.\n");
780                         break;
781                 default:
782                         printk ("0x%x. Huh?\n",mem->Common.Crystal);
783                 }
784
785                 nr_a2232++;
786
787         }       
788
789         printk("Total: %d A2232 boards initialized.\n", nr_a2232); /* Some status report if no card was found */
790
791         a2232_init_portstructs();
792
793         /*
794                 a2232_init_drivers also registers the drivers. Must be here because all boards
795                 have to be detected first.
796         */
797         if (a2232_init_drivers()) return -ENODEV; // maybe we should use a different -Exxx?
798
799         request_irq(IRQ_AMIGA_VERTB, a2232_vbl_inter, 0, "A2232 serial VBL", a2232_driver_ID);
800         return 0;
801 }
802
803 static void __exit a2232board_exit(void)
804 {
805         int i;
806
807         for (i = 0; i < nr_a2232; i++) {
808                 zorro_release_device(zd_a2232[i]);
809         }
810
811         tty_unregister_driver(a2232_driver);
812         put_tty_driver(a2232_driver);
813         free_irq(IRQ_AMIGA_VERTB, a2232_driver_ID);
814 }
815
816 module_init(a2232board_init);
817 module_exit(a2232board_exit);
818
819 MODULE_AUTHOR("Enver Haase");
820 MODULE_DESCRIPTION("Amiga A2232 multi-serial board driver");
821 MODULE_LICENSE("GPL");