]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/char/istallion.c
Linux-2.6.12-rc2
[mirror_ubuntu-artful-kernel.git] / drivers / char / istallion.c
1 /*****************************************************************************/
2
3 /*
4 * istallion.c -- stallion intelligent multiport serial driver.
5 *
6 * Copyright (C) 1996-1999 Stallion Technologies
7 * Copyright (C) 1994-1996 Greg Ungerer.
8 *
9 * This code is loosely based on the Linux serial driver, written by
10 * Linus Torvalds, Theodore T'so and others.
11 *
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2 of the License, or
15 * (at your option) any later version.
16 *
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
25 */
26
27 /*****************************************************************************/
28
29 #include <linux/config.h>
30 #include <linux/module.h>
31 #include <linux/slab.h>
32 #include <linux/interrupt.h>
33 #include <linux/tty.h>
34 #include <linux/tty_flip.h>
35 #include <linux/serial.h>
36 #include <linux/cdk.h>
37 #include <linux/comstats.h>
38 #include <linux/istallion.h>
39 #include <linux/ioport.h>
40 #include <linux/delay.h>
41 #include <linux/init.h>
42 #include <linux/devfs_fs_kernel.h>
43 #include <linux/device.h>
44 #include <linux/wait.h>
45
46 #include <asm/io.h>
47 #include <asm/uaccess.h>
48
49 #ifdef CONFIG_PCI
50 #include <linux/pci.h>
51 #endif
52
53 /*****************************************************************************/
54
55 /*
56 * Define different board types. Not all of the following board types
57 * are supported by this driver. But I will use the standard "assigned"
58 * board numbers. Currently supported boards are abbreviated as:
59 * ECP = EasyConnection 8/64, ONB = ONboard, BBY = Brumby and
60 * STAL = Stallion.
61 */
62 #define BRD_UNKNOWN 0
63 #define BRD_STALLION 1
64 #define BRD_BRUMBY4 2
65 #define BRD_ONBOARD2 3
66 #define BRD_ONBOARD 4
67 #define BRD_BRUMBY8 5
68 #define BRD_BRUMBY16 6
69 #define BRD_ONBOARDE 7
70 #define BRD_ONBOARD32 9
71 #define BRD_ONBOARD2_32 10
72 #define BRD_ONBOARDRS 11
73 #define BRD_EASYIO 20
74 #define BRD_ECH 21
75 #define BRD_ECHMC 22
76 #define BRD_ECP 23
77 #define BRD_ECPE 24
78 #define BRD_ECPMC 25
79 #define BRD_ECHPCI 26
80 #define BRD_ECH64PCI 27
81 #define BRD_EASYIOPCI 28
82 #define BRD_ECPPCI 29
83
84 #define BRD_BRUMBY BRD_BRUMBY4
85
86 /*
87 * Define a configuration structure to hold the board configuration.
88 * Need to set this up in the code (for now) with the boards that are
89 * to be configured into the system. This is what needs to be modified
90 * when adding/removing/modifying boards. Each line entry in the
91 * stli_brdconf[] array is a board. Each line contains io/irq/memory
92 * ranges for that board (as well as what type of board it is).
93 * Some examples:
94 * { BRD_ECP, 0x2a0, 0, 0xcc000, 0, 0 },
95 * This line will configure an EasyConnection 8/64 at io address 2a0,
96 * and shared memory address of cc000. Multiple EasyConnection 8/64
97 * boards can share the same shared memory address space. No interrupt
98 * is required for this board type.
99 * Another example:
100 * { BRD_ECPE, 0x5000, 0, 0x80000000, 0, 0 },
101 * This line will configure an EasyConnection 8/64 EISA in slot 5 and
102 * shared memory address of 0x80000000 (2 GByte). Multiple
103 * EasyConnection 8/64 EISA boards can share the same shared memory
104 * address space. No interrupt is required for this board type.
105 * Another example:
106 * { BRD_ONBOARD, 0x240, 0, 0xd0000, 0, 0 },
107 * This line will configure an ONboard (ISA type) at io address 240,
108 * and shared memory address of d0000. Multiple ONboards can share
109 * the same shared memory address space. No interrupt required.
110 * Another example:
111 * { BRD_BRUMBY4, 0x360, 0, 0xc8000, 0, 0 },
112 * This line will configure a Brumby board (any number of ports!) at
113 * io address 360 and shared memory address of c8000. All Brumby boards
114 * configured into a system must have their own separate io and memory
115 * addresses. No interrupt is required.
116 * Another example:
117 * { BRD_STALLION, 0x330, 0, 0xd0000, 0, 0 },
118 * This line will configure an original Stallion board at io address 330
119 * and shared memory address d0000 (this would only be valid for a "V4.0"
120 * or Rev.O Stallion board). All Stallion boards configured into the
121 * system must have their own separate io and memory addresses. No
122 * interrupt is required.
123 */
124
125 typedef struct {
126 int brdtype;
127 int ioaddr1;
128 int ioaddr2;
129 unsigned long memaddr;
130 int irq;
131 int irqtype;
132 } stlconf_t;
133
134 static stlconf_t stli_brdconf[] = {
135 /*{ BRD_ECP, 0x2a0, 0, 0xcc000, 0, 0 },*/
136 };
137
138 static int stli_nrbrds = sizeof(stli_brdconf) / sizeof(stlconf_t);
139
140 /*
141 * There is some experimental EISA board detection code in this driver.
142 * By default it is disabled, but for those that want to try it out,
143 * then set the define below to be 1.
144 */
145 #define STLI_EISAPROBE 0
146
147 /*****************************************************************************/
148
149 /*
150 * Define some important driver characteristics. Device major numbers
151 * allocated as per Linux Device Registry.
152 */
153 #ifndef STL_SIOMEMMAJOR
154 #define STL_SIOMEMMAJOR 28
155 #endif
156 #ifndef STL_SERIALMAJOR
157 #define STL_SERIALMAJOR 24
158 #endif
159 #ifndef STL_CALLOUTMAJOR
160 #define STL_CALLOUTMAJOR 25
161 #endif
162
163 /*****************************************************************************/
164
165 /*
166 * Define our local driver identity first. Set up stuff to deal with
167 * all the local structures required by a serial tty driver.
168 */
169 static char *stli_drvtitle = "Stallion Intelligent Multiport Serial Driver";
170 static char *stli_drvname = "istallion";
171 static char *stli_drvversion = "5.6.0";
172 static char *stli_serialname = "ttyE";
173
174 static struct tty_driver *stli_serial;
175
176 /*
177 * We will need to allocate a temporary write buffer for chars that
178 * come direct from user space. The problem is that a copy from user
179 * space might cause a page fault (typically on a system that is
180 * swapping!). All ports will share one buffer - since if the system
181 * is already swapping a shared buffer won't make things any worse.
182 */
183 static char *stli_tmpwritebuf;
184 static DECLARE_MUTEX(stli_tmpwritesem);
185
186 #define STLI_TXBUFSIZE 4096
187
188 /*
189 * Use a fast local buffer for cooked characters. Typically a whole
190 * bunch of cooked characters come in for a port, 1 at a time. So we
191 * save those up into a local buffer, then write out the whole lot
192 * with a large memcpy. Just use 1 buffer for all ports, since its
193 * use it is only need for short periods of time by each port.
194 */
195 static char *stli_txcookbuf;
196 static int stli_txcooksize;
197 static int stli_txcookrealsize;
198 static struct tty_struct *stli_txcooktty;
199
200 /*
201 * Define a local default termios struct. All ports will be created
202 * with this termios initially. Basically all it defines is a raw port
203 * at 9600 baud, 8 data bits, no parity, 1 stop bit.
204 */
205 static struct termios stli_deftermios = {
206 .c_cflag = (B9600 | CS8 | CREAD | HUPCL | CLOCAL),
207 .c_cc = INIT_C_CC,
208 };
209
210 /*
211 * Define global stats structures. Not used often, and can be
212 * re-used for each stats call.
213 */
214 static comstats_t stli_comstats;
215 static combrd_t stli_brdstats;
216 static asystats_t stli_cdkstats;
217 static stlibrd_t stli_dummybrd;
218 static stliport_t stli_dummyport;
219
220 /*****************************************************************************/
221
222 static stlibrd_t *stli_brds[STL_MAXBRDS];
223
224 static int stli_shared;
225
226 /*
227 * Per board state flags. Used with the state field of the board struct.
228 * Not really much here... All we need to do is keep track of whether
229 * the board has been detected, and whether it is actually running a slave
230 * or not.
231 */
232 #define BST_FOUND 0x1
233 #define BST_STARTED 0x2
234
235 /*
236 * Define the set of port state flags. These are marked for internal
237 * state purposes only, usually to do with the state of communications
238 * with the slave. Most of them need to be updated atomically, so always
239 * use the bit setting operations (unless protected by cli/sti).
240 */
241 #define ST_INITIALIZING 1
242 #define ST_OPENING 2
243 #define ST_CLOSING 3
244 #define ST_CMDING 4
245 #define ST_TXBUSY 5
246 #define ST_RXING 6
247 #define ST_DOFLUSHRX 7
248 #define ST_DOFLUSHTX 8
249 #define ST_DOSIGS 9
250 #define ST_RXSTOP 10
251 #define ST_GETSIGS 11
252
253 /*
254 * Define an array of board names as printable strings. Handy for
255 * referencing boards when printing trace and stuff.
256 */
257 static char *stli_brdnames[] = {
258 "Unknown",
259 "Stallion",
260 "Brumby",
261 "ONboard-MC",
262 "ONboard",
263 "Brumby",
264 "Brumby",
265 "ONboard-EI",
266 (char *) NULL,
267 "ONboard",
268 "ONboard-MC",
269 "ONboard-MC",
270 (char *) NULL,
271 (char *) NULL,
272 (char *) NULL,
273 (char *) NULL,
274 (char *) NULL,
275 (char *) NULL,
276 (char *) NULL,
277 (char *) NULL,
278 "EasyIO",
279 "EC8/32-AT",
280 "EC8/32-MC",
281 "EC8/64-AT",
282 "EC8/64-EI",
283 "EC8/64-MC",
284 "EC8/32-PCI",
285 "EC8/64-PCI",
286 "EasyIO-PCI",
287 "EC/RA-PCI",
288 };
289
290 /*****************************************************************************/
291
292 #ifdef MODULE
293 /*
294 * Define some string labels for arguments passed from the module
295 * load line. These allow for easy board definitions, and easy
296 * modification of the io, memory and irq resoucres.
297 */
298
299 static char *board0[8];
300 static char *board1[8];
301 static char *board2[8];
302 static char *board3[8];
303
304 static char **stli_brdsp[] = {
305 (char **) &board0,
306 (char **) &board1,
307 (char **) &board2,
308 (char **) &board3
309 };
310
311 /*
312 * Define a set of common board names, and types. This is used to
313 * parse any module arguments.
314 */
315
316 typedef struct stlibrdtype {
317 char *name;
318 int type;
319 } stlibrdtype_t;
320
321 static stlibrdtype_t stli_brdstr[] = {
322 { "stallion", BRD_STALLION },
323 { "1", BRD_STALLION },
324 { "brumby", BRD_BRUMBY },
325 { "brumby4", BRD_BRUMBY },
326 { "brumby/4", BRD_BRUMBY },
327 { "brumby-4", BRD_BRUMBY },
328 { "brumby8", BRD_BRUMBY },
329 { "brumby/8", BRD_BRUMBY },
330 { "brumby-8", BRD_BRUMBY },
331 { "brumby16", BRD_BRUMBY },
332 { "brumby/16", BRD_BRUMBY },
333 { "brumby-16", BRD_BRUMBY },
334 { "2", BRD_BRUMBY },
335 { "onboard2", BRD_ONBOARD2 },
336 { "onboard-2", BRD_ONBOARD2 },
337 { "onboard/2", BRD_ONBOARD2 },
338 { "onboard-mc", BRD_ONBOARD2 },
339 { "onboard/mc", BRD_ONBOARD2 },
340 { "onboard-mca", BRD_ONBOARD2 },
341 { "onboard/mca", BRD_ONBOARD2 },
342 { "3", BRD_ONBOARD2 },
343 { "onboard", BRD_ONBOARD },
344 { "onboardat", BRD_ONBOARD },
345 { "4", BRD_ONBOARD },
346 { "onboarde", BRD_ONBOARDE },
347 { "onboard-e", BRD_ONBOARDE },
348 { "onboard/e", BRD_ONBOARDE },
349 { "onboard-ei", BRD_ONBOARDE },
350 { "onboard/ei", BRD_ONBOARDE },
351 { "7", BRD_ONBOARDE },
352 { "ecp", BRD_ECP },
353 { "ecpat", BRD_ECP },
354 { "ec8/64", BRD_ECP },
355 { "ec8/64-at", BRD_ECP },
356 { "ec8/64-isa", BRD_ECP },
357 { "23", BRD_ECP },
358 { "ecpe", BRD_ECPE },
359 { "ecpei", BRD_ECPE },
360 { "ec8/64-e", BRD_ECPE },
361 { "ec8/64-ei", BRD_ECPE },
362 { "24", BRD_ECPE },
363 { "ecpmc", BRD_ECPMC },
364 { "ec8/64-mc", BRD_ECPMC },
365 { "ec8/64-mca", BRD_ECPMC },
366 { "25", BRD_ECPMC },
367 { "ecppci", BRD_ECPPCI },
368 { "ec/ra", BRD_ECPPCI },
369 { "ec/ra-pc", BRD_ECPPCI },
370 { "ec/ra-pci", BRD_ECPPCI },
371 { "29", BRD_ECPPCI },
372 };
373
374 /*
375 * Define the module agruments.
376 */
377 MODULE_AUTHOR("Greg Ungerer");
378 MODULE_DESCRIPTION("Stallion Intelligent Multiport Serial Driver");
379 MODULE_LICENSE("GPL");
380
381
382 MODULE_PARM(board0, "1-3s");
383 MODULE_PARM_DESC(board0, "Board 0 config -> name[,ioaddr[,memaddr]");
384 MODULE_PARM(board1, "1-3s");
385 MODULE_PARM_DESC(board1, "Board 1 config -> name[,ioaddr[,memaddr]");
386 MODULE_PARM(board2, "1-3s");
387 MODULE_PARM_DESC(board2, "Board 2 config -> name[,ioaddr[,memaddr]");
388 MODULE_PARM(board3, "1-3s");
389 MODULE_PARM_DESC(board3, "Board 3 config -> name[,ioaddr[,memaddr]");
390
391 #endif
392
393 /*
394 * Set up a default memory address table for EISA board probing.
395 * The default addresses are all bellow 1Mbyte, which has to be the
396 * case anyway. They should be safe, since we only read values from
397 * them, and interrupts are disabled while we do it. If the higher
398 * memory support is compiled in then we also try probing around
399 * the 1Gb, 2Gb and 3Gb areas as well...
400 */
401 static unsigned long stli_eisamemprobeaddrs[] = {
402 0xc0000, 0xd0000, 0xe0000, 0xf0000,
403 0x80000000, 0x80010000, 0x80020000, 0x80030000,
404 0x40000000, 0x40010000, 0x40020000, 0x40030000,
405 0xc0000000, 0xc0010000, 0xc0020000, 0xc0030000,
406 0xff000000, 0xff010000, 0xff020000, 0xff030000,
407 };
408
409 static int stli_eisamempsize = sizeof(stli_eisamemprobeaddrs) / sizeof(unsigned long);
410 int stli_eisaprobe = STLI_EISAPROBE;
411
412 /*
413 * Define the Stallion PCI vendor and device IDs.
414 */
415 #ifdef CONFIG_PCI
416 #ifndef PCI_VENDOR_ID_STALLION
417 #define PCI_VENDOR_ID_STALLION 0x124d
418 #endif
419 #ifndef PCI_DEVICE_ID_ECRA
420 #define PCI_DEVICE_ID_ECRA 0x0004
421 #endif
422
423 static struct pci_device_id istallion_pci_tbl[] = {
424 { PCI_VENDOR_ID_STALLION, PCI_DEVICE_ID_ECRA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
425 { 0 }
426 };
427 MODULE_DEVICE_TABLE(pci, istallion_pci_tbl);
428
429 #endif /* CONFIG_PCI */
430
431 /*****************************************************************************/
432
433 /*
434 * Hardware configuration info for ECP boards. These defines apply
435 * to the directly accessible io ports of the ECP. There is a set of
436 * defines for each ECP board type, ISA, EISA, MCA and PCI.
437 */
438 #define ECP_IOSIZE 4
439
440 #define ECP_MEMSIZE (128 * 1024)
441 #define ECP_PCIMEMSIZE (256 * 1024)
442
443 #define ECP_ATPAGESIZE (4 * 1024)
444 #define ECP_MCPAGESIZE (4 * 1024)
445 #define ECP_EIPAGESIZE (64 * 1024)
446 #define ECP_PCIPAGESIZE (64 * 1024)
447
448 #define STL_EISAID 0x8c4e
449
450 /*
451 * Important defines for the ISA class of ECP board.
452 */
453 #define ECP_ATIREG 0
454 #define ECP_ATCONFR 1
455 #define ECP_ATMEMAR 2
456 #define ECP_ATMEMPR 3
457 #define ECP_ATSTOP 0x1
458 #define ECP_ATINTENAB 0x10
459 #define ECP_ATENABLE 0x20
460 #define ECP_ATDISABLE 0x00
461 #define ECP_ATADDRMASK 0x3f000
462 #define ECP_ATADDRSHFT 12
463
464 /*
465 * Important defines for the EISA class of ECP board.
466 */
467 #define ECP_EIIREG 0
468 #define ECP_EIMEMARL 1
469 #define ECP_EICONFR 2
470 #define ECP_EIMEMARH 3
471 #define ECP_EIENABLE 0x1
472 #define ECP_EIDISABLE 0x0
473 #define ECP_EISTOP 0x4
474 #define ECP_EIEDGE 0x00
475 #define ECP_EILEVEL 0x80
476 #define ECP_EIADDRMASKL 0x00ff0000
477 #define ECP_EIADDRSHFTL 16
478 #define ECP_EIADDRMASKH 0xff000000
479 #define ECP_EIADDRSHFTH 24
480 #define ECP_EIBRDENAB 0xc84
481
482 #define ECP_EISAID 0x4
483
484 /*
485 * Important defines for the Micro-channel class of ECP board.
486 * (It has a lot in common with the ISA boards.)
487 */
488 #define ECP_MCIREG 0
489 #define ECP_MCCONFR 1
490 #define ECP_MCSTOP 0x20
491 #define ECP_MCENABLE 0x80
492 #define ECP_MCDISABLE 0x00
493
494 /*
495 * Important defines for the PCI class of ECP board.
496 * (It has a lot in common with the other ECP boards.)
497 */
498 #define ECP_PCIIREG 0
499 #define ECP_PCICONFR 1
500 #define ECP_PCISTOP 0x01
501
502 /*
503 * Hardware configuration info for ONboard and Brumby boards. These
504 * defines apply to the directly accessible io ports of these boards.
505 */
506 #define ONB_IOSIZE 16
507 #define ONB_MEMSIZE (64 * 1024)
508 #define ONB_ATPAGESIZE (64 * 1024)
509 #define ONB_MCPAGESIZE (64 * 1024)
510 #define ONB_EIMEMSIZE (128 * 1024)
511 #define ONB_EIPAGESIZE (64 * 1024)
512
513 /*
514 * Important defines for the ISA class of ONboard board.
515 */
516 #define ONB_ATIREG 0
517 #define ONB_ATMEMAR 1
518 #define ONB_ATCONFR 2
519 #define ONB_ATSTOP 0x4
520 #define ONB_ATENABLE 0x01
521 #define ONB_ATDISABLE 0x00
522 #define ONB_ATADDRMASK 0xff0000
523 #define ONB_ATADDRSHFT 16
524
525 #define ONB_MEMENABLO 0
526 #define ONB_MEMENABHI 0x02
527
528 /*
529 * Important defines for the EISA class of ONboard board.
530 */
531 #define ONB_EIIREG 0
532 #define ONB_EIMEMARL 1
533 #define ONB_EICONFR 2
534 #define ONB_EIMEMARH 3
535 #define ONB_EIENABLE 0x1
536 #define ONB_EIDISABLE 0x0
537 #define ONB_EISTOP 0x4
538 #define ONB_EIEDGE 0x00
539 #define ONB_EILEVEL 0x80
540 #define ONB_EIADDRMASKL 0x00ff0000
541 #define ONB_EIADDRSHFTL 16
542 #define ONB_EIADDRMASKH 0xff000000
543 #define ONB_EIADDRSHFTH 24
544 #define ONB_EIBRDENAB 0xc84
545
546 #define ONB_EISAID 0x1
547
548 /*
549 * Important defines for the Brumby boards. They are pretty simple,
550 * there is not much that is programmably configurable.
551 */
552 #define BBY_IOSIZE 16
553 #define BBY_MEMSIZE (64 * 1024)
554 #define BBY_PAGESIZE (16 * 1024)
555
556 #define BBY_ATIREG 0
557 #define BBY_ATCONFR 1
558 #define BBY_ATSTOP 0x4
559
560 /*
561 * Important defines for the Stallion boards. They are pretty simple,
562 * there is not much that is programmably configurable.
563 */
564 #define STAL_IOSIZE 16
565 #define STAL_MEMSIZE (64 * 1024)
566 #define STAL_PAGESIZE (64 * 1024)
567
568 /*
569 * Define the set of status register values for EasyConnection panels.
570 * The signature will return with the status value for each panel. From
571 * this we can determine what is attached to the board - before we have
572 * actually down loaded any code to it.
573 */
574 #define ECH_PNLSTATUS 2
575 #define ECH_PNL16PORT 0x20
576 #define ECH_PNLIDMASK 0x07
577 #define ECH_PNLXPID 0x40
578 #define ECH_PNLINTRPEND 0x80
579
580 /*
581 * Define some macros to do things to the board. Even those these boards
582 * are somewhat related there is often significantly different ways of
583 * doing some operation on it (like enable, paging, reset, etc). So each
584 * board class has a set of functions which do the commonly required
585 * operations. The macros below basically just call these functions,
586 * generally checking for a NULL function - which means that the board
587 * needs nothing done to it to achieve this operation!
588 */
589 #define EBRDINIT(brdp) \
590 if (brdp->init != NULL) \
591 (* brdp->init)(brdp)
592
593 #define EBRDENABLE(brdp) \
594 if (brdp->enable != NULL) \
595 (* brdp->enable)(brdp);
596
597 #define EBRDDISABLE(brdp) \
598 if (brdp->disable != NULL) \
599 (* brdp->disable)(brdp);
600
601 #define EBRDINTR(brdp) \
602 if (brdp->intr != NULL) \
603 (* brdp->intr)(brdp);
604
605 #define EBRDRESET(brdp) \
606 if (brdp->reset != NULL) \
607 (* brdp->reset)(brdp);
608
609 #define EBRDGETMEMPTR(brdp,offset) \
610 (* brdp->getmemptr)(brdp, offset, __LINE__)
611
612 /*
613 * Define the maximal baud rate, and the default baud base for ports.
614 */
615 #define STL_MAXBAUD 460800
616 #define STL_BAUDBASE 115200
617 #define STL_CLOSEDELAY (5 * HZ / 10)
618
619 /*****************************************************************************/
620
621 /*
622 * Define macros to extract a brd or port number from a minor number.
623 */
624 #define MINOR2BRD(min) (((min) & 0xc0) >> 6)
625 #define MINOR2PORT(min) ((min) & 0x3f)
626
627 /*
628 * Define a baud rate table that converts termios baud rate selector
629 * into the actual baud rate value. All baud rate calculations are based
630 * on the actual baud rate required.
631 */
632 static unsigned int stli_baudrates[] = {
633 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
634 9600, 19200, 38400, 57600, 115200, 230400, 460800, 921600
635 };
636
637 /*****************************************************************************/
638
639 /*
640 * Define some handy local macros...
641 */
642 #undef MIN
643 #define MIN(a,b) (((a) <= (b)) ? (a) : (b))
644
645 #undef TOLOWER
646 #define TOLOWER(x) ((((x) >= 'A') && ((x) <= 'Z')) ? ((x) + 0x20) : (x))
647
648 /*****************************************************************************/
649
650 /*
651 * Prototype all functions in this driver!
652 */
653
654 #ifdef MODULE
655 static void stli_argbrds(void);
656 static int stli_parsebrd(stlconf_t *confp, char **argp);
657
658 static unsigned long stli_atol(char *str);
659 #endif
660
661 int stli_init(void);
662 static int stli_open(struct tty_struct *tty, struct file *filp);
663 static void stli_close(struct tty_struct *tty, struct file *filp);
664 static int stli_write(struct tty_struct *tty, const unsigned char *buf, int count);
665 static void stli_putchar(struct tty_struct *tty, unsigned char ch);
666 static void stli_flushchars(struct tty_struct *tty);
667 static int stli_writeroom(struct tty_struct *tty);
668 static int stli_charsinbuffer(struct tty_struct *tty);
669 static int stli_ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg);
670 static void stli_settermios(struct tty_struct *tty, struct termios *old);
671 static void stli_throttle(struct tty_struct *tty);
672 static void stli_unthrottle(struct tty_struct *tty);
673 static void stli_stop(struct tty_struct *tty);
674 static void stli_start(struct tty_struct *tty);
675 static void stli_flushbuffer(struct tty_struct *tty);
676 static void stli_breakctl(struct tty_struct *tty, int state);
677 static void stli_waituntilsent(struct tty_struct *tty, int timeout);
678 static void stli_sendxchar(struct tty_struct *tty, char ch);
679 static void stli_hangup(struct tty_struct *tty);
680 static int stli_portinfo(stlibrd_t *brdp, stliport_t *portp, int portnr, char *pos);
681
682 static int stli_brdinit(stlibrd_t *brdp);
683 static int stli_startbrd(stlibrd_t *brdp);
684 static ssize_t stli_memread(struct file *fp, char __user *buf, size_t count, loff_t *offp);
685 static ssize_t stli_memwrite(struct file *fp, const char __user *buf, size_t count, loff_t *offp);
686 static int stli_memioctl(struct inode *ip, struct file *fp, unsigned int cmd, unsigned long arg);
687 static void stli_brdpoll(stlibrd_t *brdp, volatile cdkhdr_t *hdrp);
688 static void stli_poll(unsigned long arg);
689 static int stli_hostcmd(stlibrd_t *brdp, stliport_t *portp);
690 static int stli_initopen(stlibrd_t *brdp, stliport_t *portp);
691 static int stli_rawopen(stlibrd_t *brdp, stliport_t *portp, unsigned long arg, int wait);
692 static int stli_rawclose(stlibrd_t *brdp, stliport_t *portp, unsigned long arg, int wait);
693 static int stli_waitcarrier(stlibrd_t *brdp, stliport_t *portp, struct file *filp);
694 static void stli_dohangup(void *arg);
695 static int stli_setport(stliport_t *portp);
696 static int stli_cmdwait(stlibrd_t *brdp, stliport_t *portp, unsigned long cmd, void *arg, int size, int copyback);
697 static void stli_sendcmd(stlibrd_t *brdp, stliport_t *portp, unsigned long cmd, void *arg, int size, int copyback);
698 static void stli_dodelaycmd(stliport_t *portp, volatile cdkctrl_t *cp);
699 static void stli_mkasyport(stliport_t *portp, asyport_t *pp, struct termios *tiosp);
700 static void stli_mkasysigs(asysigs_t *sp, int dtr, int rts);
701 static long stli_mktiocm(unsigned long sigvalue);
702 static void stli_read(stlibrd_t *brdp, stliport_t *portp);
703 static int stli_getserial(stliport_t *portp, struct serial_struct __user *sp);
704 static int stli_setserial(stliport_t *portp, struct serial_struct __user *sp);
705 static int stli_getbrdstats(combrd_t __user *bp);
706 static int stli_getportstats(stliport_t *portp, comstats_t __user *cp);
707 static int stli_portcmdstats(stliport_t *portp);
708 static int stli_clrportstats(stliport_t *portp, comstats_t __user *cp);
709 static int stli_getportstruct(stliport_t __user *arg);
710 static int stli_getbrdstruct(stlibrd_t __user *arg);
711 static void *stli_memalloc(int len);
712 static stlibrd_t *stli_allocbrd(void);
713
714 static void stli_ecpinit(stlibrd_t *brdp);
715 static void stli_ecpenable(stlibrd_t *brdp);
716 static void stli_ecpdisable(stlibrd_t *brdp);
717 static char *stli_ecpgetmemptr(stlibrd_t *brdp, unsigned long offset, int line);
718 static void stli_ecpreset(stlibrd_t *brdp);
719 static void stli_ecpintr(stlibrd_t *brdp);
720 static void stli_ecpeiinit(stlibrd_t *brdp);
721 static void stli_ecpeienable(stlibrd_t *brdp);
722 static void stli_ecpeidisable(stlibrd_t *brdp);
723 static char *stli_ecpeigetmemptr(stlibrd_t *brdp, unsigned long offset, int line);
724 static void stli_ecpeireset(stlibrd_t *brdp);
725 static void stli_ecpmcenable(stlibrd_t *brdp);
726 static void stli_ecpmcdisable(stlibrd_t *brdp);
727 static char *stli_ecpmcgetmemptr(stlibrd_t *brdp, unsigned long offset, int line);
728 static void stli_ecpmcreset(stlibrd_t *brdp);
729 static void stli_ecppciinit(stlibrd_t *brdp);
730 static char *stli_ecppcigetmemptr(stlibrd_t *brdp, unsigned long offset, int line);
731 static void stli_ecppcireset(stlibrd_t *brdp);
732
733 static void stli_onbinit(stlibrd_t *brdp);
734 static void stli_onbenable(stlibrd_t *brdp);
735 static void stli_onbdisable(stlibrd_t *brdp);
736 static char *stli_onbgetmemptr(stlibrd_t *brdp, unsigned long offset, int line);
737 static void stli_onbreset(stlibrd_t *brdp);
738 static void stli_onbeinit(stlibrd_t *brdp);
739 static void stli_onbeenable(stlibrd_t *brdp);
740 static void stli_onbedisable(stlibrd_t *brdp);
741 static char *stli_onbegetmemptr(stlibrd_t *brdp, unsigned long offset, int line);
742 static void stli_onbereset(stlibrd_t *brdp);
743 static void stli_bbyinit(stlibrd_t *brdp);
744 static char *stli_bbygetmemptr(stlibrd_t *brdp, unsigned long offset, int line);
745 static void stli_bbyreset(stlibrd_t *brdp);
746 static void stli_stalinit(stlibrd_t *brdp);
747 static char *stli_stalgetmemptr(stlibrd_t *brdp, unsigned long offset, int line);
748 static void stli_stalreset(stlibrd_t *brdp);
749
750 static stliport_t *stli_getport(int brdnr, int panelnr, int portnr);
751
752 static int stli_initecp(stlibrd_t *brdp);
753 static int stli_initonb(stlibrd_t *brdp);
754 static int stli_eisamemprobe(stlibrd_t *brdp);
755 static int stli_initports(stlibrd_t *brdp);
756
757 #ifdef CONFIG_PCI
758 static int stli_initpcibrd(int brdtype, struct pci_dev *devp);
759 #endif
760
761 /*****************************************************************************/
762
763 /*
764 * Define the driver info for a user level shared memory device. This
765 * device will work sort of like the /dev/kmem device - except that it
766 * will give access to the shared memory on the Stallion intelligent
767 * board. This is also a very useful debugging tool.
768 */
769 static struct file_operations stli_fsiomem = {
770 .owner = THIS_MODULE,
771 .read = stli_memread,
772 .write = stli_memwrite,
773 .ioctl = stli_memioctl,
774 };
775
776 /*****************************************************************************/
777
778 /*
779 * Define a timer_list entry for our poll routine. The slave board
780 * is polled every so often to see if anything needs doing. This is
781 * much cheaper on host cpu than using interrupts. It turns out to
782 * not increase character latency by much either...
783 */
784 static struct timer_list stli_timerlist = TIMER_INITIALIZER(stli_poll, 0, 0);
785
786 static int stli_timeron;
787
788 /*
789 * Define the calculation for the timeout routine.
790 */
791 #define STLI_TIMEOUT (jiffies + 1)
792
793 /*****************************************************************************/
794
795 static struct class_simple *istallion_class;
796
797 #ifdef MODULE
798
799 /*
800 * Loadable module initialization stuff.
801 */
802
803 static int __init istallion_module_init(void)
804 {
805 unsigned long flags;
806
807 #ifdef DEBUG
808 printk("init_module()\n");
809 #endif
810
811 save_flags(flags);
812 cli();
813 stli_init();
814 restore_flags(flags);
815
816 return(0);
817 }
818
819 /*****************************************************************************/
820
821 static void __exit istallion_module_exit(void)
822 {
823 stlibrd_t *brdp;
824 stliport_t *portp;
825 unsigned long flags;
826 int i, j;
827
828 #ifdef DEBUG
829 printk("cleanup_module()\n");
830 #endif
831
832 printk(KERN_INFO "Unloading %s: version %s\n", stli_drvtitle,
833 stli_drvversion);
834
835 save_flags(flags);
836 cli();
837
838 /*
839 * Free up all allocated resources used by the ports. This includes
840 * memory and interrupts.
841 */
842 if (stli_timeron) {
843 stli_timeron = 0;
844 del_timer(&stli_timerlist);
845 }
846
847 i = tty_unregister_driver(stli_serial);
848 if (i) {
849 printk("STALLION: failed to un-register tty driver, "
850 "errno=%d\n", -i);
851 restore_flags(flags);
852 return;
853 }
854 put_tty_driver(stli_serial);
855 for (i = 0; i < 4; i++) {
856 devfs_remove("staliomem/%d", i);
857 class_simple_device_remove(MKDEV(STL_SIOMEMMAJOR, i));
858 }
859 devfs_remove("staliomem");
860 class_simple_destroy(istallion_class);
861 if ((i = unregister_chrdev(STL_SIOMEMMAJOR, "staliomem")))
862 printk("STALLION: failed to un-register serial memory device, "
863 "errno=%d\n", -i);
864 if (stli_tmpwritebuf != (char *) NULL)
865 kfree(stli_tmpwritebuf);
866 if (stli_txcookbuf != (char *) NULL)
867 kfree(stli_txcookbuf);
868
869 for (i = 0; (i < stli_nrbrds); i++) {
870 if ((brdp = stli_brds[i]) == (stlibrd_t *) NULL)
871 continue;
872 for (j = 0; (j < STL_MAXPORTS); j++) {
873 portp = brdp->ports[j];
874 if (portp != (stliport_t *) NULL) {
875 if (portp->tty != (struct tty_struct *) NULL)
876 tty_hangup(portp->tty);
877 kfree(portp);
878 }
879 }
880
881 iounmap(brdp->membase);
882 if (brdp->iosize > 0)
883 release_region(brdp->iobase, brdp->iosize);
884 kfree(brdp);
885 stli_brds[i] = (stlibrd_t *) NULL;
886 }
887
888 restore_flags(flags);
889 }
890
891 module_init(istallion_module_init);
892 module_exit(istallion_module_exit);
893
894 /*****************************************************************************/
895
896 /*
897 * Check for any arguments passed in on the module load command line.
898 */
899
900 static void stli_argbrds(void)
901 {
902 stlconf_t conf;
903 stlibrd_t *brdp;
904 int nrargs, i;
905
906 #ifdef DEBUG
907 printk("stli_argbrds()\n");
908 #endif
909
910 nrargs = sizeof(stli_brdsp) / sizeof(char **);
911
912 for (i = stli_nrbrds; (i < nrargs); i++) {
913 memset(&conf, 0, sizeof(conf));
914 if (stli_parsebrd(&conf, stli_brdsp[i]) == 0)
915 continue;
916 if ((brdp = stli_allocbrd()) == (stlibrd_t *) NULL)
917 continue;
918 stli_nrbrds = i + 1;
919 brdp->brdnr = i;
920 brdp->brdtype = conf.brdtype;
921 brdp->iobase = conf.ioaddr1;
922 brdp->memaddr = conf.memaddr;
923 stli_brdinit(brdp);
924 }
925 }
926
927 /*****************************************************************************/
928
929 /*
930 * Convert an ascii string number into an unsigned long.
931 */
932
933 static unsigned long stli_atol(char *str)
934 {
935 unsigned long val;
936 int base, c;
937 char *sp;
938
939 val = 0;
940 sp = str;
941 if ((*sp == '0') && (*(sp+1) == 'x')) {
942 base = 16;
943 sp += 2;
944 } else if (*sp == '0') {
945 base = 8;
946 sp++;
947 } else {
948 base = 10;
949 }
950
951 for (; (*sp != 0); sp++) {
952 c = (*sp > '9') ? (TOLOWER(*sp) - 'a' + 10) : (*sp - '0');
953 if ((c < 0) || (c >= base)) {
954 printk("STALLION: invalid argument %s\n", str);
955 val = 0;
956 break;
957 }
958 val = (val * base) + c;
959 }
960 return(val);
961 }
962
963 /*****************************************************************************/
964
965 /*
966 * Parse the supplied argument string, into the board conf struct.
967 */
968
969 static int stli_parsebrd(stlconf_t *confp, char **argp)
970 {
971 char *sp;
972 int nrbrdnames, i;
973
974 #ifdef DEBUG
975 printk("stli_parsebrd(confp=%x,argp=%x)\n", (int) confp, (int) argp);
976 #endif
977
978 if ((argp[0] == (char *) NULL) || (*argp[0] == 0))
979 return(0);
980
981 for (sp = argp[0], i = 0; ((*sp != 0) && (i < 25)); sp++, i++)
982 *sp = TOLOWER(*sp);
983
984 nrbrdnames = sizeof(stli_brdstr) / sizeof(stlibrdtype_t);
985 for (i = 0; (i < nrbrdnames); i++) {
986 if (strcmp(stli_brdstr[i].name, argp[0]) == 0)
987 break;
988 }
989 if (i >= nrbrdnames) {
990 printk("STALLION: unknown board name, %s?\n", argp[0]);
991 return(0);
992 }
993
994 confp->brdtype = stli_brdstr[i].type;
995 if ((argp[1] != (char *) NULL) && (*argp[1] != 0))
996 confp->ioaddr1 = stli_atol(argp[1]);
997 if ((argp[2] != (char *) NULL) && (*argp[2] != 0))
998 confp->memaddr = stli_atol(argp[2]);
999 return(1);
1000 }
1001
1002 #endif
1003
1004 /*****************************************************************************/
1005
1006 /*
1007 * Local driver kernel malloc routine.
1008 */
1009
1010 static void *stli_memalloc(int len)
1011 {
1012 return((void *) kmalloc(len, GFP_KERNEL));
1013 }
1014
1015 /*****************************************************************************/
1016
1017 static int stli_open(struct tty_struct *tty, struct file *filp)
1018 {
1019 stlibrd_t *brdp;
1020 stliport_t *portp;
1021 unsigned int minordev;
1022 int brdnr, portnr, rc;
1023
1024 #ifdef DEBUG
1025 printk("stli_open(tty=%x,filp=%x): device=%s\n", (int) tty,
1026 (int) filp, tty->name);
1027 #endif
1028
1029 minordev = tty->index;
1030 brdnr = MINOR2BRD(minordev);
1031 if (brdnr >= stli_nrbrds)
1032 return(-ENODEV);
1033 brdp = stli_brds[brdnr];
1034 if (brdp == (stlibrd_t *) NULL)
1035 return(-ENODEV);
1036 if ((brdp->state & BST_STARTED) == 0)
1037 return(-ENODEV);
1038 portnr = MINOR2PORT(minordev);
1039 if ((portnr < 0) || (portnr > brdp->nrports))
1040 return(-ENODEV);
1041
1042 portp = brdp->ports[portnr];
1043 if (portp == (stliport_t *) NULL)
1044 return(-ENODEV);
1045 if (portp->devnr < 1)
1046 return(-ENODEV);
1047
1048
1049 /*
1050 * Check if this port is in the middle of closing. If so then wait
1051 * until it is closed then return error status based on flag settings.
1052 * The sleep here does not need interrupt protection since the wakeup
1053 * for it is done with the same context.
1054 */
1055 if (portp->flags & ASYNC_CLOSING) {
1056 interruptible_sleep_on(&portp->close_wait);
1057 if (portp->flags & ASYNC_HUP_NOTIFY)
1058 return(-EAGAIN);
1059 return(-ERESTARTSYS);
1060 }
1061
1062 /*
1063 * On the first open of the device setup the port hardware, and
1064 * initialize the per port data structure. Since initializing the port
1065 * requires several commands to the board we will need to wait for any
1066 * other open that is already initializing the port.
1067 */
1068 portp->tty = tty;
1069 tty->driver_data = portp;
1070 portp->refcount++;
1071
1072 wait_event_interruptible(portp->raw_wait,
1073 !test_bit(ST_INITIALIZING, &portp->state));
1074 if (signal_pending(current))
1075 return(-ERESTARTSYS);
1076
1077 if ((portp->flags & ASYNC_INITIALIZED) == 0) {
1078 set_bit(ST_INITIALIZING, &portp->state);
1079 if ((rc = stli_initopen(brdp, portp)) >= 0) {
1080 portp->flags |= ASYNC_INITIALIZED;
1081 clear_bit(TTY_IO_ERROR, &tty->flags);
1082 }
1083 clear_bit(ST_INITIALIZING, &portp->state);
1084 wake_up_interruptible(&portp->raw_wait);
1085 if (rc < 0)
1086 return(rc);
1087 }
1088
1089 /*
1090 * Check if this port is in the middle of closing. If so then wait
1091 * until it is closed then return error status, based on flag settings.
1092 * The sleep here does not need interrupt protection since the wakeup
1093 * for it is done with the same context.
1094 */
1095 if (portp->flags & ASYNC_CLOSING) {
1096 interruptible_sleep_on(&portp->close_wait);
1097 if (portp->flags & ASYNC_HUP_NOTIFY)
1098 return(-EAGAIN);
1099 return(-ERESTARTSYS);
1100 }
1101
1102 /*
1103 * Based on type of open being done check if it can overlap with any
1104 * previous opens still in effect. If we are a normal serial device
1105 * then also we might have to wait for carrier.
1106 */
1107 if (!(filp->f_flags & O_NONBLOCK)) {
1108 if ((rc = stli_waitcarrier(brdp, portp, filp)) != 0)
1109 return(rc);
1110 }
1111 portp->flags |= ASYNC_NORMAL_ACTIVE;
1112 return(0);
1113 }
1114
1115 /*****************************************************************************/
1116
1117 static void stli_close(struct tty_struct *tty, struct file *filp)
1118 {
1119 stlibrd_t *brdp;
1120 stliport_t *portp;
1121 unsigned long flags;
1122
1123 #ifdef DEBUG
1124 printk("stli_close(tty=%x,filp=%x)\n", (int) tty, (int) filp);
1125 #endif
1126
1127 portp = tty->driver_data;
1128 if (portp == (stliport_t *) NULL)
1129 return;
1130
1131 save_flags(flags);
1132 cli();
1133 if (tty_hung_up_p(filp)) {
1134 restore_flags(flags);
1135 return;
1136 }
1137 if ((tty->count == 1) && (portp->refcount != 1))
1138 portp->refcount = 1;
1139 if (portp->refcount-- > 1) {
1140 restore_flags(flags);
1141 return;
1142 }
1143
1144 portp->flags |= ASYNC_CLOSING;
1145
1146 /*
1147 * May want to wait for data to drain before closing. The BUSY flag
1148 * keeps track of whether we are still transmitting or not. It is
1149 * updated by messages from the slave - indicating when all chars
1150 * really have drained.
1151 */
1152 if (tty == stli_txcooktty)
1153 stli_flushchars(tty);
1154 tty->closing = 1;
1155 if (portp->closing_wait != ASYNC_CLOSING_WAIT_NONE)
1156 tty_wait_until_sent(tty, portp->closing_wait);
1157
1158 portp->flags &= ~ASYNC_INITIALIZED;
1159 brdp = stli_brds[portp->brdnr];
1160 stli_rawclose(brdp, portp, 0, 0);
1161 if (tty->termios->c_cflag & HUPCL) {
1162 stli_mkasysigs(&portp->asig, 0, 0);
1163 if (test_bit(ST_CMDING, &portp->state))
1164 set_bit(ST_DOSIGS, &portp->state);
1165 else
1166 stli_sendcmd(brdp, portp, A_SETSIGNALS, &portp->asig,
1167 sizeof(asysigs_t), 0);
1168 }
1169 clear_bit(ST_TXBUSY, &portp->state);
1170 clear_bit(ST_RXSTOP, &portp->state);
1171 set_bit(TTY_IO_ERROR, &tty->flags);
1172 if (tty->ldisc.flush_buffer)
1173 (tty->ldisc.flush_buffer)(tty);
1174 set_bit(ST_DOFLUSHRX, &portp->state);
1175 stli_flushbuffer(tty);
1176
1177 tty->closing = 0;
1178 portp->tty = (struct tty_struct *) NULL;
1179
1180 if (portp->openwaitcnt) {
1181 if (portp->close_delay)
1182 msleep_interruptible(jiffies_to_msecs(portp->close_delay));
1183 wake_up_interruptible(&portp->open_wait);
1184 }
1185
1186 portp->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING);
1187 wake_up_interruptible(&portp->close_wait);
1188 restore_flags(flags);
1189 }
1190
1191 /*****************************************************************************/
1192
1193 /*
1194 * Carry out first open operations on a port. This involves a number of
1195 * commands to be sent to the slave. We need to open the port, set the
1196 * notification events, set the initial port settings, get and set the
1197 * initial signal values. We sleep and wait in between each one. But
1198 * this still all happens pretty quickly.
1199 */
1200
1201 static int stli_initopen(stlibrd_t *brdp, stliport_t *portp)
1202 {
1203 struct tty_struct *tty;
1204 asynotify_t nt;
1205 asyport_t aport;
1206 int rc;
1207
1208 #ifdef DEBUG
1209 printk("stli_initopen(brdp=%x,portp=%x)\n", (int) brdp, (int) portp);
1210 #endif
1211
1212 if ((rc = stli_rawopen(brdp, portp, 0, 1)) < 0)
1213 return(rc);
1214
1215 memset(&nt, 0, sizeof(asynotify_t));
1216 nt.data = (DT_TXLOW | DT_TXEMPTY | DT_RXBUSY | DT_RXBREAK);
1217 nt.signal = SG_DCD;
1218 if ((rc = stli_cmdwait(brdp, portp, A_SETNOTIFY, &nt,
1219 sizeof(asynotify_t), 0)) < 0)
1220 return(rc);
1221
1222 tty = portp->tty;
1223 if (tty == (struct tty_struct *) NULL)
1224 return(-ENODEV);
1225 stli_mkasyport(portp, &aport, tty->termios);
1226 if ((rc = stli_cmdwait(brdp, portp, A_SETPORT, &aport,
1227 sizeof(asyport_t), 0)) < 0)
1228 return(rc);
1229
1230 set_bit(ST_GETSIGS, &portp->state);
1231 if ((rc = stli_cmdwait(brdp, portp, A_GETSIGNALS, &portp->asig,
1232 sizeof(asysigs_t), 1)) < 0)
1233 return(rc);
1234 if (test_and_clear_bit(ST_GETSIGS, &portp->state))
1235 portp->sigs = stli_mktiocm(portp->asig.sigvalue);
1236 stli_mkasysigs(&portp->asig, 1, 1);
1237 if ((rc = stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
1238 sizeof(asysigs_t), 0)) < 0)
1239 return(rc);
1240
1241 return(0);
1242 }
1243
1244 /*****************************************************************************/
1245
1246 /*
1247 * Send an open message to the slave. This will sleep waiting for the
1248 * acknowledgement, so must have user context. We need to co-ordinate
1249 * with close events here, since we don't want open and close events
1250 * to overlap.
1251 */
1252
1253 static int stli_rawopen(stlibrd_t *brdp, stliport_t *portp, unsigned long arg, int wait)
1254 {
1255 volatile cdkhdr_t *hdrp;
1256 volatile cdkctrl_t *cp;
1257 volatile unsigned char *bits;
1258 unsigned long flags;
1259 int rc;
1260
1261 #ifdef DEBUG
1262 printk("stli_rawopen(brdp=%x,portp=%x,arg=%x,wait=%d)\n",
1263 (int) brdp, (int) portp, (int) arg, wait);
1264 #endif
1265
1266 /*
1267 * Send a message to the slave to open this port.
1268 */
1269 save_flags(flags);
1270 cli();
1271
1272 /*
1273 * Slave is already closing this port. This can happen if a hangup
1274 * occurs on this port. So we must wait until it is complete. The
1275 * order of opens and closes may not be preserved across shared
1276 * memory, so we must wait until it is complete.
1277 */
1278 wait_event_interruptible(portp->raw_wait,
1279 !test_bit(ST_CLOSING, &portp->state));
1280 if (signal_pending(current)) {
1281 restore_flags(flags);
1282 return -ERESTARTSYS;
1283 }
1284
1285 /*
1286 * Everything is ready now, so write the open message into shared
1287 * memory. Once the message is in set the service bits to say that
1288 * this port wants service.
1289 */
1290 EBRDENABLE(brdp);
1291 cp = &((volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl;
1292 cp->openarg = arg;
1293 cp->open = 1;
1294 hdrp = (volatile cdkhdr_t *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1295 bits = ((volatile unsigned char *) hdrp) + brdp->slaveoffset +
1296 portp->portidx;
1297 *bits |= portp->portbit;
1298 EBRDDISABLE(brdp);
1299
1300 if (wait == 0) {
1301 restore_flags(flags);
1302 return(0);
1303 }
1304
1305 /*
1306 * Slave is in action, so now we must wait for the open acknowledgment
1307 * to come back.
1308 */
1309 rc = 0;
1310 set_bit(ST_OPENING, &portp->state);
1311 wait_event_interruptible(portp->raw_wait,
1312 !test_bit(ST_OPENING, &portp->state));
1313 if (signal_pending(current))
1314 rc = -ERESTARTSYS;
1315 restore_flags(flags);
1316
1317 if ((rc == 0) && (portp->rc != 0))
1318 rc = -EIO;
1319 return(rc);
1320 }
1321
1322 /*****************************************************************************/
1323
1324 /*
1325 * Send a close message to the slave. Normally this will sleep waiting
1326 * for the acknowledgement, but if wait parameter is 0 it will not. If
1327 * wait is true then must have user context (to sleep).
1328 */
1329
1330 static int stli_rawclose(stlibrd_t *brdp, stliport_t *portp, unsigned long arg, int wait)
1331 {
1332 volatile cdkhdr_t *hdrp;
1333 volatile cdkctrl_t *cp;
1334 volatile unsigned char *bits;
1335 unsigned long flags;
1336 int rc;
1337
1338 #ifdef DEBUG
1339 printk("stli_rawclose(brdp=%x,portp=%x,arg=%x,wait=%d)\n",
1340 (int) brdp, (int) portp, (int) arg, wait);
1341 #endif
1342
1343 save_flags(flags);
1344 cli();
1345
1346 /*
1347 * Slave is already closing this port. This can happen if a hangup
1348 * occurs on this port.
1349 */
1350 if (wait) {
1351 wait_event_interruptible(portp->raw_wait,
1352 !test_bit(ST_CLOSING, &portp->state));
1353 if (signal_pending(current)) {
1354 restore_flags(flags);
1355 return -ERESTARTSYS;
1356 }
1357 }
1358
1359 /*
1360 * Write the close command into shared memory.
1361 */
1362 EBRDENABLE(brdp);
1363 cp = &((volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl;
1364 cp->closearg = arg;
1365 cp->close = 1;
1366 hdrp = (volatile cdkhdr_t *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1367 bits = ((volatile unsigned char *) hdrp) + brdp->slaveoffset +
1368 portp->portidx;
1369 *bits |= portp->portbit;
1370 EBRDDISABLE(brdp);
1371
1372 set_bit(ST_CLOSING, &portp->state);
1373 if (wait == 0) {
1374 restore_flags(flags);
1375 return(0);
1376 }
1377
1378 /*
1379 * Slave is in action, so now we must wait for the open acknowledgment
1380 * to come back.
1381 */
1382 rc = 0;
1383 wait_event_interruptible(portp->raw_wait,
1384 !test_bit(ST_CLOSING, &portp->state));
1385 if (signal_pending(current))
1386 rc = -ERESTARTSYS;
1387 restore_flags(flags);
1388
1389 if ((rc == 0) && (portp->rc != 0))
1390 rc = -EIO;
1391 return(rc);
1392 }
1393
1394 /*****************************************************************************/
1395
1396 /*
1397 * Send a command to the slave and wait for the response. This must
1398 * have user context (it sleeps). This routine is generic in that it
1399 * can send any type of command. Its purpose is to wait for that command
1400 * to complete (as opposed to initiating the command then returning).
1401 */
1402
1403 static int stli_cmdwait(stlibrd_t *brdp, stliport_t *portp, unsigned long cmd, void *arg, int size, int copyback)
1404 {
1405 unsigned long flags;
1406
1407 #ifdef DEBUG
1408 printk("stli_cmdwait(brdp=%x,portp=%x,cmd=%x,arg=%x,size=%d,"
1409 "copyback=%d)\n", (int) brdp, (int) portp, (int) cmd,
1410 (int) arg, size, copyback);
1411 #endif
1412
1413 save_flags(flags);
1414 cli();
1415 wait_event_interruptible(portp->raw_wait,
1416 !test_bit(ST_CMDING, &portp->state));
1417 if (signal_pending(current)) {
1418 restore_flags(flags);
1419 return -ERESTARTSYS;
1420 }
1421
1422 stli_sendcmd(brdp, portp, cmd, arg, size, copyback);
1423
1424 wait_event_interruptible(portp->raw_wait,
1425 !test_bit(ST_CMDING, &portp->state));
1426 if (signal_pending(current)) {
1427 restore_flags(flags);
1428 return -ERESTARTSYS;
1429 }
1430 restore_flags(flags);
1431
1432 if (portp->rc != 0)
1433 return(-EIO);
1434 return(0);
1435 }
1436
1437 /*****************************************************************************/
1438
1439 /*
1440 * Send the termios settings for this port to the slave. This sleeps
1441 * waiting for the command to complete - so must have user context.
1442 */
1443
1444 static int stli_setport(stliport_t *portp)
1445 {
1446 stlibrd_t *brdp;
1447 asyport_t aport;
1448
1449 #ifdef DEBUG
1450 printk("stli_setport(portp=%x)\n", (int) portp);
1451 #endif
1452
1453 if (portp == (stliport_t *) NULL)
1454 return(-ENODEV);
1455 if (portp->tty == (struct tty_struct *) NULL)
1456 return(-ENODEV);
1457 if ((portp->brdnr < 0) && (portp->brdnr >= stli_nrbrds))
1458 return(-ENODEV);
1459 brdp = stli_brds[portp->brdnr];
1460 if (brdp == (stlibrd_t *) NULL)
1461 return(-ENODEV);
1462
1463 stli_mkasyport(portp, &aport, portp->tty->termios);
1464 return(stli_cmdwait(brdp, portp, A_SETPORT, &aport, sizeof(asyport_t), 0));
1465 }
1466
1467 /*****************************************************************************/
1468
1469 /*
1470 * Possibly need to wait for carrier (DCD signal) to come high. Say
1471 * maybe because if we are clocal then we don't need to wait...
1472 */
1473
1474 static int stli_waitcarrier(stlibrd_t *brdp, stliport_t *portp, struct file *filp)
1475 {
1476 unsigned long flags;
1477 int rc, doclocal;
1478
1479 #ifdef DEBUG
1480 printk("stli_waitcarrier(brdp=%x,portp=%x,filp=%x)\n",
1481 (int) brdp, (int) portp, (int) filp);
1482 #endif
1483
1484 rc = 0;
1485 doclocal = 0;
1486
1487 if (portp->tty->termios->c_cflag & CLOCAL)
1488 doclocal++;
1489
1490 save_flags(flags);
1491 cli();
1492 portp->openwaitcnt++;
1493 if (! tty_hung_up_p(filp))
1494 portp->refcount--;
1495
1496 for (;;) {
1497 stli_mkasysigs(&portp->asig, 1, 1);
1498 if ((rc = stli_cmdwait(brdp, portp, A_SETSIGNALS,
1499 &portp->asig, sizeof(asysigs_t), 0)) < 0)
1500 break;
1501 if (tty_hung_up_p(filp) ||
1502 ((portp->flags & ASYNC_INITIALIZED) == 0)) {
1503 if (portp->flags & ASYNC_HUP_NOTIFY)
1504 rc = -EBUSY;
1505 else
1506 rc = -ERESTARTSYS;
1507 break;
1508 }
1509 if (((portp->flags & ASYNC_CLOSING) == 0) &&
1510 (doclocal || (portp->sigs & TIOCM_CD))) {
1511 break;
1512 }
1513 if (signal_pending(current)) {
1514 rc = -ERESTARTSYS;
1515 break;
1516 }
1517 interruptible_sleep_on(&portp->open_wait);
1518 }
1519
1520 if (! tty_hung_up_p(filp))
1521 portp->refcount++;
1522 portp->openwaitcnt--;
1523 restore_flags(flags);
1524
1525 return(rc);
1526 }
1527
1528 /*****************************************************************************/
1529
1530 /*
1531 * Write routine. Take the data and put it in the shared memory ring
1532 * queue. If port is not already sending chars then need to mark the
1533 * service bits for this port.
1534 */
1535
1536 static int stli_write(struct tty_struct *tty, const unsigned char *buf, int count)
1537 {
1538 volatile cdkasy_t *ap;
1539 volatile cdkhdr_t *hdrp;
1540 volatile unsigned char *bits;
1541 unsigned char *shbuf, *chbuf;
1542 stliport_t *portp;
1543 stlibrd_t *brdp;
1544 unsigned int len, stlen, head, tail, size;
1545 unsigned long flags;
1546
1547 #ifdef DEBUG
1548 printk("stli_write(tty=%x,buf=%x,count=%d)\n",
1549 (int) tty, (int) buf, count);
1550 #endif
1551
1552 if ((tty == (struct tty_struct *) NULL) ||
1553 (stli_tmpwritebuf == (char *) NULL))
1554 return(0);
1555 if (tty == stli_txcooktty)
1556 stli_flushchars(tty);
1557 portp = tty->driver_data;
1558 if (portp == (stliport_t *) NULL)
1559 return(0);
1560 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
1561 return(0);
1562 brdp = stli_brds[portp->brdnr];
1563 if (brdp == (stlibrd_t *) NULL)
1564 return(0);
1565 chbuf = (unsigned char *) buf;
1566
1567 /*
1568 * All data is now local, shove as much as possible into shared memory.
1569 */
1570 save_flags(flags);
1571 cli();
1572 EBRDENABLE(brdp);
1573 ap = (volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr);
1574 head = (unsigned int) ap->txq.head;
1575 tail = (unsigned int) ap->txq.tail;
1576 if (tail != ((unsigned int) ap->txq.tail))
1577 tail = (unsigned int) ap->txq.tail;
1578 size = portp->txsize;
1579 if (head >= tail) {
1580 len = size - (head - tail) - 1;
1581 stlen = size - head;
1582 } else {
1583 len = tail - head - 1;
1584 stlen = len;
1585 }
1586
1587 len = MIN(len, count);
1588 count = 0;
1589 shbuf = (char *) EBRDGETMEMPTR(brdp, portp->txoffset);
1590
1591 while (len > 0) {
1592 stlen = MIN(len, stlen);
1593 memcpy((shbuf + head), chbuf, stlen);
1594 chbuf += stlen;
1595 len -= stlen;
1596 count += stlen;
1597 head += stlen;
1598 if (head >= size) {
1599 head = 0;
1600 stlen = tail;
1601 }
1602 }
1603
1604 ap = (volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr);
1605 ap->txq.head = head;
1606 if (test_bit(ST_TXBUSY, &portp->state)) {
1607 if (ap->changed.data & DT_TXEMPTY)
1608 ap->changed.data &= ~DT_TXEMPTY;
1609 }
1610 hdrp = (volatile cdkhdr_t *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1611 bits = ((volatile unsigned char *) hdrp) + brdp->slaveoffset +
1612 portp->portidx;
1613 *bits |= portp->portbit;
1614 set_bit(ST_TXBUSY, &portp->state);
1615 EBRDDISABLE(brdp);
1616
1617 restore_flags(flags);
1618
1619 return(count);
1620 }
1621
1622 /*****************************************************************************/
1623
1624 /*
1625 * Output a single character. We put it into a temporary local buffer
1626 * (for speed) then write out that buffer when the flushchars routine
1627 * is called. There is a safety catch here so that if some other port
1628 * writes chars before the current buffer has been, then we write them
1629 * first them do the new ports.
1630 */
1631
1632 static void stli_putchar(struct tty_struct *tty, unsigned char ch)
1633 {
1634 #ifdef DEBUG
1635 printk("stli_putchar(tty=%x,ch=%x)\n", (int) tty, (int) ch);
1636 #endif
1637
1638 if (tty == (struct tty_struct *) NULL)
1639 return;
1640 if (tty != stli_txcooktty) {
1641 if (stli_txcooktty != (struct tty_struct *) NULL)
1642 stli_flushchars(stli_txcooktty);
1643 stli_txcooktty = tty;
1644 }
1645
1646 stli_txcookbuf[stli_txcooksize++] = ch;
1647 }
1648
1649 /*****************************************************************************/
1650
1651 /*
1652 * Transfer characters from the local TX cooking buffer to the board.
1653 * We sort of ignore the tty that gets passed in here. We rely on the
1654 * info stored with the TX cook buffer to tell us which port to flush
1655 * the data on. In any case we clean out the TX cook buffer, for re-use
1656 * by someone else.
1657 */
1658
1659 static void stli_flushchars(struct tty_struct *tty)
1660 {
1661 volatile cdkhdr_t *hdrp;
1662 volatile unsigned char *bits;
1663 volatile cdkasy_t *ap;
1664 struct tty_struct *cooktty;
1665 stliport_t *portp;
1666 stlibrd_t *brdp;
1667 unsigned int len, stlen, head, tail, size, count, cooksize;
1668 unsigned char *buf, *shbuf;
1669 unsigned long flags;
1670
1671 #ifdef DEBUG
1672 printk("stli_flushchars(tty=%x)\n", (int) tty);
1673 #endif
1674
1675 cooksize = stli_txcooksize;
1676 cooktty = stli_txcooktty;
1677 stli_txcooksize = 0;
1678 stli_txcookrealsize = 0;
1679 stli_txcooktty = (struct tty_struct *) NULL;
1680
1681 if (tty == (struct tty_struct *) NULL)
1682 return;
1683 if (cooktty == (struct tty_struct *) NULL)
1684 return;
1685 if (tty != cooktty)
1686 tty = cooktty;
1687 if (cooksize == 0)
1688 return;
1689
1690 portp = tty->driver_data;
1691 if (portp == (stliport_t *) NULL)
1692 return;
1693 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
1694 return;
1695 brdp = stli_brds[portp->brdnr];
1696 if (brdp == (stlibrd_t *) NULL)
1697 return;
1698
1699 save_flags(flags);
1700 cli();
1701 EBRDENABLE(brdp);
1702
1703 ap = (volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr);
1704 head = (unsigned int) ap->txq.head;
1705 tail = (unsigned int) ap->txq.tail;
1706 if (tail != ((unsigned int) ap->txq.tail))
1707 tail = (unsigned int) ap->txq.tail;
1708 size = portp->txsize;
1709 if (head >= tail) {
1710 len = size - (head - tail) - 1;
1711 stlen = size - head;
1712 } else {
1713 len = tail - head - 1;
1714 stlen = len;
1715 }
1716
1717 len = MIN(len, cooksize);
1718 count = 0;
1719 shbuf = (char *) EBRDGETMEMPTR(brdp, portp->txoffset);
1720 buf = stli_txcookbuf;
1721
1722 while (len > 0) {
1723 stlen = MIN(len, stlen);
1724 memcpy((shbuf + head), buf, stlen);
1725 buf += stlen;
1726 len -= stlen;
1727 count += stlen;
1728 head += stlen;
1729 if (head >= size) {
1730 head = 0;
1731 stlen = tail;
1732 }
1733 }
1734
1735 ap = (volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr);
1736 ap->txq.head = head;
1737
1738 if (test_bit(ST_TXBUSY, &portp->state)) {
1739 if (ap->changed.data & DT_TXEMPTY)
1740 ap->changed.data &= ~DT_TXEMPTY;
1741 }
1742 hdrp = (volatile cdkhdr_t *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1743 bits = ((volatile unsigned char *) hdrp) + brdp->slaveoffset +
1744 portp->portidx;
1745 *bits |= portp->portbit;
1746 set_bit(ST_TXBUSY, &portp->state);
1747
1748 EBRDDISABLE(brdp);
1749 restore_flags(flags);
1750 }
1751
1752 /*****************************************************************************/
1753
1754 static int stli_writeroom(struct tty_struct *tty)
1755 {
1756 volatile cdkasyrq_t *rp;
1757 stliport_t *portp;
1758 stlibrd_t *brdp;
1759 unsigned int head, tail, len;
1760 unsigned long flags;
1761
1762 #ifdef DEBUG
1763 printk("stli_writeroom(tty=%x)\n", (int) tty);
1764 #endif
1765
1766 if (tty == (struct tty_struct *) NULL)
1767 return(0);
1768 if (tty == stli_txcooktty) {
1769 if (stli_txcookrealsize != 0) {
1770 len = stli_txcookrealsize - stli_txcooksize;
1771 return(len);
1772 }
1773 }
1774
1775 portp = tty->driver_data;
1776 if (portp == (stliport_t *) NULL)
1777 return(0);
1778 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
1779 return(0);
1780 brdp = stli_brds[portp->brdnr];
1781 if (brdp == (stlibrd_t *) NULL)
1782 return(0);
1783
1784 save_flags(flags);
1785 cli();
1786 EBRDENABLE(brdp);
1787 rp = &((volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr))->txq;
1788 head = (unsigned int) rp->head;
1789 tail = (unsigned int) rp->tail;
1790 if (tail != ((unsigned int) rp->tail))
1791 tail = (unsigned int) rp->tail;
1792 len = (head >= tail) ? (portp->txsize - (head - tail)) : (tail - head);
1793 len--;
1794 EBRDDISABLE(brdp);
1795 restore_flags(flags);
1796
1797 if (tty == stli_txcooktty) {
1798 stli_txcookrealsize = len;
1799 len -= stli_txcooksize;
1800 }
1801 return(len);
1802 }
1803
1804 /*****************************************************************************/
1805
1806 /*
1807 * Return the number of characters in the transmit buffer. Normally we
1808 * will return the number of chars in the shared memory ring queue.
1809 * We need to kludge around the case where the shared memory buffer is
1810 * empty but not all characters have drained yet, for this case just
1811 * return that there is 1 character in the buffer!
1812 */
1813
1814 static int stli_charsinbuffer(struct tty_struct *tty)
1815 {
1816 volatile cdkasyrq_t *rp;
1817 stliport_t *portp;
1818 stlibrd_t *brdp;
1819 unsigned int head, tail, len;
1820 unsigned long flags;
1821
1822 #ifdef DEBUG
1823 printk("stli_charsinbuffer(tty=%x)\n", (int) tty);
1824 #endif
1825
1826 if (tty == (struct tty_struct *) NULL)
1827 return(0);
1828 if (tty == stli_txcooktty)
1829 stli_flushchars(tty);
1830 portp = tty->driver_data;
1831 if (portp == (stliport_t *) NULL)
1832 return(0);
1833 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
1834 return(0);
1835 brdp = stli_brds[portp->brdnr];
1836 if (brdp == (stlibrd_t *) NULL)
1837 return(0);
1838
1839 save_flags(flags);
1840 cli();
1841 EBRDENABLE(brdp);
1842 rp = &((volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr))->txq;
1843 head = (unsigned int) rp->head;
1844 tail = (unsigned int) rp->tail;
1845 if (tail != ((unsigned int) rp->tail))
1846 tail = (unsigned int) rp->tail;
1847 len = (head >= tail) ? (head - tail) : (portp->txsize - (tail - head));
1848 if ((len == 0) && test_bit(ST_TXBUSY, &portp->state))
1849 len = 1;
1850 EBRDDISABLE(brdp);
1851 restore_flags(flags);
1852
1853 return(len);
1854 }
1855
1856 /*****************************************************************************/
1857
1858 /*
1859 * Generate the serial struct info.
1860 */
1861
1862 static int stli_getserial(stliport_t *portp, struct serial_struct __user *sp)
1863 {
1864 struct serial_struct sio;
1865 stlibrd_t *brdp;
1866
1867 #ifdef DEBUG
1868 printk("stli_getserial(portp=%x,sp=%x)\n", (int) portp, (int) sp);
1869 #endif
1870
1871 memset(&sio, 0, sizeof(struct serial_struct));
1872 sio.type = PORT_UNKNOWN;
1873 sio.line = portp->portnr;
1874 sio.irq = 0;
1875 sio.flags = portp->flags;
1876 sio.baud_base = portp->baud_base;
1877 sio.close_delay = portp->close_delay;
1878 sio.closing_wait = portp->closing_wait;
1879 sio.custom_divisor = portp->custom_divisor;
1880 sio.xmit_fifo_size = 0;
1881 sio.hub6 = 0;
1882
1883 brdp = stli_brds[portp->brdnr];
1884 if (brdp != (stlibrd_t *) NULL)
1885 sio.port = brdp->iobase;
1886
1887 return copy_to_user(sp, &sio, sizeof(struct serial_struct)) ?
1888 -EFAULT : 0;
1889 }
1890
1891 /*****************************************************************************/
1892
1893 /*
1894 * Set port according to the serial struct info.
1895 * At this point we do not do any auto-configure stuff, so we will
1896 * just quietly ignore any requests to change irq, etc.
1897 */
1898
1899 static int stli_setserial(stliport_t *portp, struct serial_struct __user *sp)
1900 {
1901 struct serial_struct sio;
1902 int rc;
1903
1904 #ifdef DEBUG
1905 printk("stli_setserial(portp=%p,sp=%p)\n", portp, sp);
1906 #endif
1907
1908 if (copy_from_user(&sio, sp, sizeof(struct serial_struct)))
1909 return -EFAULT;
1910 if (!capable(CAP_SYS_ADMIN)) {
1911 if ((sio.baud_base != portp->baud_base) ||
1912 (sio.close_delay != portp->close_delay) ||
1913 ((sio.flags & ~ASYNC_USR_MASK) !=
1914 (portp->flags & ~ASYNC_USR_MASK)))
1915 return(-EPERM);
1916 }
1917
1918 portp->flags = (portp->flags & ~ASYNC_USR_MASK) |
1919 (sio.flags & ASYNC_USR_MASK);
1920 portp->baud_base = sio.baud_base;
1921 portp->close_delay = sio.close_delay;
1922 portp->closing_wait = sio.closing_wait;
1923 portp->custom_divisor = sio.custom_divisor;
1924
1925 if ((rc = stli_setport(portp)) < 0)
1926 return(rc);
1927 return(0);
1928 }
1929
1930 /*****************************************************************************/
1931
1932 static int stli_tiocmget(struct tty_struct *tty, struct file *file)
1933 {
1934 stliport_t *portp = tty->driver_data;
1935 stlibrd_t *brdp;
1936 int rc;
1937
1938 if (portp == (stliport_t *) NULL)
1939 return(-ENODEV);
1940 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
1941 return(0);
1942 brdp = stli_brds[portp->brdnr];
1943 if (brdp == (stlibrd_t *) NULL)
1944 return(0);
1945 if (tty->flags & (1 << TTY_IO_ERROR))
1946 return(-EIO);
1947
1948 if ((rc = stli_cmdwait(brdp, portp, A_GETSIGNALS,
1949 &portp->asig, sizeof(asysigs_t), 1)) < 0)
1950 return(rc);
1951
1952 return stli_mktiocm(portp->asig.sigvalue);
1953 }
1954
1955 static int stli_tiocmset(struct tty_struct *tty, struct file *file,
1956 unsigned int set, unsigned int clear)
1957 {
1958 stliport_t *portp = tty->driver_data;
1959 stlibrd_t *brdp;
1960 int rts = -1, dtr = -1;
1961
1962 if (portp == (stliport_t *) NULL)
1963 return(-ENODEV);
1964 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
1965 return(0);
1966 brdp = stli_brds[portp->brdnr];
1967 if (brdp == (stlibrd_t *) NULL)
1968 return(0);
1969 if (tty->flags & (1 << TTY_IO_ERROR))
1970 return(-EIO);
1971
1972 if (set & TIOCM_RTS)
1973 rts = 1;
1974 if (set & TIOCM_DTR)
1975 dtr = 1;
1976 if (clear & TIOCM_RTS)
1977 rts = 0;
1978 if (clear & TIOCM_DTR)
1979 dtr = 0;
1980
1981 stli_mkasysigs(&portp->asig, dtr, rts);
1982
1983 return stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
1984 sizeof(asysigs_t), 0);
1985 }
1986
1987 static int stli_ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg)
1988 {
1989 stliport_t *portp;
1990 stlibrd_t *brdp;
1991 unsigned int ival;
1992 int rc;
1993 void __user *argp = (void __user *)arg;
1994
1995 #ifdef DEBUG
1996 printk("stli_ioctl(tty=%x,file=%x,cmd=%x,arg=%x)\n",
1997 (int) tty, (int) file, cmd, (int) arg);
1998 #endif
1999
2000 if (tty == (struct tty_struct *) NULL)
2001 return(-ENODEV);
2002 portp = tty->driver_data;
2003 if (portp == (stliport_t *) NULL)
2004 return(-ENODEV);
2005 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
2006 return(0);
2007 brdp = stli_brds[portp->brdnr];
2008 if (brdp == (stlibrd_t *) NULL)
2009 return(0);
2010
2011 if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
2012 (cmd != COM_GETPORTSTATS) && (cmd != COM_CLRPORTSTATS)) {
2013 if (tty->flags & (1 << TTY_IO_ERROR))
2014 return(-EIO);
2015 }
2016
2017 rc = 0;
2018
2019 switch (cmd) {
2020 case TIOCGSOFTCAR:
2021 rc = put_user(((tty->termios->c_cflag & CLOCAL) ? 1 : 0),
2022 (unsigned __user *) arg);
2023 break;
2024 case TIOCSSOFTCAR:
2025 if ((rc = get_user(ival, (unsigned __user *) arg)) == 0)
2026 tty->termios->c_cflag =
2027 (tty->termios->c_cflag & ~CLOCAL) |
2028 (ival ? CLOCAL : 0);
2029 break;
2030 case TIOCGSERIAL:
2031 rc = stli_getserial(portp, argp);
2032 break;
2033 case TIOCSSERIAL:
2034 rc = stli_setserial(portp, argp);
2035 break;
2036 case STL_GETPFLAG:
2037 rc = put_user(portp->pflag, (unsigned __user *)argp);
2038 break;
2039 case STL_SETPFLAG:
2040 if ((rc = get_user(portp->pflag, (unsigned __user *)argp)) == 0)
2041 stli_setport(portp);
2042 break;
2043 case COM_GETPORTSTATS:
2044 rc = stli_getportstats(portp, argp);
2045 break;
2046 case COM_CLRPORTSTATS:
2047 rc = stli_clrportstats(portp, argp);
2048 break;
2049 case TIOCSERCONFIG:
2050 case TIOCSERGWILD:
2051 case TIOCSERSWILD:
2052 case TIOCSERGETLSR:
2053 case TIOCSERGSTRUCT:
2054 case TIOCSERGETMULTI:
2055 case TIOCSERSETMULTI:
2056 default:
2057 rc = -ENOIOCTLCMD;
2058 break;
2059 }
2060
2061 return(rc);
2062 }
2063
2064 /*****************************************************************************/
2065
2066 /*
2067 * This routine assumes that we have user context and can sleep.
2068 * Looks like it is true for the current ttys implementation..!!
2069 */
2070
2071 static void stli_settermios(struct tty_struct *tty, struct termios *old)
2072 {
2073 stliport_t *portp;
2074 stlibrd_t *brdp;
2075 struct termios *tiosp;
2076 asyport_t aport;
2077
2078 #ifdef DEBUG
2079 printk("stli_settermios(tty=%x,old=%x)\n", (int) tty, (int) old);
2080 #endif
2081
2082 if (tty == (struct tty_struct *) NULL)
2083 return;
2084 portp = tty->driver_data;
2085 if (portp == (stliport_t *) NULL)
2086 return;
2087 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
2088 return;
2089 brdp = stli_brds[portp->brdnr];
2090 if (brdp == (stlibrd_t *) NULL)
2091 return;
2092
2093 tiosp = tty->termios;
2094 if ((tiosp->c_cflag == old->c_cflag) &&
2095 (tiosp->c_iflag == old->c_iflag))
2096 return;
2097
2098 stli_mkasyport(portp, &aport, tiosp);
2099 stli_cmdwait(brdp, portp, A_SETPORT, &aport, sizeof(asyport_t), 0);
2100 stli_mkasysigs(&portp->asig, ((tiosp->c_cflag & CBAUD) ? 1 : 0), -1);
2101 stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
2102 sizeof(asysigs_t), 0);
2103 if ((old->c_cflag & CRTSCTS) && ((tiosp->c_cflag & CRTSCTS) == 0))
2104 tty->hw_stopped = 0;
2105 if (((old->c_cflag & CLOCAL) == 0) && (tiosp->c_cflag & CLOCAL))
2106 wake_up_interruptible(&portp->open_wait);
2107 }
2108
2109 /*****************************************************************************/
2110
2111 /*
2112 * Attempt to flow control who ever is sending us data. We won't really
2113 * do any flow control action here. We can't directly, and even if we
2114 * wanted to we would have to send a command to the slave. The slave
2115 * knows how to flow control, and will do so when its buffers reach its
2116 * internal high water marks. So what we will do is set a local state
2117 * bit that will stop us sending any RX data up from the poll routine
2118 * (which is the place where RX data from the slave is handled).
2119 */
2120
2121 static void stli_throttle(struct tty_struct *tty)
2122 {
2123 stliport_t *portp;
2124
2125 #ifdef DEBUG
2126 printk("stli_throttle(tty=%x)\n", (int) tty);
2127 #endif
2128
2129 if (tty == (struct tty_struct *) NULL)
2130 return;
2131 portp = tty->driver_data;
2132 if (portp == (stliport_t *) NULL)
2133 return;
2134
2135 set_bit(ST_RXSTOP, &portp->state);
2136 }
2137
2138 /*****************************************************************************/
2139
2140 /*
2141 * Unflow control the device sending us data... That means that all
2142 * we have to do is clear the RXSTOP state bit. The next poll call
2143 * will then be able to pass the RX data back up.
2144 */
2145
2146 static void stli_unthrottle(struct tty_struct *tty)
2147 {
2148 stliport_t *portp;
2149
2150 #ifdef DEBUG
2151 printk("stli_unthrottle(tty=%x)\n", (int) tty);
2152 #endif
2153
2154 if (tty == (struct tty_struct *) NULL)
2155 return;
2156 portp = tty->driver_data;
2157 if (portp == (stliport_t *) NULL)
2158 return;
2159
2160 clear_bit(ST_RXSTOP, &portp->state);
2161 }
2162
2163 /*****************************************************************************/
2164
2165 /*
2166 * Stop the transmitter. Basically to do this we will just turn TX
2167 * interrupts off.
2168 */
2169
2170 static void stli_stop(struct tty_struct *tty)
2171 {
2172 stlibrd_t *brdp;
2173 stliport_t *portp;
2174 asyctrl_t actrl;
2175
2176 #ifdef DEBUG
2177 printk("stli_stop(tty=%x)\n", (int) tty);
2178 #endif
2179
2180 if (tty == (struct tty_struct *) NULL)
2181 return;
2182 portp = tty->driver_data;
2183 if (portp == (stliport_t *) NULL)
2184 return;
2185 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
2186 return;
2187 brdp = stli_brds[portp->brdnr];
2188 if (brdp == (stlibrd_t *) NULL)
2189 return;
2190
2191 memset(&actrl, 0, sizeof(asyctrl_t));
2192 actrl.txctrl = CT_STOPFLOW;
2193 #if 0
2194 stli_cmdwait(brdp, portp, A_PORTCTRL, &actrl, sizeof(asyctrl_t), 0);
2195 #endif
2196 }
2197
2198 /*****************************************************************************/
2199
2200 /*
2201 * Start the transmitter again. Just turn TX interrupts back on.
2202 */
2203
2204 static void stli_start(struct tty_struct *tty)
2205 {
2206 stliport_t *portp;
2207 stlibrd_t *brdp;
2208 asyctrl_t actrl;
2209
2210 #ifdef DEBUG
2211 printk("stli_start(tty=%x)\n", (int) tty);
2212 #endif
2213
2214 if (tty == (struct tty_struct *) NULL)
2215 return;
2216 portp = tty->driver_data;
2217 if (portp == (stliport_t *) NULL)
2218 return;
2219 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
2220 return;
2221 brdp = stli_brds[portp->brdnr];
2222 if (brdp == (stlibrd_t *) NULL)
2223 return;
2224
2225 memset(&actrl, 0, sizeof(asyctrl_t));
2226 actrl.txctrl = CT_STARTFLOW;
2227 #if 0
2228 stli_cmdwait(brdp, portp, A_PORTCTRL, &actrl, sizeof(asyctrl_t), 0);
2229 #endif
2230 }
2231
2232 /*****************************************************************************/
2233
2234 /*
2235 * Scheduler called hang up routine. This is called from the scheduler,
2236 * not direct from the driver "poll" routine. We can't call it there
2237 * since the real local hangup code will enable/disable the board and
2238 * other things that we can't do while handling the poll. Much easier
2239 * to deal with it some time later (don't really care when, hangups
2240 * aren't that time critical).
2241 */
2242
2243 static void stli_dohangup(void *arg)
2244 {
2245 stliport_t *portp;
2246
2247 #ifdef DEBUG
2248 printk(KERN_DEBUG "stli_dohangup(portp=%x)\n", (int) arg);
2249 #endif
2250
2251 /*
2252 * FIXME: There's a module removal race here: tty_hangup
2253 * calls schedule_work which will call into this
2254 * driver later.
2255 */
2256 portp = (stliport_t *) arg;
2257 if (portp != (stliport_t *) NULL) {
2258 if (portp->tty != (struct tty_struct *) NULL) {
2259 tty_hangup(portp->tty);
2260 }
2261 }
2262 }
2263
2264 /*****************************************************************************/
2265
2266 /*
2267 * Hangup this port. This is pretty much like closing the port, only
2268 * a little more brutal. No waiting for data to drain. Shutdown the
2269 * port and maybe drop signals. This is rather tricky really. We want
2270 * to close the port as well.
2271 */
2272
2273 static void stli_hangup(struct tty_struct *tty)
2274 {
2275 stliport_t *portp;
2276 stlibrd_t *brdp;
2277 unsigned long flags;
2278
2279 #ifdef DEBUG
2280 printk(KERN_DEBUG "stli_hangup(tty=%x)\n", (int) tty);
2281 #endif
2282
2283 if (tty == (struct tty_struct *) NULL)
2284 return;
2285 portp = tty->driver_data;
2286 if (portp == (stliport_t *) NULL)
2287 return;
2288 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
2289 return;
2290 brdp = stli_brds[portp->brdnr];
2291 if (brdp == (stlibrd_t *) NULL)
2292 return;
2293
2294 portp->flags &= ~ASYNC_INITIALIZED;
2295
2296 save_flags(flags);
2297 cli();
2298 if (! test_bit(ST_CLOSING, &portp->state))
2299 stli_rawclose(brdp, portp, 0, 0);
2300 if (tty->termios->c_cflag & HUPCL) {
2301 stli_mkasysigs(&portp->asig, 0, 0);
2302 if (test_bit(ST_CMDING, &portp->state)) {
2303 set_bit(ST_DOSIGS, &portp->state);
2304 set_bit(ST_DOFLUSHTX, &portp->state);
2305 set_bit(ST_DOFLUSHRX, &portp->state);
2306 } else {
2307 stli_sendcmd(brdp, portp, A_SETSIGNALSF,
2308 &portp->asig, sizeof(asysigs_t), 0);
2309 }
2310 }
2311 restore_flags(flags);
2312
2313 clear_bit(ST_TXBUSY, &portp->state);
2314 clear_bit(ST_RXSTOP, &portp->state);
2315 set_bit(TTY_IO_ERROR, &tty->flags);
2316 portp->tty = (struct tty_struct *) NULL;
2317 portp->flags &= ~ASYNC_NORMAL_ACTIVE;
2318 portp->refcount = 0;
2319 wake_up_interruptible(&portp->open_wait);
2320 }
2321
2322 /*****************************************************************************/
2323
2324 /*
2325 * Flush characters from the lower buffer. We may not have user context
2326 * so we cannot sleep waiting for it to complete. Also we need to check
2327 * if there is chars for this port in the TX cook buffer, and flush them
2328 * as well.
2329 */
2330
2331 static void stli_flushbuffer(struct tty_struct *tty)
2332 {
2333 stliport_t *portp;
2334 stlibrd_t *brdp;
2335 unsigned long ftype, flags;
2336
2337 #ifdef DEBUG
2338 printk(KERN_DEBUG "stli_flushbuffer(tty=%x)\n", (int) tty);
2339 #endif
2340
2341 if (tty == (struct tty_struct *) NULL)
2342 return;
2343 portp = tty->driver_data;
2344 if (portp == (stliport_t *) NULL)
2345 return;
2346 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
2347 return;
2348 brdp = stli_brds[portp->brdnr];
2349 if (brdp == (stlibrd_t *) NULL)
2350 return;
2351
2352 save_flags(flags);
2353 cli();
2354 if (tty == stli_txcooktty) {
2355 stli_txcooktty = (struct tty_struct *) NULL;
2356 stli_txcooksize = 0;
2357 stli_txcookrealsize = 0;
2358 }
2359 if (test_bit(ST_CMDING, &portp->state)) {
2360 set_bit(ST_DOFLUSHTX, &portp->state);
2361 } else {
2362 ftype = FLUSHTX;
2363 if (test_bit(ST_DOFLUSHRX, &portp->state)) {
2364 ftype |= FLUSHRX;
2365 clear_bit(ST_DOFLUSHRX, &portp->state);
2366 }
2367 stli_sendcmd(brdp, portp, A_FLUSH, &ftype,
2368 sizeof(unsigned long), 0);
2369 }
2370 restore_flags(flags);
2371
2372 wake_up_interruptible(&tty->write_wait);
2373 if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
2374 tty->ldisc.write_wakeup)
2375 (tty->ldisc.write_wakeup)(tty);
2376 }
2377
2378 /*****************************************************************************/
2379
2380 static void stli_breakctl(struct tty_struct *tty, int state)
2381 {
2382 stlibrd_t *brdp;
2383 stliport_t *portp;
2384 long arg;
2385 /* long savestate, savetime; */
2386
2387 #ifdef DEBUG
2388 printk(KERN_DEBUG "stli_breakctl(tty=%x,state=%d)\n", (int) tty, state);
2389 #endif
2390
2391 if (tty == (struct tty_struct *) NULL)
2392 return;
2393 portp = tty->driver_data;
2394 if (portp == (stliport_t *) NULL)
2395 return;
2396 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
2397 return;
2398 brdp = stli_brds[portp->brdnr];
2399 if (brdp == (stlibrd_t *) NULL)
2400 return;
2401
2402 /*
2403 * Due to a bug in the tty send_break() code we need to preserve
2404 * the current process state and timeout...
2405 savetime = current->timeout;
2406 savestate = current->state;
2407 */
2408
2409 arg = (state == -1) ? BREAKON : BREAKOFF;
2410 stli_cmdwait(brdp, portp, A_BREAK, &arg, sizeof(long), 0);
2411
2412 /*
2413 *
2414 current->timeout = savetime;
2415 current->state = savestate;
2416 */
2417 }
2418
2419 /*****************************************************************************/
2420
2421 static void stli_waituntilsent(struct tty_struct *tty, int timeout)
2422 {
2423 stliport_t *portp;
2424 unsigned long tend;
2425
2426 #ifdef DEBUG
2427 printk(KERN_DEBUG "stli_waituntilsent(tty=%x,timeout=%x)\n", (int) tty, timeout);
2428 #endif
2429
2430 if (tty == (struct tty_struct *) NULL)
2431 return;
2432 portp = tty->driver_data;
2433 if (portp == (stliport_t *) NULL)
2434 return;
2435
2436 if (timeout == 0)
2437 timeout = HZ;
2438 tend = jiffies + timeout;
2439
2440 while (test_bit(ST_TXBUSY, &portp->state)) {
2441 if (signal_pending(current))
2442 break;
2443 msleep_interruptible(20);
2444 if (time_after_eq(jiffies, tend))
2445 break;
2446 }
2447 }
2448
2449 /*****************************************************************************/
2450
2451 static void stli_sendxchar(struct tty_struct *tty, char ch)
2452 {
2453 stlibrd_t *brdp;
2454 stliport_t *portp;
2455 asyctrl_t actrl;
2456
2457 #ifdef DEBUG
2458 printk(KERN_DEBUG "stli_sendxchar(tty=%x,ch=%x)\n", (int) tty, ch);
2459 #endif
2460
2461 if (tty == (struct tty_struct *) NULL)
2462 return;
2463 portp = tty->driver_data;
2464 if (portp == (stliport_t *) NULL)
2465 return;
2466 if ((portp->brdnr < 0) || (portp->brdnr >= stli_nrbrds))
2467 return;
2468 brdp = stli_brds[portp->brdnr];
2469 if (brdp == (stlibrd_t *) NULL)
2470 return;
2471
2472 memset(&actrl, 0, sizeof(asyctrl_t));
2473 if (ch == STOP_CHAR(tty)) {
2474 actrl.rxctrl = CT_STOPFLOW;
2475 } else if (ch == START_CHAR(tty)) {
2476 actrl.rxctrl = CT_STARTFLOW;
2477 } else {
2478 actrl.txctrl = CT_SENDCHR;
2479 actrl.tximdch = ch;
2480 }
2481
2482 stli_cmdwait(brdp, portp, A_PORTCTRL, &actrl, sizeof(asyctrl_t), 0);
2483 }
2484
2485 /*****************************************************************************/
2486
2487 #define MAXLINE 80
2488
2489 /*
2490 * Format info for a specified port. The line is deliberately limited
2491 * to 80 characters. (If it is too long it will be truncated, if too
2492 * short then padded with spaces).
2493 */
2494
2495 static int stli_portinfo(stlibrd_t *brdp, stliport_t *portp, int portnr, char *pos)
2496 {
2497 char *sp, *uart;
2498 int rc, cnt;
2499
2500 rc = stli_portcmdstats(portp);
2501
2502 uart = "UNKNOWN";
2503 if (brdp->state & BST_STARTED) {
2504 switch (stli_comstats.hwid) {
2505 case 0: uart = "2681"; break;
2506 case 1: uart = "SC26198"; break;
2507 default: uart = "CD1400"; break;
2508 }
2509 }
2510
2511 sp = pos;
2512 sp += sprintf(sp, "%d: uart:%s ", portnr, uart);
2513
2514 if ((brdp->state & BST_STARTED) && (rc >= 0)) {
2515 sp += sprintf(sp, "tx:%d rx:%d", (int) stli_comstats.txtotal,
2516 (int) stli_comstats.rxtotal);
2517
2518 if (stli_comstats.rxframing)
2519 sp += sprintf(sp, " fe:%d",
2520 (int) stli_comstats.rxframing);
2521 if (stli_comstats.rxparity)
2522 sp += sprintf(sp, " pe:%d",
2523 (int) stli_comstats.rxparity);
2524 if (stli_comstats.rxbreaks)
2525 sp += sprintf(sp, " brk:%d",
2526 (int) stli_comstats.rxbreaks);
2527 if (stli_comstats.rxoverrun)
2528 sp += sprintf(sp, " oe:%d",
2529 (int) stli_comstats.rxoverrun);
2530
2531 cnt = sprintf(sp, "%s%s%s%s%s ",
2532 (stli_comstats.signals & TIOCM_RTS) ? "|RTS" : "",
2533 (stli_comstats.signals & TIOCM_CTS) ? "|CTS" : "",
2534 (stli_comstats.signals & TIOCM_DTR) ? "|DTR" : "",
2535 (stli_comstats.signals & TIOCM_CD) ? "|DCD" : "",
2536 (stli_comstats.signals & TIOCM_DSR) ? "|DSR" : "");
2537 *sp = ' ';
2538 sp += cnt;
2539 }
2540
2541 for (cnt = (sp - pos); (cnt < (MAXLINE - 1)); cnt++)
2542 *sp++ = ' ';
2543 if (cnt >= MAXLINE)
2544 pos[(MAXLINE - 2)] = '+';
2545 pos[(MAXLINE - 1)] = '\n';
2546
2547 return(MAXLINE);
2548 }
2549
2550 /*****************************************************************************/
2551
2552 /*
2553 * Port info, read from the /proc file system.
2554 */
2555
2556 static int stli_readproc(char *page, char **start, off_t off, int count, int *eof, void *data)
2557 {
2558 stlibrd_t *brdp;
2559 stliport_t *portp;
2560 int brdnr, portnr, totalport;
2561 int curoff, maxoff;
2562 char *pos;
2563
2564 #ifdef DEBUG
2565 printk(KERN_DEBUG "stli_readproc(page=%x,start=%x,off=%x,count=%d,eof=%x,"
2566 "data=%x\n", (int) page, (int) start, (int) off, count,
2567 (int) eof, (int) data);
2568 #endif
2569
2570 pos = page;
2571 totalport = 0;
2572 curoff = 0;
2573
2574 if (off == 0) {
2575 pos += sprintf(pos, "%s: version %s", stli_drvtitle,
2576 stli_drvversion);
2577 while (pos < (page + MAXLINE - 1))
2578 *pos++ = ' ';
2579 *pos++ = '\n';
2580 }
2581 curoff = MAXLINE;
2582
2583 /*
2584 * We scan through for each board, panel and port. The offset is
2585 * calculated on the fly, and irrelevant ports are skipped.
2586 */
2587 for (brdnr = 0; (brdnr < stli_nrbrds); brdnr++) {
2588 brdp = stli_brds[brdnr];
2589 if (brdp == (stlibrd_t *) NULL)
2590 continue;
2591 if (brdp->state == 0)
2592 continue;
2593
2594 maxoff = curoff + (brdp->nrports * MAXLINE);
2595 if (off >= maxoff) {
2596 curoff = maxoff;
2597 continue;
2598 }
2599
2600 totalport = brdnr * STL_MAXPORTS;
2601 for (portnr = 0; (portnr < brdp->nrports); portnr++,
2602 totalport++) {
2603 portp = brdp->ports[portnr];
2604 if (portp == (stliport_t *) NULL)
2605 continue;
2606 if (off >= (curoff += MAXLINE))
2607 continue;
2608 if ((pos - page + MAXLINE) > count)
2609 goto stli_readdone;
2610 pos += stli_portinfo(brdp, portp, totalport, pos);
2611 }
2612 }
2613
2614 *eof = 1;
2615
2616 stli_readdone:
2617 *start = page;
2618 return(pos - page);
2619 }
2620
2621 /*****************************************************************************/
2622
2623 /*
2624 * Generic send command routine. This will send a message to the slave,
2625 * of the specified type with the specified argument. Must be very
2626 * careful of data that will be copied out from shared memory -
2627 * containing command results. The command completion is all done from
2628 * a poll routine that does not have user context. Therefore you cannot
2629 * copy back directly into user space, or to the kernel stack of a
2630 * process. This routine does not sleep, so can be called from anywhere.
2631 */
2632
2633 static void stli_sendcmd(stlibrd_t *brdp, stliport_t *portp, unsigned long cmd, void *arg, int size, int copyback)
2634 {
2635 volatile cdkhdr_t *hdrp;
2636 volatile cdkctrl_t *cp;
2637 volatile unsigned char *bits;
2638 unsigned long flags;
2639
2640 #ifdef DEBUG
2641 printk(KERN_DEBUG "stli_sendcmd(brdp=%x,portp=%x,cmd=%x,arg=%x,size=%d,"
2642 "copyback=%d)\n", (int) brdp, (int) portp, (int) cmd,
2643 (int) arg, size, copyback);
2644 #endif
2645
2646 save_flags(flags);
2647 cli();
2648
2649 if (test_bit(ST_CMDING, &portp->state)) {
2650 printk(KERN_ERR "STALLION: command already busy, cmd=%x!\n",
2651 (int) cmd);
2652 restore_flags(flags);
2653 return;
2654 }
2655
2656 EBRDENABLE(brdp);
2657 cp = &((volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl;
2658 if (size > 0) {
2659 memcpy((void *) &(cp->args[0]), arg, size);
2660 if (copyback) {
2661 portp->argp = arg;
2662 portp->argsize = size;
2663 }
2664 }
2665 cp->status = 0;
2666 cp->cmd = cmd;
2667 hdrp = (volatile cdkhdr_t *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
2668 bits = ((volatile unsigned char *) hdrp) + brdp->slaveoffset +
2669 portp->portidx;
2670 *bits |= portp->portbit;
2671 set_bit(ST_CMDING, &portp->state);
2672 EBRDDISABLE(brdp);
2673 restore_flags(flags);
2674 }
2675
2676 /*****************************************************************************/
2677
2678 /*
2679 * Read data from shared memory. This assumes that the shared memory
2680 * is enabled and that interrupts are off. Basically we just empty out
2681 * the shared memory buffer into the tty buffer. Must be careful to
2682 * handle the case where we fill up the tty buffer, but still have
2683 * more chars to unload.
2684 */
2685
2686 static void stli_read(stlibrd_t *brdp, stliport_t *portp)
2687 {
2688 volatile cdkasyrq_t *rp;
2689 volatile char *shbuf;
2690 struct tty_struct *tty;
2691 unsigned int head, tail, size;
2692 unsigned int len, stlen;
2693
2694 #ifdef DEBUG
2695 printk(KERN_DEBUG "stli_read(brdp=%x,portp=%d)\n",
2696 (int) brdp, (int) portp);
2697 #endif
2698
2699 if (test_bit(ST_RXSTOP, &portp->state))
2700 return;
2701 tty = portp->tty;
2702 if (tty == (struct tty_struct *) NULL)
2703 return;
2704
2705 rp = &((volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr))->rxq;
2706 head = (unsigned int) rp->head;
2707 if (head != ((unsigned int) rp->head))
2708 head = (unsigned int) rp->head;
2709 tail = (unsigned int) rp->tail;
2710 size = portp->rxsize;
2711 if (head >= tail) {
2712 len = head - tail;
2713 stlen = len;
2714 } else {
2715 len = size - (tail - head);
2716 stlen = size - tail;
2717 }
2718
2719 len = MIN(len, (TTY_FLIPBUF_SIZE - tty->flip.count));
2720 shbuf = (volatile char *) EBRDGETMEMPTR(brdp, portp->rxoffset);
2721
2722 while (len > 0) {
2723 stlen = MIN(len, stlen);
2724 memcpy(tty->flip.char_buf_ptr, (char *) (shbuf + tail), stlen);
2725 memset(tty->flip.flag_buf_ptr, 0, stlen);
2726 tty->flip.char_buf_ptr += stlen;
2727 tty->flip.flag_buf_ptr += stlen;
2728 tty->flip.count += stlen;
2729
2730 len -= stlen;
2731 tail += stlen;
2732 if (tail >= size) {
2733 tail = 0;
2734 stlen = head;
2735 }
2736 }
2737 rp = &((volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr))->rxq;
2738 rp->tail = tail;
2739
2740 if (head != tail)
2741 set_bit(ST_RXING, &portp->state);
2742
2743 tty_schedule_flip(tty);
2744 }
2745
2746 /*****************************************************************************/
2747
2748 /*
2749 * Set up and carry out any delayed commands. There is only a small set
2750 * of slave commands that can be done "off-level". So it is not too
2751 * difficult to deal with them here.
2752 */
2753
2754 static void stli_dodelaycmd(stliport_t *portp, volatile cdkctrl_t *cp)
2755 {
2756 int cmd;
2757
2758 if (test_bit(ST_DOSIGS, &portp->state)) {
2759 if (test_bit(ST_DOFLUSHTX, &portp->state) &&
2760 test_bit(ST_DOFLUSHRX, &portp->state))
2761 cmd = A_SETSIGNALSF;
2762 else if (test_bit(ST_DOFLUSHTX, &portp->state))
2763 cmd = A_SETSIGNALSFTX;
2764 else if (test_bit(ST_DOFLUSHRX, &portp->state))
2765 cmd = A_SETSIGNALSFRX;
2766 else
2767 cmd = A_SETSIGNALS;
2768 clear_bit(ST_DOFLUSHTX, &portp->state);
2769 clear_bit(ST_DOFLUSHRX, &portp->state);
2770 clear_bit(ST_DOSIGS, &portp->state);
2771 memcpy((void *) &(cp->args[0]), (void *) &portp->asig,
2772 sizeof(asysigs_t));
2773 cp->status = 0;
2774 cp->cmd = cmd;
2775 set_bit(ST_CMDING, &portp->state);
2776 } else if (test_bit(ST_DOFLUSHTX, &portp->state) ||
2777 test_bit(ST_DOFLUSHRX, &portp->state)) {
2778 cmd = ((test_bit(ST_DOFLUSHTX, &portp->state)) ? FLUSHTX : 0);
2779 cmd |= ((test_bit(ST_DOFLUSHRX, &portp->state)) ? FLUSHRX : 0);
2780 clear_bit(ST_DOFLUSHTX, &portp->state);
2781 clear_bit(ST_DOFLUSHRX, &portp->state);
2782 memcpy((void *) &(cp->args[0]), (void *) &cmd, sizeof(int));
2783 cp->status = 0;
2784 cp->cmd = A_FLUSH;
2785 set_bit(ST_CMDING, &portp->state);
2786 }
2787 }
2788
2789 /*****************************************************************************/
2790
2791 /*
2792 * Host command service checking. This handles commands or messages
2793 * coming from the slave to the host. Must have board shared memory
2794 * enabled and interrupts off when called. Notice that by servicing the
2795 * read data last we don't need to change the shared memory pointer
2796 * during processing (which is a slow IO operation).
2797 * Return value indicates if this port is still awaiting actions from
2798 * the slave (like open, command, or even TX data being sent). If 0
2799 * then port is still busy, otherwise no longer busy.
2800 */
2801
2802 static int stli_hostcmd(stlibrd_t *brdp, stliport_t *portp)
2803 {
2804 volatile cdkasy_t *ap;
2805 volatile cdkctrl_t *cp;
2806 struct tty_struct *tty;
2807 asynotify_t nt;
2808 unsigned long oldsigs;
2809 int rc, donerx;
2810
2811 #ifdef DEBUG
2812 printk(KERN_DEBUG "stli_hostcmd(brdp=%x,channr=%d)\n",
2813 (int) brdp, channr);
2814 #endif
2815
2816 ap = (volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr);
2817 cp = &ap->ctrl;
2818
2819 /*
2820 * Check if we are waiting for an open completion message.
2821 */
2822 if (test_bit(ST_OPENING, &portp->state)) {
2823 rc = (int) cp->openarg;
2824 if ((cp->open == 0) && (rc != 0)) {
2825 if (rc > 0)
2826 rc--;
2827 cp->openarg = 0;
2828 portp->rc = rc;
2829 clear_bit(ST_OPENING, &portp->state);
2830 wake_up_interruptible(&portp->raw_wait);
2831 }
2832 }
2833
2834 /*
2835 * Check if we are waiting for a close completion message.
2836 */
2837 if (test_bit(ST_CLOSING, &portp->state)) {
2838 rc = (int) cp->closearg;
2839 if ((cp->close == 0) && (rc != 0)) {
2840 if (rc > 0)
2841 rc--;
2842 cp->closearg = 0;
2843 portp->rc = rc;
2844 clear_bit(ST_CLOSING, &portp->state);
2845 wake_up_interruptible(&portp->raw_wait);
2846 }
2847 }
2848
2849 /*
2850 * Check if we are waiting for a command completion message. We may
2851 * need to copy out the command results associated with this command.
2852 */
2853 if (test_bit(ST_CMDING, &portp->state)) {
2854 rc = cp->status;
2855 if ((cp->cmd == 0) && (rc != 0)) {
2856 if (rc > 0)
2857 rc--;
2858 if (portp->argp != (void *) NULL) {
2859 memcpy(portp->argp, (void *) &(cp->args[0]),
2860 portp->argsize);
2861 portp->argp = (void *) NULL;
2862 }
2863 cp->status = 0;
2864 portp->rc = rc;
2865 clear_bit(ST_CMDING, &portp->state);
2866 stli_dodelaycmd(portp, cp);
2867 wake_up_interruptible(&portp->raw_wait);
2868 }
2869 }
2870
2871 /*
2872 * Check for any notification messages ready. This includes lots of
2873 * different types of events - RX chars ready, RX break received,
2874 * TX data low or empty in the slave, modem signals changed state.
2875 */
2876 donerx = 0;
2877
2878 if (ap->notify) {
2879 nt = ap->changed;
2880 ap->notify = 0;
2881 tty = portp->tty;
2882
2883 if (nt.signal & SG_DCD) {
2884 oldsigs = portp->sigs;
2885 portp->sigs = stli_mktiocm(nt.sigvalue);
2886 clear_bit(ST_GETSIGS, &portp->state);
2887 if ((portp->sigs & TIOCM_CD) &&
2888 ((oldsigs & TIOCM_CD) == 0))
2889 wake_up_interruptible(&portp->open_wait);
2890 if ((oldsigs & TIOCM_CD) &&
2891 ((portp->sigs & TIOCM_CD) == 0)) {
2892 if (portp->flags & ASYNC_CHECK_CD) {
2893 if (tty)
2894 schedule_work(&portp->tqhangup);
2895 }
2896 }
2897 }
2898
2899 if (nt.data & DT_TXEMPTY)
2900 clear_bit(ST_TXBUSY, &portp->state);
2901 if (nt.data & (DT_TXEMPTY | DT_TXLOW)) {
2902 if (tty != (struct tty_struct *) NULL) {
2903 if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
2904 tty->ldisc.write_wakeup) {
2905 (tty->ldisc.write_wakeup)(tty);
2906 EBRDENABLE(brdp);
2907 }
2908 wake_up_interruptible(&tty->write_wait);
2909 }
2910 }
2911
2912 if ((nt.data & DT_RXBREAK) && (portp->rxmarkmsk & BRKINT)) {
2913 if (tty != (struct tty_struct *) NULL) {
2914 if (tty->flip.count < TTY_FLIPBUF_SIZE) {
2915 tty->flip.count++;
2916 *tty->flip.flag_buf_ptr++ = TTY_BREAK;
2917 *tty->flip.char_buf_ptr++ = 0;
2918 if (portp->flags & ASYNC_SAK) {
2919 do_SAK(tty);
2920 EBRDENABLE(brdp);
2921 }
2922 tty_schedule_flip(tty);
2923 }
2924 }
2925 }
2926
2927 if (nt.data & DT_RXBUSY) {
2928 donerx++;
2929 stli_read(brdp, portp);
2930 }
2931 }
2932
2933 /*
2934 * It might seem odd that we are checking for more RX chars here.
2935 * But, we need to handle the case where the tty buffer was previously
2936 * filled, but we had more characters to pass up. The slave will not
2937 * send any more RX notify messages until the RX buffer has been emptied.
2938 * But it will leave the service bits on (since the buffer is not empty).
2939 * So from here we can try to process more RX chars.
2940 */
2941 if ((!donerx) && test_bit(ST_RXING, &portp->state)) {
2942 clear_bit(ST_RXING, &portp->state);
2943 stli_read(brdp, portp);
2944 }
2945
2946 return((test_bit(ST_OPENING, &portp->state) ||
2947 test_bit(ST_CLOSING, &portp->state) ||
2948 test_bit(ST_CMDING, &portp->state) ||
2949 test_bit(ST_TXBUSY, &portp->state) ||
2950 test_bit(ST_RXING, &portp->state)) ? 0 : 1);
2951 }
2952
2953 /*****************************************************************************/
2954
2955 /*
2956 * Service all ports on a particular board. Assumes that the boards
2957 * shared memory is enabled, and that the page pointer is pointed
2958 * at the cdk header structure.
2959 */
2960
2961 static void stli_brdpoll(stlibrd_t *brdp, volatile cdkhdr_t *hdrp)
2962 {
2963 stliport_t *portp;
2964 unsigned char hostbits[(STL_MAXCHANS / 8) + 1];
2965 unsigned char slavebits[(STL_MAXCHANS / 8) + 1];
2966 unsigned char *slavep;
2967 int bitpos, bitat, bitsize;
2968 int channr, nrdevs, slavebitchange;
2969
2970 bitsize = brdp->bitsize;
2971 nrdevs = brdp->nrdevs;
2972
2973 /*
2974 * Check if slave wants any service. Basically we try to do as
2975 * little work as possible here. There are 2 levels of service
2976 * bits. So if there is nothing to do we bail early. We check
2977 * 8 service bits at a time in the inner loop, so we can bypass
2978 * the lot if none of them want service.
2979 */
2980 memcpy(&hostbits[0], (((unsigned char *) hdrp) + brdp->hostoffset),
2981 bitsize);
2982
2983 memset(&slavebits[0], 0, bitsize);
2984 slavebitchange = 0;
2985
2986 for (bitpos = 0; (bitpos < bitsize); bitpos++) {
2987 if (hostbits[bitpos] == 0)
2988 continue;
2989 channr = bitpos * 8;
2990 for (bitat = 0x1; (channr < nrdevs); channr++, bitat <<= 1) {
2991 if (hostbits[bitpos] & bitat) {
2992 portp = brdp->ports[(channr - 1)];
2993 if (stli_hostcmd(brdp, portp)) {
2994 slavebitchange++;
2995 slavebits[bitpos] |= bitat;
2996 }
2997 }
2998 }
2999 }
3000
3001 /*
3002 * If any of the ports are no longer busy then update them in the
3003 * slave request bits. We need to do this after, since a host port
3004 * service may initiate more slave requests.
3005 */
3006 if (slavebitchange) {
3007 hdrp = (volatile cdkhdr_t *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
3008 slavep = ((unsigned char *) hdrp) + brdp->slaveoffset;
3009 for (bitpos = 0; (bitpos < bitsize); bitpos++) {
3010 if (slavebits[bitpos])
3011 slavep[bitpos] &= ~slavebits[bitpos];
3012 }
3013 }
3014 }
3015
3016 /*****************************************************************************/
3017
3018 /*
3019 * Driver poll routine. This routine polls the boards in use and passes
3020 * messages back up to host when necessary. This is actually very
3021 * CPU efficient, since we will always have the kernel poll clock, it
3022 * adds only a few cycles when idle (since board service can be
3023 * determined very easily), but when loaded generates no interrupts
3024 * (with their expensive associated context change).
3025 */
3026
3027 static void stli_poll(unsigned long arg)
3028 {
3029 volatile cdkhdr_t *hdrp;
3030 stlibrd_t *brdp;
3031 int brdnr;
3032
3033 stli_timerlist.expires = STLI_TIMEOUT;
3034 add_timer(&stli_timerlist);
3035
3036 /*
3037 * Check each board and do any servicing required.
3038 */
3039 for (brdnr = 0; (brdnr < stli_nrbrds); brdnr++) {
3040 brdp = stli_brds[brdnr];
3041 if (brdp == (stlibrd_t *) NULL)
3042 continue;
3043 if ((brdp->state & BST_STARTED) == 0)
3044 continue;
3045
3046 EBRDENABLE(brdp);
3047 hdrp = (volatile cdkhdr_t *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
3048 if (hdrp->hostreq)
3049 stli_brdpoll(brdp, hdrp);
3050 EBRDDISABLE(brdp);
3051 }
3052 }
3053
3054 /*****************************************************************************/
3055
3056 /*
3057 * Translate the termios settings into the port setting structure of
3058 * the slave.
3059 */
3060
3061 static void stli_mkasyport(stliport_t *portp, asyport_t *pp, struct termios *tiosp)
3062 {
3063 #ifdef DEBUG
3064 printk(KERN_DEBUG "stli_mkasyport(portp=%x,pp=%x,tiosp=%d)\n",
3065 (int) portp, (int) pp, (int) tiosp);
3066 #endif
3067
3068 memset(pp, 0, sizeof(asyport_t));
3069
3070 /*
3071 * Start of by setting the baud, char size, parity and stop bit info.
3072 */
3073 pp->baudout = tiosp->c_cflag & CBAUD;
3074 if (pp->baudout & CBAUDEX) {
3075 pp->baudout &= ~CBAUDEX;
3076 if ((pp->baudout < 1) || (pp->baudout > 4))
3077 tiosp->c_cflag &= ~CBAUDEX;
3078 else
3079 pp->baudout += 15;
3080 }
3081 pp->baudout = stli_baudrates[pp->baudout];
3082 if ((tiosp->c_cflag & CBAUD) == B38400) {
3083 if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
3084 pp->baudout = 57600;
3085 else if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
3086 pp->baudout = 115200;
3087 else if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI)
3088 pp->baudout = 230400;
3089 else if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP)
3090 pp->baudout = 460800;
3091 else if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)
3092 pp->baudout = (portp->baud_base / portp->custom_divisor);
3093 }
3094 if (pp->baudout > STL_MAXBAUD)
3095 pp->baudout = STL_MAXBAUD;
3096 pp->baudin = pp->baudout;
3097
3098 switch (tiosp->c_cflag & CSIZE) {
3099 case CS5:
3100 pp->csize = 5;
3101 break;
3102 case CS6:
3103 pp->csize = 6;
3104 break;
3105 case CS7:
3106 pp->csize = 7;
3107 break;
3108 default:
3109 pp->csize = 8;
3110 break;
3111 }
3112
3113 if (tiosp->c_cflag & CSTOPB)
3114 pp->stopbs = PT_STOP2;
3115 else
3116 pp->stopbs = PT_STOP1;
3117
3118 if (tiosp->c_cflag & PARENB) {
3119 if (tiosp->c_cflag & PARODD)
3120 pp->parity = PT_ODDPARITY;
3121 else
3122 pp->parity = PT_EVENPARITY;
3123 } else {
3124 pp->parity = PT_NOPARITY;
3125 }
3126
3127 /*
3128 * Set up any flow control options enabled.
3129 */
3130 if (tiosp->c_iflag & IXON) {
3131 pp->flow |= F_IXON;
3132 if (tiosp->c_iflag & IXANY)
3133 pp->flow |= F_IXANY;
3134 }
3135 if (tiosp->c_cflag & CRTSCTS)
3136 pp->flow |= (F_RTSFLOW | F_CTSFLOW);
3137
3138 pp->startin = tiosp->c_cc[VSTART];
3139 pp->stopin = tiosp->c_cc[VSTOP];
3140 pp->startout = tiosp->c_cc[VSTART];
3141 pp->stopout = tiosp->c_cc[VSTOP];
3142
3143 /*
3144 * Set up the RX char marking mask with those RX error types we must
3145 * catch. We can get the slave to help us out a little here, it will
3146 * ignore parity errors and breaks for us, and mark parity errors in
3147 * the data stream.
3148 */
3149 if (tiosp->c_iflag & IGNPAR)
3150 pp->iflag |= FI_IGNRXERRS;
3151 if (tiosp->c_iflag & IGNBRK)
3152 pp->iflag |= FI_IGNBREAK;
3153
3154 portp->rxmarkmsk = 0;
3155 if (tiosp->c_iflag & (INPCK | PARMRK))
3156 pp->iflag |= FI_1MARKRXERRS;
3157 if (tiosp->c_iflag & BRKINT)
3158 portp->rxmarkmsk |= BRKINT;
3159
3160 /*
3161 * Set up clocal processing as required.
3162 */
3163 if (tiosp->c_cflag & CLOCAL)
3164 portp->flags &= ~ASYNC_CHECK_CD;
3165 else
3166 portp->flags |= ASYNC_CHECK_CD;
3167
3168 /*
3169 * Transfer any persistent flags into the asyport structure.
3170 */
3171 pp->pflag = (portp->pflag & 0xffff);
3172 pp->vmin = (portp->pflag & P_RXIMIN) ? 1 : 0;
3173 pp->vtime = (portp->pflag & P_RXITIME) ? 1 : 0;
3174 pp->cc[1] = (portp->pflag & P_RXTHOLD) ? 1 : 0;
3175 }
3176
3177 /*****************************************************************************/
3178
3179 /*
3180 * Construct a slave signals structure for setting the DTR and RTS
3181 * signals as specified.
3182 */
3183
3184 static void stli_mkasysigs(asysigs_t *sp, int dtr, int rts)
3185 {
3186 #ifdef DEBUG
3187 printk(KERN_DEBUG "stli_mkasysigs(sp=%x,dtr=%d,rts=%d)\n",
3188 (int) sp, dtr, rts);
3189 #endif
3190
3191 memset(sp, 0, sizeof(asysigs_t));
3192 if (dtr >= 0) {
3193 sp->signal |= SG_DTR;
3194 sp->sigvalue |= ((dtr > 0) ? SG_DTR : 0);
3195 }
3196 if (rts >= 0) {
3197 sp->signal |= SG_RTS;
3198 sp->sigvalue |= ((rts > 0) ? SG_RTS : 0);
3199 }
3200 }
3201
3202 /*****************************************************************************/
3203
3204 /*
3205 * Convert the signals returned from the slave into a local TIOCM type
3206 * signals value. We keep them locally in TIOCM format.
3207 */
3208
3209 static long stli_mktiocm(unsigned long sigvalue)
3210 {
3211 long tiocm;
3212
3213 #ifdef DEBUG
3214 printk(KERN_DEBUG "stli_mktiocm(sigvalue=%x)\n", (int) sigvalue);
3215 #endif
3216
3217 tiocm = 0;
3218 tiocm |= ((sigvalue & SG_DCD) ? TIOCM_CD : 0);
3219 tiocm |= ((sigvalue & SG_CTS) ? TIOCM_CTS : 0);
3220 tiocm |= ((sigvalue & SG_RI) ? TIOCM_RI : 0);
3221 tiocm |= ((sigvalue & SG_DSR) ? TIOCM_DSR : 0);
3222 tiocm |= ((sigvalue & SG_DTR) ? TIOCM_DTR : 0);
3223 tiocm |= ((sigvalue & SG_RTS) ? TIOCM_RTS : 0);
3224 return(tiocm);
3225 }
3226
3227 /*****************************************************************************/
3228
3229 /*
3230 * All panels and ports actually attached have been worked out. All
3231 * we need to do here is set up the appropriate per port data structures.
3232 */
3233
3234 static int stli_initports(stlibrd_t *brdp)
3235 {
3236 stliport_t *portp;
3237 int i, panelnr, panelport;
3238
3239 #ifdef DEBUG
3240 printk(KERN_DEBUG "stli_initports(brdp=%x)\n", (int) brdp);
3241 #endif
3242
3243 for (i = 0, panelnr = 0, panelport = 0; (i < brdp->nrports); i++) {
3244 portp = (stliport_t *) stli_memalloc(sizeof(stliport_t));
3245 if (portp == (stliport_t *) NULL) {
3246 printk("STALLION: failed to allocate port structure\n");
3247 continue;
3248 }
3249
3250 memset(portp, 0, sizeof(stliport_t));
3251 portp->magic = STLI_PORTMAGIC;
3252 portp->portnr = i;
3253 portp->brdnr = brdp->brdnr;
3254 portp->panelnr = panelnr;
3255 portp->baud_base = STL_BAUDBASE;
3256 portp->close_delay = STL_CLOSEDELAY;
3257 portp->closing_wait = 30 * HZ;
3258 INIT_WORK(&portp->tqhangup, stli_dohangup, portp);
3259 init_waitqueue_head(&portp->open_wait);
3260 init_waitqueue_head(&portp->close_wait);
3261 init_waitqueue_head(&portp->raw_wait);
3262 panelport++;
3263 if (panelport >= brdp->panels[panelnr]) {
3264 panelport = 0;
3265 panelnr++;
3266 }
3267 brdp->ports[i] = portp;
3268 }
3269
3270 return(0);
3271 }
3272
3273 /*****************************************************************************/
3274
3275 /*
3276 * All the following routines are board specific hardware operations.
3277 */
3278
3279 static void stli_ecpinit(stlibrd_t *brdp)
3280 {
3281 unsigned long memconf;
3282
3283 #ifdef DEBUG
3284 printk(KERN_DEBUG "stli_ecpinit(brdp=%d)\n", (int) brdp);
3285 #endif
3286
3287 outb(ECP_ATSTOP, (brdp->iobase + ECP_ATCONFR));
3288 udelay(10);
3289 outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR));
3290 udelay(100);
3291
3292 memconf = (brdp->memaddr & ECP_ATADDRMASK) >> ECP_ATADDRSHFT;
3293 outb(memconf, (brdp->iobase + ECP_ATMEMAR));
3294 }
3295
3296 /*****************************************************************************/
3297
3298 static void stli_ecpenable(stlibrd_t *brdp)
3299 {
3300 #ifdef DEBUG
3301 printk(KERN_DEBUG "stli_ecpenable(brdp=%x)\n", (int) brdp);
3302 #endif
3303 outb(ECP_ATENABLE, (brdp->iobase + ECP_ATCONFR));
3304 }
3305
3306 /*****************************************************************************/
3307
3308 static void stli_ecpdisable(stlibrd_t *brdp)
3309 {
3310 #ifdef DEBUG
3311 printk(KERN_DEBUG "stli_ecpdisable(brdp=%x)\n", (int) brdp);
3312 #endif
3313 outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR));
3314 }
3315
3316 /*****************************************************************************/
3317
3318 static char *stli_ecpgetmemptr(stlibrd_t *brdp, unsigned long offset, int line)
3319 {
3320 void *ptr;
3321 unsigned char val;
3322
3323 #ifdef DEBUG
3324 printk(KERN_DEBUG "stli_ecpgetmemptr(brdp=%x,offset=%x)\n", (int) brdp,
3325 (int) offset);
3326 #endif
3327
3328 if (offset > brdp->memsize) {
3329 printk(KERN_ERR "STALLION: shared memory pointer=%x out of "
3330 "range at line=%d(%d), brd=%d\n",
3331 (int) offset, line, __LINE__, brdp->brdnr);
3332 ptr = NULL;
3333 val = 0;
3334 } else {
3335 ptr = brdp->membase + (offset % ECP_ATPAGESIZE);
3336 val = (unsigned char) (offset / ECP_ATPAGESIZE);
3337 }
3338 outb(val, (brdp->iobase + ECP_ATMEMPR));
3339 return(ptr);
3340 }
3341
3342 /*****************************************************************************/
3343
3344 static void stli_ecpreset(stlibrd_t *brdp)
3345 {
3346 #ifdef DEBUG
3347 printk(KERN_DEBUG "stli_ecpreset(brdp=%x)\n", (int) brdp);
3348 #endif
3349
3350 outb(ECP_ATSTOP, (brdp->iobase + ECP_ATCONFR));
3351 udelay(10);
3352 outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR));
3353 udelay(500);
3354 }
3355
3356 /*****************************************************************************/
3357
3358 static void stli_ecpintr(stlibrd_t *brdp)
3359 {
3360 #ifdef DEBUG
3361 printk(KERN_DEBUG "stli_ecpintr(brdp=%x)\n", (int) brdp);
3362 #endif
3363 outb(0x1, brdp->iobase);
3364 }
3365
3366 /*****************************************************************************/
3367
3368 /*
3369 * The following set of functions act on ECP EISA boards.
3370 */
3371
3372 static void stli_ecpeiinit(stlibrd_t *brdp)
3373 {
3374 unsigned long memconf;
3375
3376 #ifdef DEBUG
3377 printk(KERN_DEBUG "stli_ecpeiinit(brdp=%x)\n", (int) brdp);
3378 #endif
3379
3380 outb(0x1, (brdp->iobase + ECP_EIBRDENAB));
3381 outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR));
3382 udelay(10);
3383 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
3384 udelay(500);
3385
3386 memconf = (brdp->memaddr & ECP_EIADDRMASKL) >> ECP_EIADDRSHFTL;
3387 outb(memconf, (brdp->iobase + ECP_EIMEMARL));
3388 memconf = (brdp->memaddr & ECP_EIADDRMASKH) >> ECP_EIADDRSHFTH;
3389 outb(memconf, (brdp->iobase + ECP_EIMEMARH));
3390 }
3391
3392 /*****************************************************************************/
3393
3394 static void stli_ecpeienable(stlibrd_t *brdp)
3395 {
3396 outb(ECP_EIENABLE, (brdp->iobase + ECP_EICONFR));
3397 }
3398
3399 /*****************************************************************************/
3400
3401 static void stli_ecpeidisable(stlibrd_t *brdp)
3402 {
3403 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
3404 }
3405
3406 /*****************************************************************************/
3407
3408 static char *stli_ecpeigetmemptr(stlibrd_t *brdp, unsigned long offset, int line)
3409 {
3410 void *ptr;
3411 unsigned char val;
3412
3413 #ifdef DEBUG
3414 printk(KERN_DEBUG "stli_ecpeigetmemptr(brdp=%x,offset=%x,line=%d)\n",
3415 (int) brdp, (int) offset, line);
3416 #endif
3417
3418 if (offset > brdp->memsize) {
3419 printk(KERN_ERR "STALLION: shared memory pointer=%x out of "
3420 "range at line=%d(%d), brd=%d\n",
3421 (int) offset, line, __LINE__, brdp->brdnr);
3422 ptr = NULL;
3423 val = 0;
3424 } else {
3425 ptr = brdp->membase + (offset % ECP_EIPAGESIZE);
3426 if (offset < ECP_EIPAGESIZE)
3427 val = ECP_EIENABLE;
3428 else
3429 val = ECP_EIENABLE | 0x40;
3430 }
3431 outb(val, (brdp->iobase + ECP_EICONFR));
3432 return(ptr);
3433 }
3434
3435 /*****************************************************************************/
3436
3437 static void stli_ecpeireset(stlibrd_t *brdp)
3438 {
3439 outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR));
3440 udelay(10);
3441 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
3442 udelay(500);
3443 }
3444
3445 /*****************************************************************************/
3446
3447 /*
3448 * The following set of functions act on ECP MCA boards.
3449 */
3450
3451 static void stli_ecpmcenable(stlibrd_t *brdp)
3452 {
3453 outb(ECP_MCENABLE, (brdp->iobase + ECP_MCCONFR));
3454 }
3455
3456 /*****************************************************************************/
3457
3458 static void stli_ecpmcdisable(stlibrd_t *brdp)
3459 {
3460 outb(ECP_MCDISABLE, (brdp->iobase + ECP_MCCONFR));
3461 }
3462
3463 /*****************************************************************************/
3464
3465 static char *stli_ecpmcgetmemptr(stlibrd_t *brdp, unsigned long offset, int line)
3466 {
3467 void *ptr;
3468 unsigned char val;
3469
3470 if (offset > brdp->memsize) {
3471 printk(KERN_ERR "STALLION: shared memory pointer=%x out of "
3472 "range at line=%d(%d), brd=%d\n",
3473 (int) offset, line, __LINE__, brdp->brdnr);
3474 ptr = NULL;
3475 val = 0;
3476 } else {
3477 ptr = brdp->membase + (offset % ECP_MCPAGESIZE);
3478 val = ((unsigned char) (offset / ECP_MCPAGESIZE)) | ECP_MCENABLE;
3479 }
3480 outb(val, (brdp->iobase + ECP_MCCONFR));
3481 return(ptr);
3482 }
3483
3484 /*****************************************************************************/
3485
3486 static void stli_ecpmcreset(stlibrd_t *brdp)
3487 {
3488 outb(ECP_MCSTOP, (brdp->iobase + ECP_MCCONFR));
3489 udelay(10);
3490 outb(ECP_MCDISABLE, (brdp->iobase + ECP_MCCONFR));
3491 udelay(500);
3492 }
3493
3494 /*****************************************************************************/
3495
3496 /*
3497 * The following set of functions act on ECP PCI boards.
3498 */
3499
3500 static void stli_ecppciinit(stlibrd_t *brdp)
3501 {
3502 #ifdef DEBUG
3503 printk(KERN_DEBUG "stli_ecppciinit(brdp=%x)\n", (int) brdp);
3504 #endif
3505
3506 outb(ECP_PCISTOP, (brdp->iobase + ECP_PCICONFR));
3507 udelay(10);
3508 outb(0, (brdp->iobase + ECP_PCICONFR));
3509 udelay(500);
3510 }
3511
3512 /*****************************************************************************/
3513
3514 static char *stli_ecppcigetmemptr(stlibrd_t *brdp, unsigned long offset, int line)
3515 {
3516 void *ptr;
3517 unsigned char val;
3518
3519 #ifdef DEBUG
3520 printk(KERN_DEBUG "stli_ecppcigetmemptr(brdp=%x,offset=%x,line=%d)\n",
3521 (int) brdp, (int) offset, line);
3522 #endif
3523
3524 if (offset > brdp->memsize) {
3525 printk(KERN_ERR "STALLION: shared memory pointer=%x out of "
3526 "range at line=%d(%d), board=%d\n",
3527 (int) offset, line, __LINE__, brdp->brdnr);
3528 ptr = NULL;
3529 val = 0;
3530 } else {
3531 ptr = brdp->membase + (offset % ECP_PCIPAGESIZE);
3532 val = (offset / ECP_PCIPAGESIZE) << 1;
3533 }
3534 outb(val, (brdp->iobase + ECP_PCICONFR));
3535 return(ptr);
3536 }
3537
3538 /*****************************************************************************/
3539
3540 static void stli_ecppcireset(stlibrd_t *brdp)
3541 {
3542 outb(ECP_PCISTOP, (brdp->iobase + ECP_PCICONFR));
3543 udelay(10);
3544 outb(0, (brdp->iobase + ECP_PCICONFR));
3545 udelay(500);
3546 }
3547
3548 /*****************************************************************************/
3549
3550 /*
3551 * The following routines act on ONboards.
3552 */
3553
3554 static void stli_onbinit(stlibrd_t *brdp)
3555 {
3556 unsigned long memconf;
3557
3558 #ifdef DEBUG
3559 printk(KERN_DEBUG "stli_onbinit(brdp=%d)\n", (int) brdp);
3560 #endif
3561
3562 outb(ONB_ATSTOP, (brdp->iobase + ONB_ATCONFR));
3563 udelay(10);
3564 outb(ONB_ATDISABLE, (brdp->iobase + ONB_ATCONFR));
3565 mdelay(1000);
3566
3567 memconf = (brdp->memaddr & ONB_ATADDRMASK) >> ONB_ATADDRSHFT;
3568 outb(memconf, (brdp->iobase + ONB_ATMEMAR));
3569 outb(0x1, brdp->iobase);
3570 mdelay(1);
3571 }
3572
3573 /*****************************************************************************/
3574
3575 static void stli_onbenable(stlibrd_t *brdp)
3576 {
3577 #ifdef DEBUG
3578 printk(KERN_DEBUG "stli_onbenable(brdp=%x)\n", (int) brdp);
3579 #endif
3580 outb((brdp->enabval | ONB_ATENABLE), (brdp->iobase + ONB_ATCONFR));
3581 }
3582
3583 /*****************************************************************************/
3584
3585 static void stli_onbdisable(stlibrd_t *brdp)
3586 {
3587 #ifdef DEBUG
3588 printk(KERN_DEBUG "stli_onbdisable(brdp=%x)\n", (int) brdp);
3589 #endif
3590 outb((brdp->enabval | ONB_ATDISABLE), (brdp->iobase + ONB_ATCONFR));
3591 }
3592
3593 /*****************************************************************************/
3594
3595 static char *stli_onbgetmemptr(stlibrd_t *brdp, unsigned long offset, int line)
3596 {
3597 void *ptr;
3598
3599 #ifdef DEBUG
3600 printk(KERN_DEBUG "stli_onbgetmemptr(brdp=%x,offset=%x)\n", (int) brdp,
3601 (int) offset);
3602 #endif
3603
3604 if (offset > brdp->memsize) {
3605 printk(KERN_ERR "STALLION: shared memory pointer=%x out of "
3606 "range at line=%d(%d), brd=%d\n",
3607 (int) offset, line, __LINE__, brdp->brdnr);
3608 ptr = NULL;
3609 } else {
3610 ptr = brdp->membase + (offset % ONB_ATPAGESIZE);
3611 }
3612 return(ptr);
3613 }
3614
3615 /*****************************************************************************/
3616
3617 static void stli_onbreset(stlibrd_t *brdp)
3618 {
3619
3620 #ifdef DEBUG
3621 printk(KERN_DEBUG "stli_onbreset(brdp=%x)\n", (int) brdp);
3622 #endif
3623
3624 outb(ONB_ATSTOP, (brdp->iobase + ONB_ATCONFR));
3625 udelay(10);
3626 outb(ONB_ATDISABLE, (brdp->iobase + ONB_ATCONFR));
3627 mdelay(1000);
3628 }
3629
3630 /*****************************************************************************/
3631
3632 /*
3633 * The following routines act on ONboard EISA.
3634 */
3635
3636 static void stli_onbeinit(stlibrd_t *brdp)
3637 {
3638 unsigned long memconf;
3639
3640 #ifdef DEBUG
3641 printk(KERN_DEBUG "stli_onbeinit(brdp=%d)\n", (int) brdp);
3642 #endif
3643
3644 outb(0x1, (brdp->iobase + ONB_EIBRDENAB));
3645 outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR));
3646 udelay(10);
3647 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
3648 mdelay(1000);
3649
3650 memconf = (brdp->memaddr & ONB_EIADDRMASKL) >> ONB_EIADDRSHFTL;
3651 outb(memconf, (brdp->iobase + ONB_EIMEMARL));
3652 memconf = (brdp->memaddr & ONB_EIADDRMASKH) >> ONB_EIADDRSHFTH;
3653 outb(memconf, (brdp->iobase + ONB_EIMEMARH));
3654 outb(0x1, brdp->iobase);
3655 mdelay(1);
3656 }
3657
3658 /*****************************************************************************/
3659
3660 static void stli_onbeenable(stlibrd_t *brdp)
3661 {
3662 #ifdef DEBUG
3663 printk(KERN_DEBUG "stli_onbeenable(brdp=%x)\n", (int) brdp);
3664 #endif
3665 outb(ONB_EIENABLE, (brdp->iobase + ONB_EICONFR));
3666 }
3667
3668 /*****************************************************************************/
3669
3670 static void stli_onbedisable(stlibrd_t *brdp)
3671 {
3672 #ifdef DEBUG
3673 printk(KERN_DEBUG "stli_onbedisable(brdp=%x)\n", (int) brdp);
3674 #endif
3675 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
3676 }
3677
3678 /*****************************************************************************/
3679
3680 static char *stli_onbegetmemptr(stlibrd_t *brdp, unsigned long offset, int line)
3681 {
3682 void *ptr;
3683 unsigned char val;
3684
3685 #ifdef DEBUG
3686 printk(KERN_DEBUG "stli_onbegetmemptr(brdp=%x,offset=%x,line=%d)\n",
3687 (int) brdp, (int) offset, line);
3688 #endif
3689
3690 if (offset > brdp->memsize) {
3691 printk(KERN_ERR "STALLION: shared memory pointer=%x out of "
3692 "range at line=%d(%d), brd=%d\n",
3693 (int) offset, line, __LINE__, brdp->brdnr);
3694 ptr = NULL;
3695 val = 0;
3696 } else {
3697 ptr = brdp->membase + (offset % ONB_EIPAGESIZE);
3698 if (offset < ONB_EIPAGESIZE)
3699 val = ONB_EIENABLE;
3700 else
3701 val = ONB_EIENABLE | 0x40;
3702 }
3703 outb(val, (brdp->iobase + ONB_EICONFR));
3704 return(ptr);
3705 }
3706
3707 /*****************************************************************************/
3708
3709 static void stli_onbereset(stlibrd_t *brdp)
3710 {
3711
3712 #ifdef DEBUG
3713 printk(KERN_ERR "stli_onbereset(brdp=%x)\n", (int) brdp);
3714 #endif
3715
3716 outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR));
3717 udelay(10);
3718 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
3719 mdelay(1000);
3720 }
3721
3722 /*****************************************************************************/
3723
3724 /*
3725 * The following routines act on Brumby boards.
3726 */
3727
3728 static void stli_bbyinit(stlibrd_t *brdp)
3729 {
3730
3731 #ifdef DEBUG
3732 printk(KERN_ERR "stli_bbyinit(brdp=%d)\n", (int) brdp);
3733 #endif
3734
3735 outb(BBY_ATSTOP, (brdp->iobase + BBY_ATCONFR));
3736 udelay(10);
3737 outb(0, (brdp->iobase + BBY_ATCONFR));
3738 mdelay(1000);
3739 outb(0x1, brdp->iobase);
3740 mdelay(1);
3741 }
3742
3743 /*****************************************************************************/
3744
3745 static char *stli_bbygetmemptr(stlibrd_t *brdp, unsigned long offset, int line)
3746 {
3747 void *ptr;
3748 unsigned char val;
3749
3750 #ifdef DEBUG
3751 printk(KERN_ERR "stli_bbygetmemptr(brdp=%x,offset=%x)\n", (int) brdp,
3752 (int) offset);
3753 #endif
3754
3755 if (offset > brdp->memsize) {
3756 printk(KERN_ERR "STALLION: shared memory pointer=%x out of "
3757 "range at line=%d(%d), brd=%d\n",
3758 (int) offset, line, __LINE__, brdp->brdnr);
3759 ptr = NULL;
3760 val = 0;
3761 } else {
3762 ptr = brdp->membase + (offset % BBY_PAGESIZE);
3763 val = (unsigned char) (offset / BBY_PAGESIZE);
3764 }
3765 outb(val, (brdp->iobase + BBY_ATCONFR));
3766 return(ptr);
3767 }
3768
3769 /*****************************************************************************/
3770
3771 static void stli_bbyreset(stlibrd_t *brdp)
3772 {
3773
3774 #ifdef DEBUG
3775 printk(KERN_DEBUG "stli_bbyreset(brdp=%x)\n", (int) brdp);
3776 #endif
3777
3778 outb(BBY_ATSTOP, (brdp->iobase + BBY_ATCONFR));
3779 udelay(10);
3780 outb(0, (brdp->iobase + BBY_ATCONFR));
3781 mdelay(1000);
3782 }
3783
3784 /*****************************************************************************/
3785
3786 /*
3787 * The following routines act on original old Stallion boards.
3788 */
3789
3790 static void stli_stalinit(stlibrd_t *brdp)
3791 {
3792
3793 #ifdef DEBUG
3794 printk(KERN_DEBUG "stli_stalinit(brdp=%d)\n", (int) brdp);
3795 #endif
3796
3797 outb(0x1, brdp->iobase);
3798 mdelay(1000);
3799 }
3800
3801 /*****************************************************************************/
3802
3803 static char *stli_stalgetmemptr(stlibrd_t *brdp, unsigned long offset, int line)
3804 {
3805 void *ptr;
3806
3807 #ifdef DEBUG
3808 printk(KERN_DEBUG "stli_stalgetmemptr(brdp=%x,offset=%x)\n", (int) brdp,
3809 (int) offset);
3810 #endif
3811
3812 if (offset > brdp->memsize) {
3813 printk(KERN_ERR "STALLION: shared memory pointer=%x out of "
3814 "range at line=%d(%d), brd=%d\n",
3815 (int) offset, line, __LINE__, brdp->brdnr);
3816 ptr = NULL;
3817 } else {
3818 ptr = brdp->membase + (offset % STAL_PAGESIZE);
3819 }
3820 return(ptr);
3821 }
3822
3823 /*****************************************************************************/
3824
3825 static void stli_stalreset(stlibrd_t *brdp)
3826 {
3827 volatile unsigned long *vecp;
3828
3829 #ifdef DEBUG
3830 printk(KERN_DEBUG "stli_stalreset(brdp=%x)\n", (int) brdp);
3831 #endif
3832
3833 vecp = (volatile unsigned long *) (brdp->membase + 0x30);
3834 *vecp = 0xffff0000;
3835 outb(0, brdp->iobase);
3836 mdelay(1000);
3837 }
3838
3839 /*****************************************************************************/
3840
3841 /*
3842 * Try to find an ECP board and initialize it. This handles only ECP
3843 * board types.
3844 */
3845
3846 static int stli_initecp(stlibrd_t *brdp)
3847 {
3848 cdkecpsig_t sig;
3849 cdkecpsig_t *sigsp;
3850 unsigned int status, nxtid;
3851 char *name;
3852 int panelnr, nrports;
3853
3854 #ifdef DEBUG
3855 printk(KERN_DEBUG "stli_initecp(brdp=%x)\n", (int) brdp);
3856 #endif
3857
3858 if (!request_region(brdp->iobase, brdp->iosize, "istallion"))
3859 return -EIO;
3860
3861 if ((brdp->iobase == 0) || (brdp->memaddr == 0))
3862 {
3863 release_region(brdp->iobase, brdp->iosize);
3864 return(-ENODEV);
3865 }
3866
3867 brdp->iosize = ECP_IOSIZE;
3868
3869 /*
3870 * Based on the specific board type setup the common vars to access
3871 * and enable shared memory. Set all board specific information now
3872 * as well.
3873 */
3874 switch (brdp->brdtype) {
3875 case BRD_ECP:
3876 brdp->membase = (void *) brdp->memaddr;
3877 brdp->memsize = ECP_MEMSIZE;
3878 brdp->pagesize = ECP_ATPAGESIZE;
3879 brdp->init = stli_ecpinit;
3880 brdp->enable = stli_ecpenable;
3881 brdp->reenable = stli_ecpenable;
3882 brdp->disable = stli_ecpdisable;
3883 brdp->getmemptr = stli_ecpgetmemptr;
3884 brdp->intr = stli_ecpintr;
3885 brdp->reset = stli_ecpreset;
3886 name = "serial(EC8/64)";
3887 break;
3888
3889 case BRD_ECPE:
3890 brdp->membase = (void *) brdp->memaddr;
3891 brdp->memsize = ECP_MEMSIZE;
3892 brdp->pagesize = ECP_EIPAGESIZE;
3893 brdp->init = stli_ecpeiinit;
3894 brdp->enable = stli_ecpeienable;
3895 brdp->reenable = stli_ecpeienable;
3896 brdp->disable = stli_ecpeidisable;
3897 brdp->getmemptr = stli_ecpeigetmemptr;
3898 brdp->intr = stli_ecpintr;
3899 brdp->reset = stli_ecpeireset;
3900 name = "serial(EC8/64-EI)";
3901 break;
3902
3903 case BRD_ECPMC:
3904 brdp->membase = (void *) brdp->memaddr;
3905 brdp->memsize = ECP_MEMSIZE;
3906 brdp->pagesize = ECP_MCPAGESIZE;
3907 brdp->init = NULL;
3908 brdp->enable = stli_ecpmcenable;
3909 brdp->reenable = stli_ecpmcenable;
3910 brdp->disable = stli_ecpmcdisable;
3911 brdp->getmemptr = stli_ecpmcgetmemptr;
3912 brdp->intr = stli_ecpintr;
3913 brdp->reset = stli_ecpmcreset;
3914 name = "serial(EC8/64-MCA)";
3915 break;
3916
3917 case BRD_ECPPCI:
3918 brdp->membase = (void *) brdp->memaddr;
3919 brdp->memsize = ECP_PCIMEMSIZE;
3920 brdp->pagesize = ECP_PCIPAGESIZE;
3921 brdp->init = stli_ecppciinit;
3922 brdp->enable = NULL;
3923 brdp->reenable = NULL;
3924 brdp->disable = NULL;
3925 brdp->getmemptr = stli_ecppcigetmemptr;
3926 brdp->intr = stli_ecpintr;
3927 brdp->reset = stli_ecppcireset;
3928 name = "serial(EC/RA-PCI)";
3929 break;
3930
3931 default:
3932 release_region(brdp->iobase, brdp->iosize);
3933 return(-EINVAL);
3934 }
3935
3936 /*
3937 * The per-board operations structure is all set up, so now let's go
3938 * and get the board operational. Firstly initialize board configuration
3939 * registers. Set the memory mapping info so we can get at the boards
3940 * shared memory.
3941 */
3942 EBRDINIT(brdp);
3943
3944 brdp->membase = ioremap(brdp->memaddr, brdp->memsize);
3945 if (brdp->membase == (void *) NULL)
3946 {
3947 release_region(brdp->iobase, brdp->iosize);
3948 return(-ENOMEM);
3949 }
3950
3951 /*
3952 * Now that all specific code is set up, enable the shared memory and
3953 * look for the a signature area that will tell us exactly what board
3954 * this is, and what it is connected to it.
3955 */
3956 EBRDENABLE(brdp);
3957 sigsp = (cdkecpsig_t *) EBRDGETMEMPTR(brdp, CDK_SIGADDR);
3958 memcpy(&sig, sigsp, sizeof(cdkecpsig_t));
3959 EBRDDISABLE(brdp);
3960
3961 #if 0
3962 printk("%s(%d): sig-> magic=%x rom=%x panel=%x,%x,%x,%x,%x,%x,%x,%x\n",
3963 __FILE__, __LINE__, (int) sig.magic, sig.romver, sig.panelid[0],
3964 (int) sig.panelid[1], (int) sig.panelid[2],
3965 (int) sig.panelid[3], (int) sig.panelid[4],
3966 (int) sig.panelid[5], (int) sig.panelid[6],
3967 (int) sig.panelid[7]);
3968 #endif
3969
3970 if (sig.magic != ECP_MAGIC)
3971 {
3972 release_region(brdp->iobase, brdp->iosize);
3973 return(-ENODEV);
3974 }
3975
3976 /*
3977 * Scan through the signature looking at the panels connected to the
3978 * board. Calculate the total number of ports as we go.
3979 */
3980 for (panelnr = 0, nxtid = 0; (panelnr < STL_MAXPANELS); panelnr++) {
3981 status = sig.panelid[nxtid];
3982 if ((status & ECH_PNLIDMASK) != nxtid)
3983 break;
3984
3985 brdp->panelids[panelnr] = status;
3986 nrports = (status & ECH_PNL16PORT) ? 16 : 8;
3987 if ((nrports == 16) && ((status & ECH_PNLXPID) == 0))
3988 nxtid++;
3989 brdp->panels[panelnr] = nrports;
3990 brdp->nrports += nrports;
3991 nxtid++;
3992 brdp->nrpanels++;
3993 }
3994
3995
3996 brdp->state |= BST_FOUND;
3997 return(0);
3998 }
3999
4000 /*****************************************************************************/
4001
4002 /*
4003 * Try to find an ONboard, Brumby or Stallion board and initialize it.
4004 * This handles only these board types.
4005 */
4006
4007 static int stli_initonb(stlibrd_t *brdp)
4008 {
4009 cdkonbsig_t sig;
4010 cdkonbsig_t *sigsp;
4011 char *name;
4012 int i;
4013
4014 #ifdef DEBUG
4015 printk(KERN_DEBUG "stli_initonb(brdp=%x)\n", (int) brdp);
4016 #endif
4017
4018 /*
4019 * Do a basic sanity check on the IO and memory addresses.
4020 */
4021 if ((brdp->iobase == 0) || (brdp->memaddr == 0))
4022 return(-ENODEV);
4023
4024 brdp->iosize = ONB_IOSIZE;
4025
4026 if (!request_region(brdp->iobase, brdp->iosize, "istallion"))
4027 return -EIO;
4028
4029 /*
4030 * Based on the specific board type setup the common vars to access
4031 * and enable shared memory. Set all board specific information now
4032 * as well.
4033 */
4034 switch (brdp->brdtype) {
4035 case BRD_ONBOARD:
4036 case BRD_ONBOARD32:
4037 case BRD_ONBOARD2:
4038 case BRD_ONBOARD2_32:
4039 case BRD_ONBOARDRS:
4040 brdp->membase = (void *) brdp->memaddr;
4041 brdp->memsize = ONB_MEMSIZE;
4042 brdp->pagesize = ONB_ATPAGESIZE;
4043 brdp->init = stli_onbinit;
4044 brdp->enable = stli_onbenable;
4045 brdp->reenable = stli_onbenable;
4046 brdp->disable = stli_onbdisable;
4047 brdp->getmemptr = stli_onbgetmemptr;
4048 brdp->intr = stli_ecpintr;
4049 brdp->reset = stli_onbreset;
4050 if (brdp->memaddr > 0x100000)
4051 brdp->enabval = ONB_MEMENABHI;
4052 else
4053 brdp->enabval = ONB_MEMENABLO;
4054 name = "serial(ONBoard)";
4055 break;
4056
4057 case BRD_ONBOARDE:
4058 brdp->membase = (void *) brdp->memaddr;
4059 brdp->memsize = ONB_EIMEMSIZE;
4060 brdp->pagesize = ONB_EIPAGESIZE;
4061 brdp->init = stli_onbeinit;
4062 brdp->enable = stli_onbeenable;
4063 brdp->reenable = stli_onbeenable;
4064 brdp->disable = stli_onbedisable;
4065 brdp->getmemptr = stli_onbegetmemptr;
4066 brdp->intr = stli_ecpintr;
4067 brdp->reset = stli_onbereset;
4068 name = "serial(ONBoard/E)";
4069 break;
4070
4071 case BRD_BRUMBY4:
4072 case BRD_BRUMBY8:
4073 case BRD_BRUMBY16:
4074 brdp->membase = (void *) brdp->memaddr;
4075 brdp->memsize = BBY_MEMSIZE;
4076 brdp->pagesize = BBY_PAGESIZE;
4077 brdp->init = stli_bbyinit;
4078 brdp->enable = NULL;
4079 brdp->reenable = NULL;
4080 brdp->disable = NULL;
4081 brdp->getmemptr = stli_bbygetmemptr;
4082 brdp->intr = stli_ecpintr;
4083 brdp->reset = stli_bbyreset;
4084 name = "serial(Brumby)";
4085 break;
4086
4087 case BRD_STALLION:
4088 brdp->membase = (void *) brdp->memaddr;
4089 brdp->memsize = STAL_MEMSIZE;
4090 brdp->pagesize = STAL_PAGESIZE;
4091 brdp->init = stli_stalinit;
4092 brdp->enable = NULL;
4093 brdp->reenable = NULL;
4094 brdp->disable = NULL;
4095 brdp->getmemptr = stli_stalgetmemptr;
4096 brdp->intr = stli_ecpintr;
4097 brdp->reset = stli_stalreset;
4098 name = "serial(Stallion)";
4099 break;
4100
4101 default:
4102 release_region(brdp->iobase, brdp->iosize);
4103 return(-EINVAL);
4104 }
4105
4106 /*
4107 * The per-board operations structure is all set up, so now let's go
4108 * and get the board operational. Firstly initialize board configuration
4109 * registers. Set the memory mapping info so we can get at the boards
4110 * shared memory.
4111 */
4112 EBRDINIT(brdp);
4113
4114 brdp->membase = ioremap(brdp->memaddr, brdp->memsize);
4115 if (brdp->membase == (void *) NULL)
4116 {
4117 release_region(brdp->iobase, brdp->iosize);
4118 return(-ENOMEM);
4119 }
4120
4121 /*
4122 * Now that all specific code is set up, enable the shared memory and
4123 * look for the a signature area that will tell us exactly what board
4124 * this is, and how many ports.
4125 */
4126 EBRDENABLE(brdp);
4127 sigsp = (cdkonbsig_t *) EBRDGETMEMPTR(brdp, CDK_SIGADDR);
4128 memcpy(&sig, sigsp, sizeof(cdkonbsig_t));
4129 EBRDDISABLE(brdp);
4130
4131 #if 0
4132 printk("%s(%d): sig-> magic=%x:%x:%x:%x romver=%x amask=%x:%x:%x\n",
4133 __FILE__, __LINE__, sig.magic0, sig.magic1, sig.magic2,
4134 sig.magic3, sig.romver, sig.amask0, sig.amask1, sig.amask2);
4135 #endif
4136
4137 if ((sig.magic0 != ONB_MAGIC0) || (sig.magic1 != ONB_MAGIC1) ||
4138 (sig.magic2 != ONB_MAGIC2) || (sig.magic3 != ONB_MAGIC3))
4139 {
4140 release_region(brdp->iobase, brdp->iosize);
4141 return(-ENODEV);
4142 }
4143
4144 /*
4145 * Scan through the signature alive mask and calculate how many ports
4146 * there are on this board.
4147 */
4148 brdp->nrpanels = 1;
4149 if (sig.amask1) {
4150 brdp->nrports = 32;
4151 } else {
4152 for (i = 0; (i < 16); i++) {
4153 if (((sig.amask0 << i) & 0x8000) == 0)
4154 break;
4155 }
4156 brdp->nrports = i;
4157 }
4158 brdp->panels[0] = brdp->nrports;
4159
4160
4161 brdp->state |= BST_FOUND;
4162 return(0);
4163 }
4164
4165 /*****************************************************************************/
4166
4167 /*
4168 * Start up a running board. This routine is only called after the
4169 * code has been down loaded to the board and is operational. It will
4170 * read in the memory map, and get the show on the road...
4171 */
4172
4173 static int stli_startbrd(stlibrd_t *brdp)
4174 {
4175 volatile cdkhdr_t *hdrp;
4176 volatile cdkmem_t *memp;
4177 volatile cdkasy_t *ap;
4178 unsigned long flags;
4179 stliport_t *portp;
4180 int portnr, nrdevs, i, rc;
4181
4182 #ifdef DEBUG
4183 printk(KERN_DEBUG "stli_startbrd(brdp=%x)\n", (int) brdp);
4184 #endif
4185
4186 rc = 0;
4187
4188 save_flags(flags);
4189 cli();
4190 EBRDENABLE(brdp);
4191 hdrp = (volatile cdkhdr_t *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
4192 nrdevs = hdrp->nrdevs;
4193
4194 #if 0
4195 printk("%s(%d): CDK version %d.%d.%d --> "
4196 "nrdevs=%d memp=%x hostp=%x slavep=%x\n",
4197 __FILE__, __LINE__, hdrp->ver_release, hdrp->ver_modification,
4198 hdrp->ver_fix, nrdevs, (int) hdrp->memp, (int) hdrp->hostp,
4199 (int) hdrp->slavep);
4200 #endif
4201
4202 if (nrdevs < (brdp->nrports + 1)) {
4203 printk(KERN_ERR "STALLION: slave failed to allocate memory for "
4204 "all devices, devices=%d\n", nrdevs);
4205 brdp->nrports = nrdevs - 1;
4206 }
4207 brdp->nrdevs = nrdevs;
4208 brdp->hostoffset = hdrp->hostp - CDK_CDKADDR;
4209 brdp->slaveoffset = hdrp->slavep - CDK_CDKADDR;
4210 brdp->bitsize = (nrdevs + 7) / 8;
4211 memp = (volatile cdkmem_t *) hdrp->memp;
4212 if (((unsigned long) memp) > brdp->memsize) {
4213 printk(KERN_ERR "STALLION: corrupted shared memory region?\n");
4214 rc = -EIO;
4215 goto stli_donestartup;
4216 }
4217 memp = (volatile cdkmem_t *) EBRDGETMEMPTR(brdp, (unsigned long) memp);
4218 if (memp->dtype != TYP_ASYNCTRL) {
4219 printk(KERN_ERR "STALLION: no slave control device found\n");
4220 goto stli_donestartup;
4221 }
4222 memp++;
4223
4224 /*
4225 * Cycle through memory allocation of each port. We are guaranteed to
4226 * have all ports inside the first page of slave window, so no need to
4227 * change pages while reading memory map.
4228 */
4229 for (i = 1, portnr = 0; (i < nrdevs); i++, portnr++, memp++) {
4230 if (memp->dtype != TYP_ASYNC)
4231 break;
4232 portp = brdp->ports[portnr];
4233 if (portp == (stliport_t *) NULL)
4234 break;
4235 portp->devnr = i;
4236 portp->addr = memp->offset;
4237 portp->reqbit = (unsigned char) (0x1 << (i * 8 / nrdevs));
4238 portp->portidx = (unsigned char) (i / 8);
4239 portp->portbit = (unsigned char) (0x1 << (i % 8));
4240 }
4241
4242 hdrp->slavereq = 0xff;
4243
4244 /*
4245 * For each port setup a local copy of the RX and TX buffer offsets
4246 * and sizes. We do this separate from the above, because we need to
4247 * move the shared memory page...
4248 */
4249 for (i = 1, portnr = 0; (i < nrdevs); i++, portnr++) {
4250 portp = brdp->ports[portnr];
4251 if (portp == (stliport_t *) NULL)
4252 break;
4253 if (portp->addr == 0)
4254 break;
4255 ap = (volatile cdkasy_t *) EBRDGETMEMPTR(brdp, portp->addr);
4256 if (ap != (volatile cdkasy_t *) NULL) {
4257 portp->rxsize = ap->rxq.size;
4258 portp->txsize = ap->txq.size;
4259 portp->rxoffset = ap->rxq.offset;
4260 portp->txoffset = ap->txq.offset;
4261 }
4262 }
4263
4264 stli_donestartup:
4265 EBRDDISABLE(brdp);
4266 restore_flags(flags);
4267
4268 if (rc == 0)
4269 brdp->state |= BST_STARTED;
4270
4271 if (! stli_timeron) {
4272 stli_timeron++;
4273 stli_timerlist.expires = STLI_TIMEOUT;
4274 add_timer(&stli_timerlist);
4275 }
4276
4277 return(rc);
4278 }
4279
4280 /*****************************************************************************/
4281
4282 /*
4283 * Probe and initialize the specified board.
4284 */
4285
4286 static int __init stli_brdinit(stlibrd_t *brdp)
4287 {
4288 #ifdef DEBUG
4289 printk(KERN_DEBUG "stli_brdinit(brdp=%x)\n", (int) brdp);
4290 #endif
4291
4292 stli_brds[brdp->brdnr] = brdp;
4293
4294 switch (brdp->brdtype) {
4295 case BRD_ECP:
4296 case BRD_ECPE:
4297 case BRD_ECPMC:
4298 case BRD_ECPPCI:
4299 stli_initecp(brdp);
4300 break;
4301 case BRD_ONBOARD:
4302 case BRD_ONBOARDE:
4303 case BRD_ONBOARD2:
4304 case BRD_ONBOARD32:
4305 case BRD_ONBOARD2_32:
4306 case BRD_ONBOARDRS:
4307 case BRD_BRUMBY4:
4308 case BRD_BRUMBY8:
4309 case BRD_BRUMBY16:
4310 case BRD_STALLION:
4311 stli_initonb(brdp);
4312 break;
4313 case BRD_EASYIO:
4314 case BRD_ECH:
4315 case BRD_ECHMC:
4316 case BRD_ECHPCI:
4317 printk(KERN_ERR "STALLION: %s board type not supported in "
4318 "this driver\n", stli_brdnames[brdp->brdtype]);
4319 return(ENODEV);
4320 default:
4321 printk(KERN_ERR "STALLION: board=%d is unknown board "
4322 "type=%d\n", brdp->brdnr, brdp->brdtype);
4323 return(ENODEV);
4324 }
4325
4326 if ((brdp->state & BST_FOUND) == 0) {
4327 printk(KERN_ERR "STALLION: %s board not found, board=%d "
4328 "io=%x mem=%x\n",
4329 stli_brdnames[brdp->brdtype], brdp->brdnr,
4330 brdp->iobase, (int) brdp->memaddr);
4331 return(ENODEV);
4332 }
4333
4334 stli_initports(brdp);
4335 printk(KERN_INFO "STALLION: %s found, board=%d io=%x mem=%x "
4336 "nrpanels=%d nrports=%d\n", stli_brdnames[brdp->brdtype],
4337 brdp->brdnr, brdp->iobase, (int) brdp->memaddr,
4338 brdp->nrpanels, brdp->nrports);
4339 return(0);
4340 }
4341
4342 /*****************************************************************************/
4343
4344 /*
4345 * Probe around trying to find where the EISA boards shared memory
4346 * might be. This is a bit if hack, but it is the best we can do.
4347 */
4348
4349 static int stli_eisamemprobe(stlibrd_t *brdp)
4350 {
4351 cdkecpsig_t ecpsig, *ecpsigp;
4352 cdkonbsig_t onbsig, *onbsigp;
4353 int i, foundit;
4354
4355 #ifdef DEBUG
4356 printk(KERN_DEBUG "stli_eisamemprobe(brdp=%x)\n", (int) brdp);
4357 #endif
4358
4359 /*
4360 * First up we reset the board, to get it into a known state. There
4361 * is only 2 board types here we need to worry about. Don;t use the
4362 * standard board init routine here, it programs up the shared
4363 * memory address, and we don't know it yet...
4364 */
4365 if (brdp->brdtype == BRD_ECPE) {
4366 outb(0x1, (brdp->iobase + ECP_EIBRDENAB));
4367 outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR));
4368 udelay(10);
4369 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
4370 udelay(500);
4371 stli_ecpeienable(brdp);
4372 } else if (brdp->brdtype == BRD_ONBOARDE) {
4373 outb(0x1, (brdp->iobase + ONB_EIBRDENAB));
4374 outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR));
4375 udelay(10);
4376 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
4377 mdelay(100);
4378 outb(0x1, brdp->iobase);
4379 mdelay(1);
4380 stli_onbeenable(brdp);
4381 } else {
4382 return(-ENODEV);
4383 }
4384
4385 foundit = 0;
4386 brdp->memsize = ECP_MEMSIZE;
4387
4388 /*
4389 * Board shared memory is enabled, so now we have a poke around and
4390 * see if we can find it.
4391 */
4392 for (i = 0; (i < stli_eisamempsize); i++) {
4393 brdp->memaddr = stli_eisamemprobeaddrs[i];
4394 brdp->membase = (void *) brdp->memaddr;
4395 brdp->membase = ioremap(brdp->memaddr, brdp->memsize);
4396 if (brdp->membase == (void *) NULL)
4397 continue;
4398
4399 if (brdp->brdtype == BRD_ECPE) {
4400 ecpsigp = (cdkecpsig_t *) stli_ecpeigetmemptr(brdp,
4401 CDK_SIGADDR, __LINE__);
4402 memcpy(&ecpsig, ecpsigp, sizeof(cdkecpsig_t));
4403 if (ecpsig.magic == ECP_MAGIC)
4404 foundit = 1;
4405 } else {
4406 onbsigp = (cdkonbsig_t *) stli_onbegetmemptr(brdp,
4407 CDK_SIGADDR, __LINE__);
4408 memcpy(&onbsig, onbsigp, sizeof(cdkonbsig_t));
4409 if ((onbsig.magic0 == ONB_MAGIC0) &&
4410 (onbsig.magic1 == ONB_MAGIC1) &&
4411 (onbsig.magic2 == ONB_MAGIC2) &&
4412 (onbsig.magic3 == ONB_MAGIC3))
4413 foundit = 1;
4414 }
4415
4416 iounmap(brdp->membase);
4417 if (foundit)
4418 break;
4419 }
4420
4421 /*
4422 * Regardless of whether we found the shared memory or not we must
4423 * disable the region. After that return success or failure.
4424 */
4425 if (brdp->brdtype == BRD_ECPE)
4426 stli_ecpeidisable(brdp);
4427 else
4428 stli_onbedisable(brdp);
4429
4430 if (! foundit) {
4431 brdp->memaddr = 0;
4432 brdp->membase = NULL;
4433 printk(KERN_ERR "STALLION: failed to probe shared memory "
4434 "region for %s in EISA slot=%d\n",
4435 stli_brdnames[brdp->brdtype], (brdp->iobase >> 12));
4436 return(-ENODEV);
4437 }
4438 return(0);
4439 }
4440
4441 static int stli_getbrdnr(void)
4442 {
4443 int i;
4444
4445 for (i = 0; i < STL_MAXBRDS; i++) {
4446 if (!stli_brds[i]) {
4447 if (i >= stli_nrbrds)
4448 stli_nrbrds = i + 1;
4449 return i;
4450 }
4451 }
4452 return -1;
4453 }
4454
4455 /*****************************************************************************/
4456
4457 /*
4458 * Probe around and try to find any EISA boards in system. The biggest
4459 * problem here is finding out what memory address is associated with
4460 * an EISA board after it is found. The registers of the ECPE and
4461 * ONboardE are not readable - so we can't read them from there. We
4462 * don't have access to the EISA CMOS (or EISA BIOS) so we don't
4463 * actually have any way to find out the real value. The best we can
4464 * do is go probing around in the usual places hoping we can find it.
4465 */
4466
4467 static int stli_findeisabrds(void)
4468 {
4469 stlibrd_t *brdp;
4470 unsigned int iobase, eid;
4471 int i;
4472
4473 #ifdef DEBUG
4474 printk(KERN_DEBUG "stli_findeisabrds()\n");
4475 #endif
4476
4477 /*
4478 * Firstly check if this is an EISA system. Do this by probing for
4479 * the system board EISA ID. If this is not an EISA system then
4480 * don't bother going any further!
4481 */
4482 outb(0xff, 0xc80);
4483 if (inb(0xc80) == 0xff)
4484 return(0);
4485
4486 /*
4487 * Looks like an EISA system, so go searching for EISA boards.
4488 */
4489 for (iobase = 0x1000; (iobase <= 0xc000); iobase += 0x1000) {
4490 outb(0xff, (iobase + 0xc80));
4491 eid = inb(iobase + 0xc80);
4492 eid |= inb(iobase + 0xc81) << 8;
4493 if (eid != STL_EISAID)
4494 continue;
4495
4496 /*
4497 * We have found a board. Need to check if this board was
4498 * statically configured already (just in case!).
4499 */
4500 for (i = 0; (i < STL_MAXBRDS); i++) {
4501 brdp = stli_brds[i];
4502 if (brdp == (stlibrd_t *) NULL)
4503 continue;
4504 if (brdp->iobase == iobase)
4505 break;
4506 }
4507 if (i < STL_MAXBRDS)
4508 continue;
4509
4510 /*
4511 * We have found a Stallion board and it is not configured already.
4512 * Allocate a board structure and initialize it.
4513 */
4514 if ((brdp = stli_allocbrd()) == (stlibrd_t *) NULL)
4515 return(-ENOMEM);
4516 if ((brdp->brdnr = stli_getbrdnr()) < 0)
4517 return(-ENOMEM);
4518 eid = inb(iobase + 0xc82);
4519 if (eid == ECP_EISAID)
4520 brdp->brdtype = BRD_ECPE;
4521 else if (eid == ONB_EISAID)
4522 brdp->brdtype = BRD_ONBOARDE;
4523 else
4524 brdp->brdtype = BRD_UNKNOWN;
4525 brdp->iobase = iobase;
4526 outb(0x1, (iobase + 0xc84));
4527 if (stli_eisamemprobe(brdp))
4528 outb(0, (iobase + 0xc84));
4529 stli_brdinit(brdp);
4530 }
4531
4532 return(0);
4533 }
4534
4535 /*****************************************************************************/
4536
4537 /*
4538 * Find the next available board number that is free.
4539 */
4540
4541 /*****************************************************************************/
4542
4543 #ifdef CONFIG_PCI
4544
4545 /*
4546 * We have a Stallion board. Allocate a board structure and
4547 * initialize it. Read its IO and MEMORY resources from PCI
4548 * configuration space.
4549 */
4550
4551 static int stli_initpcibrd(int brdtype, struct pci_dev *devp)
4552 {
4553 stlibrd_t *brdp;
4554
4555 #ifdef DEBUG
4556 printk(KERN_DEBUG "stli_initpcibrd(brdtype=%d,busnr=%x,devnr=%x)\n",
4557 brdtype, dev->bus->number, dev->devfn);
4558 #endif
4559
4560 if (pci_enable_device(devp))
4561 return(-EIO);
4562 if ((brdp = stli_allocbrd()) == (stlibrd_t *) NULL)
4563 return(-ENOMEM);
4564 if ((brdp->brdnr = stli_getbrdnr()) < 0) {
4565 printk(KERN_INFO "STALLION: too many boards found, "
4566 "maximum supported %d\n", STL_MAXBRDS);
4567 return(0);
4568 }
4569 brdp->brdtype = brdtype;
4570
4571 #ifdef DEBUG
4572 printk(KERN_DEBUG "%s(%d): BAR[]=%lx,%lx,%lx,%lx\n", __FILE__, __LINE__,
4573 pci_resource_start(devp, 0),
4574 pci_resource_start(devp, 1),
4575 pci_resource_start(devp, 2),
4576 pci_resource_start(devp, 3));
4577 #endif
4578
4579 /*
4580 * We have all resources from the board, so lets setup the actual
4581 * board structure now.
4582 */
4583 brdp->iobase = pci_resource_start(devp, 3);
4584 brdp->memaddr = pci_resource_start(devp, 2);
4585 stli_brdinit(brdp);
4586
4587 return(0);
4588 }
4589
4590 /*****************************************************************************/
4591
4592 /*
4593 * Find all Stallion PCI boards that might be installed. Initialize each
4594 * one as it is found.
4595 */
4596
4597 static int stli_findpcibrds(void)
4598 {
4599 struct pci_dev *dev = NULL;
4600 int rc;
4601
4602 #ifdef DEBUG
4603 printk("stli_findpcibrds()\n");
4604 #endif
4605
4606 while ((dev = pci_find_device(PCI_VENDOR_ID_STALLION,
4607 PCI_DEVICE_ID_ECRA, dev))) {
4608 if ((rc = stli_initpcibrd(BRD_ECPPCI, dev)))
4609 return(rc);
4610 }
4611
4612 return(0);
4613 }
4614
4615 #endif
4616
4617 /*****************************************************************************/
4618
4619 /*
4620 * Allocate a new board structure. Fill out the basic info in it.
4621 */
4622
4623 static stlibrd_t *stli_allocbrd(void)
4624 {
4625 stlibrd_t *brdp;
4626
4627 brdp = (stlibrd_t *) stli_memalloc(sizeof(stlibrd_t));
4628 if (brdp == (stlibrd_t *) NULL) {
4629 printk(KERN_ERR "STALLION: failed to allocate memory "
4630 "(size=%d)\n", sizeof(stlibrd_t));
4631 return((stlibrd_t *) NULL);
4632 }
4633
4634 memset(brdp, 0, sizeof(stlibrd_t));
4635 brdp->magic = STLI_BOARDMAGIC;
4636 return(brdp);
4637 }
4638
4639 /*****************************************************************************/
4640
4641 /*
4642 * Scan through all the boards in the configuration and see what we
4643 * can find.
4644 */
4645
4646 static int stli_initbrds(void)
4647 {
4648 stlibrd_t *brdp, *nxtbrdp;
4649 stlconf_t *confp;
4650 int i, j;
4651
4652 #ifdef DEBUG
4653 printk(KERN_DEBUG "stli_initbrds()\n");
4654 #endif
4655
4656 if (stli_nrbrds > STL_MAXBRDS) {
4657 printk(KERN_INFO "STALLION: too many boards in configuration "
4658 "table, truncating to %d\n", STL_MAXBRDS);
4659 stli_nrbrds = STL_MAXBRDS;
4660 }
4661
4662 /*
4663 * Firstly scan the list of static boards configured. Allocate
4664 * resources and initialize the boards as found. If this is a
4665 * module then let the module args override static configuration.
4666 */
4667 for (i = 0; (i < stli_nrbrds); i++) {
4668 confp = &stli_brdconf[i];
4669 #ifdef MODULE
4670 stli_parsebrd(confp, stli_brdsp[i]);
4671 #endif
4672 if ((brdp = stli_allocbrd()) == (stlibrd_t *) NULL)
4673 return(-ENOMEM);
4674 brdp->brdnr = i;
4675 brdp->brdtype = confp->brdtype;
4676 brdp->iobase = confp->ioaddr1;
4677 brdp->memaddr = confp->memaddr;
4678 stli_brdinit(brdp);
4679 }
4680
4681 /*
4682 * Static configuration table done, so now use dynamic methods to
4683 * see if any more boards should be configured.
4684 */
4685 #ifdef MODULE
4686 stli_argbrds();
4687 #endif
4688 if (stli_eisaprobe)
4689 stli_findeisabrds();
4690 #ifdef CONFIG_PCI
4691 stli_findpcibrds();
4692 #endif
4693
4694 /*
4695 * All found boards are initialized. Now for a little optimization, if
4696 * no boards are sharing the "shared memory" regions then we can just
4697 * leave them all enabled. This is in fact the usual case.
4698 */
4699 stli_shared = 0;
4700 if (stli_nrbrds > 1) {
4701 for (i = 0; (i < stli_nrbrds); i++) {
4702 brdp = stli_brds[i];
4703 if (brdp == (stlibrd_t *) NULL)
4704 continue;
4705 for (j = i + 1; (j < stli_nrbrds); j++) {
4706 nxtbrdp = stli_brds[j];
4707 if (nxtbrdp == (stlibrd_t *) NULL)
4708 continue;
4709 if ((brdp->membase >= nxtbrdp->membase) &&
4710 (brdp->membase <= (nxtbrdp->membase +
4711 nxtbrdp->memsize - 1))) {
4712 stli_shared++;
4713 break;
4714 }
4715 }
4716 }
4717 }
4718
4719 if (stli_shared == 0) {
4720 for (i = 0; (i < stli_nrbrds); i++) {
4721 brdp = stli_brds[i];
4722 if (brdp == (stlibrd_t *) NULL)
4723 continue;
4724 if (brdp->state & BST_FOUND) {
4725 EBRDENABLE(brdp);
4726 brdp->enable = NULL;
4727 brdp->disable = NULL;
4728 }
4729 }
4730 }
4731
4732 return(0);
4733 }
4734
4735 /*****************************************************************************/
4736
4737 /*
4738 * Code to handle an "staliomem" read operation. This device is the
4739 * contents of the board shared memory. It is used for down loading
4740 * the slave image (and debugging :-)
4741 */
4742
4743 static ssize_t stli_memread(struct file *fp, char __user *buf, size_t count, loff_t *offp)
4744 {
4745 unsigned long flags;
4746 void *memptr;
4747 stlibrd_t *brdp;
4748 int brdnr, size, n;
4749
4750 #ifdef DEBUG
4751 printk(KERN_DEBUG "stli_memread(fp=%x,buf=%x,count=%x,offp=%x)\n",
4752 (int) fp, (int) buf, count, (int) offp);
4753 #endif
4754
4755 brdnr = iminor(fp->f_dentry->d_inode);
4756 if (brdnr >= stli_nrbrds)
4757 return(-ENODEV);
4758 brdp = stli_brds[brdnr];
4759 if (brdp == (stlibrd_t *) NULL)
4760 return(-ENODEV);
4761 if (brdp->state == 0)
4762 return(-ENODEV);
4763 if (fp->f_pos >= brdp->memsize)
4764 return(0);
4765
4766 size = MIN(count, (brdp->memsize - fp->f_pos));
4767
4768 save_flags(flags);
4769 cli();
4770 EBRDENABLE(brdp);
4771 while (size > 0) {
4772 memptr = (void *) EBRDGETMEMPTR(brdp, fp->f_pos);
4773 n = MIN(size, (brdp->pagesize - (((unsigned long) fp->f_pos) % brdp->pagesize)));
4774 if (copy_to_user(buf, memptr, n)) {
4775 count = -EFAULT;
4776 goto out;
4777 }
4778 fp->f_pos += n;
4779 buf += n;
4780 size -= n;
4781 }
4782 out:
4783 EBRDDISABLE(brdp);
4784 restore_flags(flags);
4785
4786 return(count);
4787 }
4788
4789 /*****************************************************************************/
4790
4791 /*
4792 * Code to handle an "staliomem" write operation. This device is the
4793 * contents of the board shared memory. It is used for down loading
4794 * the slave image (and debugging :-)
4795 */
4796
4797 static ssize_t stli_memwrite(struct file *fp, const char __user *buf, size_t count, loff_t *offp)
4798 {
4799 unsigned long flags;
4800 void *memptr;
4801 stlibrd_t *brdp;
4802 char __user *chbuf;
4803 int brdnr, size, n;
4804
4805 #ifdef DEBUG
4806 printk(KERN_DEBUG "stli_memwrite(fp=%x,buf=%x,count=%x,offp=%x)\n",
4807 (int) fp, (int) buf, count, (int) offp);
4808 #endif
4809
4810 brdnr = iminor(fp->f_dentry->d_inode);
4811 if (brdnr >= stli_nrbrds)
4812 return(-ENODEV);
4813 brdp = stli_brds[brdnr];
4814 if (brdp == (stlibrd_t *) NULL)
4815 return(-ENODEV);
4816 if (brdp->state == 0)
4817 return(-ENODEV);
4818 if (fp->f_pos >= brdp->memsize)
4819 return(0);
4820
4821 chbuf = (char __user *) buf;
4822 size = MIN(count, (brdp->memsize - fp->f_pos));
4823
4824 save_flags(flags);
4825 cli();
4826 EBRDENABLE(brdp);
4827 while (size > 0) {
4828 memptr = (void *) EBRDGETMEMPTR(brdp, fp->f_pos);
4829 n = MIN(size, (brdp->pagesize - (((unsigned long) fp->f_pos) % brdp->pagesize)));
4830 if (copy_from_user(memptr, chbuf, n)) {
4831 count = -EFAULT;
4832 goto out;
4833 }
4834 fp->f_pos += n;
4835 chbuf += n;
4836 size -= n;
4837 }
4838 out:
4839 EBRDDISABLE(brdp);
4840 restore_flags(flags);
4841
4842 return(count);
4843 }
4844
4845 /*****************************************************************************/
4846
4847 /*
4848 * Return the board stats structure to user app.
4849 */
4850
4851 static int stli_getbrdstats(combrd_t __user *bp)
4852 {
4853 stlibrd_t *brdp;
4854 int i;
4855
4856 if (copy_from_user(&stli_brdstats, bp, sizeof(combrd_t)))
4857 return -EFAULT;
4858 if (stli_brdstats.brd >= STL_MAXBRDS)
4859 return(-ENODEV);
4860 brdp = stli_brds[stli_brdstats.brd];
4861 if (brdp == (stlibrd_t *) NULL)
4862 return(-ENODEV);
4863
4864 memset(&stli_brdstats, 0, sizeof(combrd_t));
4865 stli_brdstats.brd = brdp->brdnr;
4866 stli_brdstats.type = brdp->brdtype;
4867 stli_brdstats.hwid = 0;
4868 stli_brdstats.state = brdp->state;
4869 stli_brdstats.ioaddr = brdp->iobase;
4870 stli_brdstats.memaddr = brdp->memaddr;
4871 stli_brdstats.nrpanels = brdp->nrpanels;
4872 stli_brdstats.nrports = brdp->nrports;
4873 for (i = 0; (i < brdp->nrpanels); i++) {
4874 stli_brdstats.panels[i].panel = i;
4875 stli_brdstats.panels[i].hwid = brdp->panelids[i];
4876 stli_brdstats.panels[i].nrports = brdp->panels[i];
4877 }
4878
4879 if (copy_to_user(bp, &stli_brdstats, sizeof(combrd_t)))
4880 return -EFAULT;
4881 return(0);
4882 }
4883
4884 /*****************************************************************************/
4885
4886 /*
4887 * Resolve the referenced port number into a port struct pointer.
4888 */
4889
4890 static stliport_t *stli_getport(int brdnr, int panelnr, int portnr)
4891 {
4892 stlibrd_t *brdp;
4893 int i;
4894
4895 if ((brdnr < 0) || (brdnr >= STL_MAXBRDS))
4896 return((stliport_t *) NULL);
4897 brdp = stli_brds[brdnr];
4898 if (brdp == (stlibrd_t *) NULL)
4899 return((stliport_t *) NULL);
4900 for (i = 0; (i < panelnr); i++)
4901 portnr += brdp->panels[i];
4902 if ((portnr < 0) || (portnr >= brdp->nrports))
4903 return((stliport_t *) NULL);
4904 return(brdp->ports[portnr]);
4905 }
4906
4907 /*****************************************************************************/
4908
4909 /*
4910 * Return the port stats structure to user app. A NULL port struct
4911 * pointer passed in means that we need to find out from the app
4912 * what port to get stats for (used through board control device).
4913 */
4914
4915 static int stli_portcmdstats(stliport_t *portp)
4916 {
4917 unsigned long flags;
4918 stlibrd_t *brdp;
4919 int rc;
4920
4921 memset(&stli_comstats, 0, sizeof(comstats_t));
4922
4923 if (portp == (stliport_t *) NULL)
4924 return(-ENODEV);
4925 brdp = stli_brds[portp->brdnr];
4926 if (brdp == (stlibrd_t *) NULL)
4927 return(-ENODEV);
4928
4929 if (brdp->state & BST_STARTED) {
4930 if ((rc = stli_cmdwait(brdp, portp, A_GETSTATS,
4931 &stli_cdkstats, sizeof(asystats_t), 1)) < 0)
4932 return(rc);
4933 } else {
4934 memset(&stli_cdkstats, 0, sizeof(asystats_t));
4935 }
4936
4937 stli_comstats.brd = portp->brdnr;
4938 stli_comstats.panel = portp->panelnr;
4939 stli_comstats.port = portp->portnr;
4940 stli_comstats.state = portp->state;
4941 stli_comstats.flags = portp->flags;
4942
4943 save_flags(flags);
4944 cli();
4945 if (portp->tty != (struct tty_struct *) NULL) {
4946 if (portp->tty->driver_data == portp) {
4947 stli_comstats.ttystate = portp->tty->flags;
4948 stli_comstats.rxbuffered = portp->tty->flip.count;
4949 if (portp->tty->termios != (struct termios *) NULL) {
4950 stli_comstats.cflags = portp->tty->termios->c_cflag;
4951 stli_comstats.iflags = portp->tty->termios->c_iflag;
4952 stli_comstats.oflags = portp->tty->termios->c_oflag;
4953 stli_comstats.lflags = portp->tty->termios->c_lflag;
4954 }
4955 }
4956 }
4957 restore_flags(flags);
4958
4959 stli_comstats.txtotal = stli_cdkstats.txchars;
4960 stli_comstats.rxtotal = stli_cdkstats.rxchars + stli_cdkstats.ringover;
4961 stli_comstats.txbuffered = stli_cdkstats.txringq;
4962 stli_comstats.rxbuffered += stli_cdkstats.rxringq;
4963 stli_comstats.rxoverrun = stli_cdkstats.overruns;
4964 stli_comstats.rxparity = stli_cdkstats.parity;
4965 stli_comstats.rxframing = stli_cdkstats.framing;
4966 stli_comstats.rxlost = stli_cdkstats.ringover;
4967 stli_comstats.rxbreaks = stli_cdkstats.rxbreaks;
4968 stli_comstats.txbreaks = stli_cdkstats.txbreaks;
4969 stli_comstats.txxon = stli_cdkstats.txstart;
4970 stli_comstats.txxoff = stli_cdkstats.txstop;
4971 stli_comstats.rxxon = stli_cdkstats.rxstart;
4972 stli_comstats.rxxoff = stli_cdkstats.rxstop;
4973 stli_comstats.rxrtsoff = stli_cdkstats.rtscnt / 2;
4974 stli_comstats.rxrtson = stli_cdkstats.rtscnt - stli_comstats.rxrtsoff;
4975 stli_comstats.modem = stli_cdkstats.dcdcnt;
4976 stli_comstats.hwid = stli_cdkstats.hwid;
4977 stli_comstats.signals = stli_mktiocm(stli_cdkstats.signals);
4978
4979 return(0);
4980 }
4981
4982 /*****************************************************************************/
4983
4984 /*
4985 * Return the port stats structure to user app. A NULL port struct
4986 * pointer passed in means that we need to find out from the app
4987 * what port to get stats for (used through board control device).
4988 */
4989
4990 static int stli_getportstats(stliport_t *portp, comstats_t __user *cp)
4991 {
4992 stlibrd_t *brdp;
4993 int rc;
4994
4995 if (!portp) {
4996 if (copy_from_user(&stli_comstats, cp, sizeof(comstats_t)))
4997 return -EFAULT;
4998 portp = stli_getport(stli_comstats.brd, stli_comstats.panel,
4999 stli_comstats.port);
5000 if (!portp)
5001 return -ENODEV;
5002 }
5003
5004 brdp = stli_brds[portp->brdnr];
5005 if (!brdp)
5006 return -ENODEV;
5007
5008 if ((rc = stli_portcmdstats(portp)) < 0)
5009 return rc;
5010
5011 return copy_to_user(cp, &stli_comstats, sizeof(comstats_t)) ?
5012 -EFAULT : 0;
5013 }
5014
5015 /*****************************************************************************/
5016
5017 /*
5018 * Clear the port stats structure. We also return it zeroed out...
5019 */
5020
5021 static int stli_clrportstats(stliport_t *portp, comstats_t __user *cp)
5022 {
5023 stlibrd_t *brdp;
5024 int rc;
5025
5026 if (!portp) {
5027 if (copy_from_user(&stli_comstats, cp, sizeof(comstats_t)))
5028 return -EFAULT;
5029 portp = stli_getport(stli_comstats.brd, stli_comstats.panel,
5030 stli_comstats.port);
5031 if (!portp)
5032 return -ENODEV;
5033 }
5034
5035 brdp = stli_brds[portp->brdnr];
5036 if (!brdp)
5037 return -ENODEV;
5038
5039 if (brdp->state & BST_STARTED) {
5040 if ((rc = stli_cmdwait(brdp, portp, A_CLEARSTATS, NULL, 0, 0)) < 0)
5041 return rc;
5042 }
5043
5044 memset(&stli_comstats, 0, sizeof(comstats_t));
5045 stli_comstats.brd = portp->brdnr;
5046 stli_comstats.panel = portp->panelnr;
5047 stli_comstats.port = portp->portnr;
5048
5049 if (copy_to_user(cp, &stli_comstats, sizeof(comstats_t)))
5050 return -EFAULT;
5051 return 0;
5052 }
5053
5054 /*****************************************************************************/
5055
5056 /*
5057 * Return the entire driver ports structure to a user app.
5058 */
5059
5060 static int stli_getportstruct(stliport_t __user *arg)
5061 {
5062 stliport_t *portp;
5063
5064 if (copy_from_user(&stli_dummyport, arg, sizeof(stliport_t)))
5065 return -EFAULT;
5066 portp = stli_getport(stli_dummyport.brdnr, stli_dummyport.panelnr,
5067 stli_dummyport.portnr);
5068 if (!portp)
5069 return -ENODEV;
5070 if (copy_to_user(arg, portp, sizeof(stliport_t)))
5071 return -EFAULT;
5072 return 0;
5073 }
5074
5075 /*****************************************************************************/
5076
5077 /*
5078 * Return the entire driver board structure to a user app.
5079 */
5080
5081 static int stli_getbrdstruct(stlibrd_t __user *arg)
5082 {
5083 stlibrd_t *brdp;
5084
5085 if (copy_from_user(&stli_dummybrd, arg, sizeof(stlibrd_t)))
5086 return -EFAULT;
5087 if ((stli_dummybrd.brdnr < 0) || (stli_dummybrd.brdnr >= STL_MAXBRDS))
5088 return -ENODEV;
5089 brdp = stli_brds[stli_dummybrd.brdnr];
5090 if (!brdp)
5091 return -ENODEV;
5092 if (copy_to_user(arg, brdp, sizeof(stlibrd_t)))
5093 return -EFAULT;
5094 return 0;
5095 }
5096
5097 /*****************************************************************************/
5098
5099 /*
5100 * The "staliomem" device is also required to do some special operations on
5101 * the board. We need to be able to send an interrupt to the board,
5102 * reset it, and start/stop it.
5103 */
5104
5105 static int stli_memioctl(struct inode *ip, struct file *fp, unsigned int cmd, unsigned long arg)
5106 {
5107 stlibrd_t *brdp;
5108 int brdnr, rc, done;
5109 void __user *argp = (void __user *)arg;
5110
5111 #ifdef DEBUG
5112 printk(KERN_DEBUG "stli_memioctl(ip=%x,fp=%x,cmd=%x,arg=%x)\n",
5113 (int) ip, (int) fp, cmd, (int) arg);
5114 #endif
5115
5116 /*
5117 * First up handle the board independent ioctls.
5118 */
5119 done = 0;
5120 rc = 0;
5121
5122 switch (cmd) {
5123 case COM_GETPORTSTATS:
5124 rc = stli_getportstats(NULL, argp);
5125 done++;
5126 break;
5127 case COM_CLRPORTSTATS:
5128 rc = stli_clrportstats(NULL, argp);
5129 done++;
5130 break;
5131 case COM_GETBRDSTATS:
5132 rc = stli_getbrdstats(argp);
5133 done++;
5134 break;
5135 case COM_READPORT:
5136 rc = stli_getportstruct(argp);
5137 done++;
5138 break;
5139 case COM_READBOARD:
5140 rc = stli_getbrdstruct(argp);
5141 done++;
5142 break;
5143 }
5144
5145 if (done)
5146 return(rc);
5147
5148 /*
5149 * Now handle the board specific ioctls. These all depend on the
5150 * minor number of the device they were called from.
5151 */
5152 brdnr = iminor(ip);
5153 if (brdnr >= STL_MAXBRDS)
5154 return(-ENODEV);
5155 brdp = stli_brds[brdnr];
5156 if (!brdp)
5157 return(-ENODEV);
5158 if (brdp->state == 0)
5159 return(-ENODEV);
5160
5161 switch (cmd) {
5162 case STL_BINTR:
5163 EBRDINTR(brdp);
5164 break;
5165 case STL_BSTART:
5166 rc = stli_startbrd(brdp);
5167 break;
5168 case STL_BSTOP:
5169 brdp->state &= ~BST_STARTED;
5170 break;
5171 case STL_BRESET:
5172 brdp->state &= ~BST_STARTED;
5173 EBRDRESET(brdp);
5174 if (stli_shared == 0) {
5175 if (brdp->reenable != NULL)
5176 (* brdp->reenable)(brdp);
5177 }
5178 break;
5179 default:
5180 rc = -ENOIOCTLCMD;
5181 break;
5182 }
5183
5184 return(rc);
5185 }
5186
5187 static struct tty_operations stli_ops = {
5188 .open = stli_open,
5189 .close = stli_close,
5190 .write = stli_write,
5191 .put_char = stli_putchar,
5192 .flush_chars = stli_flushchars,
5193 .write_room = stli_writeroom,
5194 .chars_in_buffer = stli_charsinbuffer,
5195 .ioctl = stli_ioctl,
5196 .set_termios = stli_settermios,
5197 .throttle = stli_throttle,
5198 .unthrottle = stli_unthrottle,
5199 .stop = stli_stop,
5200 .start = stli_start,
5201 .hangup = stli_hangup,
5202 .flush_buffer = stli_flushbuffer,
5203 .break_ctl = stli_breakctl,
5204 .wait_until_sent = stli_waituntilsent,
5205 .send_xchar = stli_sendxchar,
5206 .read_proc = stli_readproc,
5207 .tiocmget = stli_tiocmget,
5208 .tiocmset = stli_tiocmset,
5209 };
5210
5211 /*****************************************************************************/
5212
5213 int __init stli_init(void)
5214 {
5215 int i;
5216 printk(KERN_INFO "%s: version %s\n", stli_drvtitle, stli_drvversion);
5217
5218 stli_initbrds();
5219
5220 stli_serial = alloc_tty_driver(STL_MAXBRDS * STL_MAXPORTS);
5221 if (!stli_serial)
5222 return -ENOMEM;
5223
5224 /*
5225 * Allocate a temporary write buffer.
5226 */
5227 stli_tmpwritebuf = (char *) stli_memalloc(STLI_TXBUFSIZE);
5228 if (stli_tmpwritebuf == (char *) NULL)
5229 printk(KERN_ERR "STALLION: failed to allocate memory "
5230 "(size=%d)\n", STLI_TXBUFSIZE);
5231 stli_txcookbuf = stli_memalloc(STLI_TXBUFSIZE);
5232 if (stli_txcookbuf == (char *) NULL)
5233 printk(KERN_ERR "STALLION: failed to allocate memory "
5234 "(size=%d)\n", STLI_TXBUFSIZE);
5235
5236 /*
5237 * Set up a character driver for the shared memory region. We need this
5238 * to down load the slave code image. Also it is a useful debugging tool.
5239 */
5240 if (register_chrdev(STL_SIOMEMMAJOR, "staliomem", &stli_fsiomem))
5241 printk(KERN_ERR "STALLION: failed to register serial memory "
5242 "device\n");
5243
5244 devfs_mk_dir("staliomem");
5245 istallion_class = class_simple_create(THIS_MODULE, "staliomem");
5246 for (i = 0; i < 4; i++) {
5247 devfs_mk_cdev(MKDEV(STL_SIOMEMMAJOR, i),
5248 S_IFCHR | S_IRUSR | S_IWUSR,
5249 "staliomem/%d", i);
5250 class_simple_device_add(istallion_class, MKDEV(STL_SIOMEMMAJOR, i),
5251 NULL, "staliomem%d", i);
5252 }
5253
5254 /*
5255 * Set up the tty driver structure and register us as a driver.
5256 */
5257 stli_serial->owner = THIS_MODULE;
5258 stli_serial->driver_name = stli_drvname;
5259 stli_serial->name = stli_serialname;
5260 stli_serial->major = STL_SERIALMAJOR;
5261 stli_serial->minor_start = 0;
5262 stli_serial->type = TTY_DRIVER_TYPE_SERIAL;
5263 stli_serial->subtype = SERIAL_TYPE_NORMAL;
5264 stli_serial->init_termios = stli_deftermios;
5265 stli_serial->flags = TTY_DRIVER_REAL_RAW;
5266 tty_set_operations(stli_serial, &stli_ops);
5267
5268 if (tty_register_driver(stli_serial)) {
5269 put_tty_driver(stli_serial);
5270 printk(KERN_ERR "STALLION: failed to register serial driver\n");
5271 return -EBUSY;
5272 }
5273 return(0);
5274 }
5275
5276 /*****************************************************************************/