blob: 5c3dc6b8411c88d62ec800f082678dc6f66ec3d8 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*****************************************************************************/
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 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070017 */
18
19/*****************************************************************************/
20
Linus Torvalds1da177e2005-04-16 15:20:36 -070021#include <linux/module.h>
22#include <linux/slab.h>
23#include <linux/interrupt.h>
24#include <linux/tty.h>
25#include <linux/tty_flip.h>
26#include <linux/serial.h>
27#include <linux/cdk.h>
28#include <linux/comstats.h>
29#include <linux/istallion.h>
30#include <linux/ioport.h>
31#include <linux/delay.h>
32#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include <linux/device.h>
34#include <linux/wait.h>
Alan Cox4ac43602006-06-28 04:26:52 -070035#include <linux/eisa.h>
Jiri Slabya3f8d9d2006-12-08 02:39:18 -080036#include <linux/ctype.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070037
38#include <asm/io.h>
39#include <asm/uaccess.h>
40
Linus Torvalds1da177e2005-04-16 15:20:36 -070041#include <linux/pci.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070042
43/*****************************************************************************/
44
45/*
46 * Define different board types. Not all of the following board types
47 * are supported by this driver. But I will use the standard "assigned"
48 * board numbers. Currently supported boards are abbreviated as:
49 * ECP = EasyConnection 8/64, ONB = ONboard, BBY = Brumby and
50 * STAL = Stallion.
51 */
52#define BRD_UNKNOWN 0
53#define BRD_STALLION 1
54#define BRD_BRUMBY4 2
55#define BRD_ONBOARD2 3
56#define BRD_ONBOARD 4
Linus Torvalds1da177e2005-04-16 15:20:36 -070057#define BRD_ONBOARDE 7
Linus Torvalds1da177e2005-04-16 15:20:36 -070058#define BRD_ECP 23
59#define BRD_ECPE 24
60#define BRD_ECPMC 25
Linus Torvalds1da177e2005-04-16 15:20:36 -070061#define BRD_ECPPCI 29
62
63#define BRD_BRUMBY BRD_BRUMBY4
64
65/*
66 * Define a configuration structure to hold the board configuration.
67 * Need to set this up in the code (for now) with the boards that are
68 * to be configured into the system. This is what needs to be modified
69 * when adding/removing/modifying boards. Each line entry in the
70 * stli_brdconf[] array is a board. Each line contains io/irq/memory
71 * ranges for that board (as well as what type of board it is).
72 * Some examples:
73 * { BRD_ECP, 0x2a0, 0, 0xcc000, 0, 0 },
74 * This line will configure an EasyConnection 8/64 at io address 2a0,
75 * and shared memory address of cc000. Multiple EasyConnection 8/64
76 * boards can share the same shared memory address space. No interrupt
77 * is required for this board type.
78 * Another example:
79 * { BRD_ECPE, 0x5000, 0, 0x80000000, 0, 0 },
80 * This line will configure an EasyConnection 8/64 EISA in slot 5 and
81 * shared memory address of 0x80000000 (2 GByte). Multiple
82 * EasyConnection 8/64 EISA boards can share the same shared memory
83 * address space. No interrupt is required for this board type.
84 * Another example:
85 * { BRD_ONBOARD, 0x240, 0, 0xd0000, 0, 0 },
86 * This line will configure an ONboard (ISA type) at io address 240,
87 * and shared memory address of d0000. Multiple ONboards can share
88 * the same shared memory address space. No interrupt required.
89 * Another example:
90 * { BRD_BRUMBY4, 0x360, 0, 0xc8000, 0, 0 },
91 * This line will configure a Brumby board (any number of ports!) at
92 * io address 360 and shared memory address of c8000. All Brumby boards
93 * configured into a system must have their own separate io and memory
94 * addresses. No interrupt is required.
95 * Another example:
96 * { BRD_STALLION, 0x330, 0, 0xd0000, 0, 0 },
97 * This line will configure an original Stallion board at io address 330
98 * and shared memory address d0000 (this would only be valid for a "V4.0"
99 * or Rev.O Stallion board). All Stallion boards configured into the
100 * system must have their own separate io and memory addresses. No
101 * interrupt is required.
102 */
103
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800104struct stlconf {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105 int brdtype;
106 int ioaddr1;
107 int ioaddr2;
108 unsigned long memaddr;
109 int irq;
110 int irqtype;
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800111};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112
Jiri Slaby1328d732006-12-08 02:39:19 -0800113static unsigned int stli_nrbrds;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114
Alan Cox4ac43602006-06-28 04:26:52 -0700115/* stli_lock must NOT be taken holding brd_lock */
116static spinlock_t stli_lock; /* TTY logic lock */
117static spinlock_t brd_lock; /* Board logic lock */
118
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119/*
120 * There is some experimental EISA board detection code in this driver.
121 * By default it is disabled, but for those that want to try it out,
122 * then set the define below to be 1.
123 */
124#define STLI_EISAPROBE 0
125
126/*****************************************************************************/
127
128/*
129 * Define some important driver characteristics. Device major numbers
130 * allocated as per Linux Device Registry.
131 */
132#ifndef STL_SIOMEMMAJOR
133#define STL_SIOMEMMAJOR 28
134#endif
135#ifndef STL_SERIALMAJOR
136#define STL_SERIALMAJOR 24
137#endif
138#ifndef STL_CALLOUTMAJOR
139#define STL_CALLOUTMAJOR 25
140#endif
141
142/*****************************************************************************/
143
144/*
145 * Define our local driver identity first. Set up stuff to deal with
146 * all the local structures required by a serial tty driver.
147 */
148static char *stli_drvtitle = "Stallion Intelligent Multiport Serial Driver";
149static char *stli_drvname = "istallion";
150static char *stli_drvversion = "5.6.0";
151static char *stli_serialname = "ttyE";
152
153static struct tty_driver *stli_serial;
Alan Cox31f35932009-01-02 13:45:05 +0000154static const struct tty_port_operations stli_port_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155
156#define STLI_TXBUFSIZE 4096
157
158/*
159 * Use a fast local buffer for cooked characters. Typically a whole
160 * bunch of cooked characters come in for a port, 1 at a time. So we
161 * save those up into a local buffer, then write out the whole lot
162 * with a large memcpy. Just use 1 buffer for all ports, since its
163 * use it is only need for short periods of time by each port.
164 */
165static char *stli_txcookbuf;
166static int stli_txcooksize;
167static int stli_txcookrealsize;
168static struct tty_struct *stli_txcooktty;
169
170/*
171 * Define a local default termios struct. All ports will be created
172 * with this termios initially. Basically all it defines is a raw port
173 * at 9600 baud, 8 data bits, no parity, 1 stop bit.
174 */
Alan Cox606d0992006-12-08 02:38:45 -0800175static struct ktermios stli_deftermios = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176 .c_cflag = (B9600 | CS8 | CREAD | HUPCL | CLOCAL),
177 .c_cc = INIT_C_CC,
Alan Cox606d0992006-12-08 02:38:45 -0800178 .c_ispeed = 9600,
179 .c_ospeed = 9600,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180};
181
182/*
183 * Define global stats structures. Not used often, and can be
184 * re-used for each stats call.
185 */
186static comstats_t stli_comstats;
187static combrd_t stli_brdstats;
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800188static struct asystats stli_cdkstats;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189
190/*****************************************************************************/
191
Jiri Slabyb103b5c2006-12-08 02:39:21 -0800192static DEFINE_MUTEX(stli_brdslock);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800193static struct stlibrd *stli_brds[STL_MAXBRDS];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194
195static int stli_shared;
196
197/*
198 * Per board state flags. Used with the state field of the board struct.
199 * Not really much here... All we need to do is keep track of whether
200 * the board has been detected, and whether it is actually running a slave
201 * or not.
202 */
203#define BST_FOUND 0x1
204#define BST_STARTED 0x2
Jiri Slaby39014172006-12-08 02:39:22 -0800205#define BST_PROBED 0x4
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206
207/*
208 * Define the set of port state flags. These are marked for internal
209 * state purposes only, usually to do with the state of communications
210 * with the slave. Most of them need to be updated atomically, so always
211 * use the bit setting operations (unless protected by cli/sti).
212 */
213#define ST_INITIALIZING 1
214#define ST_OPENING 2
215#define ST_CLOSING 3
216#define ST_CMDING 4
217#define ST_TXBUSY 5
218#define ST_RXING 6
219#define ST_DOFLUSHRX 7
220#define ST_DOFLUSHTX 8
221#define ST_DOSIGS 9
222#define ST_RXSTOP 10
223#define ST_GETSIGS 11
224
225/*
226 * Define an array of board names as printable strings. Handy for
227 * referencing boards when printing trace and stuff.
228 */
229static char *stli_brdnames[] = {
230 "Unknown",
231 "Stallion",
232 "Brumby",
233 "ONboard-MC",
234 "ONboard",
235 "Brumby",
236 "Brumby",
237 "ONboard-EI",
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800238 NULL,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239 "ONboard",
240 "ONboard-MC",
241 "ONboard-MC",
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800242 NULL,
243 NULL,
244 NULL,
245 NULL,
246 NULL,
247 NULL,
248 NULL,
249 NULL,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250 "EasyIO",
251 "EC8/32-AT",
252 "EC8/32-MC",
253 "EC8/64-AT",
254 "EC8/64-EI",
255 "EC8/64-MC",
256 "EC8/32-PCI",
257 "EC8/64-PCI",
258 "EasyIO-PCI",
259 "EC/RA-PCI",
260};
261
262/*****************************************************************************/
263
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264/*
265 * Define some string labels for arguments passed from the module
266 * load line. These allow for easy board definitions, and easy
267 * modification of the io, memory and irq resoucres.
268 */
269
270static char *board0[8];
271static char *board1[8];
272static char *board2[8];
273static char *board3[8];
274
275static char **stli_brdsp[] = {
276 (char **) &board0,
277 (char **) &board1,
278 (char **) &board2,
279 (char **) &board3
280};
281
282/*
283 * Define a set of common board names, and types. This is used to
284 * parse any module arguments.
285 */
286
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800287static struct stlibrdtype {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288 char *name;
289 int type;
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800290} stli_brdstr[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700291 { "stallion", BRD_STALLION },
292 { "1", BRD_STALLION },
293 { "brumby", BRD_BRUMBY },
294 { "brumby4", BRD_BRUMBY },
295 { "brumby/4", BRD_BRUMBY },
296 { "brumby-4", BRD_BRUMBY },
297 { "brumby8", BRD_BRUMBY },
298 { "brumby/8", BRD_BRUMBY },
299 { "brumby-8", BRD_BRUMBY },
300 { "brumby16", BRD_BRUMBY },
301 { "brumby/16", BRD_BRUMBY },
302 { "brumby-16", BRD_BRUMBY },
303 { "2", BRD_BRUMBY },
304 { "onboard2", BRD_ONBOARD2 },
305 { "onboard-2", BRD_ONBOARD2 },
306 { "onboard/2", BRD_ONBOARD2 },
307 { "onboard-mc", BRD_ONBOARD2 },
308 { "onboard/mc", BRD_ONBOARD2 },
309 { "onboard-mca", BRD_ONBOARD2 },
310 { "onboard/mca", BRD_ONBOARD2 },
311 { "3", BRD_ONBOARD2 },
312 { "onboard", BRD_ONBOARD },
313 { "onboardat", BRD_ONBOARD },
314 { "4", BRD_ONBOARD },
315 { "onboarde", BRD_ONBOARDE },
316 { "onboard-e", BRD_ONBOARDE },
317 { "onboard/e", BRD_ONBOARDE },
318 { "onboard-ei", BRD_ONBOARDE },
319 { "onboard/ei", BRD_ONBOARDE },
320 { "7", BRD_ONBOARDE },
321 { "ecp", BRD_ECP },
322 { "ecpat", BRD_ECP },
323 { "ec8/64", BRD_ECP },
324 { "ec8/64-at", BRD_ECP },
325 { "ec8/64-isa", BRD_ECP },
326 { "23", BRD_ECP },
327 { "ecpe", BRD_ECPE },
328 { "ecpei", BRD_ECPE },
329 { "ec8/64-e", BRD_ECPE },
330 { "ec8/64-ei", BRD_ECPE },
331 { "24", BRD_ECPE },
332 { "ecpmc", BRD_ECPMC },
333 { "ec8/64-mc", BRD_ECPMC },
334 { "ec8/64-mca", BRD_ECPMC },
335 { "25", BRD_ECPMC },
336 { "ecppci", BRD_ECPPCI },
337 { "ec/ra", BRD_ECPPCI },
338 { "ec/ra-pc", BRD_ECPPCI },
339 { "ec/ra-pci", BRD_ECPPCI },
340 { "29", BRD_ECPPCI },
341};
342
343/*
344 * Define the module agruments.
345 */
346MODULE_AUTHOR("Greg Ungerer");
347MODULE_DESCRIPTION("Stallion Intelligent Multiport Serial Driver");
348MODULE_LICENSE("GPL");
349
350
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800351module_param_array(board0, charp, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352MODULE_PARM_DESC(board0, "Board 0 config -> name[,ioaddr[,memaddr]");
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800353module_param_array(board1, charp, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354MODULE_PARM_DESC(board1, "Board 1 config -> name[,ioaddr[,memaddr]");
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800355module_param_array(board2, charp, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356MODULE_PARM_DESC(board2, "Board 2 config -> name[,ioaddr[,memaddr]");
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800357module_param_array(board3, charp, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358MODULE_PARM_DESC(board3, "Board 3 config -> name[,ioaddr[,memaddr]");
359
Jiri Slabya00f33f2006-12-08 02:39:20 -0800360#if STLI_EISAPROBE != 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361/*
362 * Set up a default memory address table for EISA board probing.
363 * The default addresses are all bellow 1Mbyte, which has to be the
364 * case anyway. They should be safe, since we only read values from
365 * them, and interrupts are disabled while we do it. If the higher
366 * memory support is compiled in then we also try probing around
367 * the 1Gb, 2Gb and 3Gb areas as well...
368 */
369static unsigned long stli_eisamemprobeaddrs[] = {
370 0xc0000, 0xd0000, 0xe0000, 0xf0000,
371 0x80000000, 0x80010000, 0x80020000, 0x80030000,
372 0x40000000, 0x40010000, 0x40020000, 0x40030000,
373 0xc0000000, 0xc0010000, 0xc0020000, 0xc0030000,
374 0xff000000, 0xff010000, 0xff020000, 0xff030000,
375};
376
Tobias Klauserfe971072006-01-09 20:54:02 -0800377static int stli_eisamempsize = ARRAY_SIZE(stli_eisamemprobeaddrs);
Jiri Slabya00f33f2006-12-08 02:39:20 -0800378#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379
380/*
381 * Define the Stallion PCI vendor and device IDs.
382 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383#ifndef PCI_DEVICE_ID_ECRA
384#define PCI_DEVICE_ID_ECRA 0x0004
385#endif
386
387static struct pci_device_id istallion_pci_tbl[] = {
Alan Cox4ac43602006-06-28 04:26:52 -0700388 { PCI_DEVICE(PCI_VENDOR_ID_STALLION, PCI_DEVICE_ID_ECRA), },
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389 { 0 }
390};
391MODULE_DEVICE_TABLE(pci, istallion_pci_tbl);
392
Jiri Slaby845bead2006-12-08 02:39:17 -0800393static struct pci_driver stli_pcidriver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394
395/*****************************************************************************/
396
397/*
398 * Hardware configuration info for ECP boards. These defines apply
399 * to the directly accessible io ports of the ECP. There is a set of
400 * defines for each ECP board type, ISA, EISA, MCA and PCI.
401 */
402#define ECP_IOSIZE 4
403
404#define ECP_MEMSIZE (128 * 1024)
405#define ECP_PCIMEMSIZE (256 * 1024)
406
407#define ECP_ATPAGESIZE (4 * 1024)
408#define ECP_MCPAGESIZE (4 * 1024)
409#define ECP_EIPAGESIZE (64 * 1024)
410#define ECP_PCIPAGESIZE (64 * 1024)
411
412#define STL_EISAID 0x8c4e
413
414/*
415 * Important defines for the ISA class of ECP board.
416 */
417#define ECP_ATIREG 0
418#define ECP_ATCONFR 1
419#define ECP_ATMEMAR 2
420#define ECP_ATMEMPR 3
421#define ECP_ATSTOP 0x1
422#define ECP_ATINTENAB 0x10
423#define ECP_ATENABLE 0x20
424#define ECP_ATDISABLE 0x00
425#define ECP_ATADDRMASK 0x3f000
426#define ECP_ATADDRSHFT 12
427
428/*
429 * Important defines for the EISA class of ECP board.
430 */
431#define ECP_EIIREG 0
432#define ECP_EIMEMARL 1
433#define ECP_EICONFR 2
434#define ECP_EIMEMARH 3
435#define ECP_EIENABLE 0x1
436#define ECP_EIDISABLE 0x0
437#define ECP_EISTOP 0x4
438#define ECP_EIEDGE 0x00
439#define ECP_EILEVEL 0x80
440#define ECP_EIADDRMASKL 0x00ff0000
441#define ECP_EIADDRSHFTL 16
442#define ECP_EIADDRMASKH 0xff000000
443#define ECP_EIADDRSHFTH 24
444#define ECP_EIBRDENAB 0xc84
445
446#define ECP_EISAID 0x4
447
448/*
449 * Important defines for the Micro-channel class of ECP board.
450 * (It has a lot in common with the ISA boards.)
451 */
452#define ECP_MCIREG 0
453#define ECP_MCCONFR 1
454#define ECP_MCSTOP 0x20
455#define ECP_MCENABLE 0x80
456#define ECP_MCDISABLE 0x00
457
458/*
459 * Important defines for the PCI class of ECP board.
460 * (It has a lot in common with the other ECP boards.)
461 */
462#define ECP_PCIIREG 0
463#define ECP_PCICONFR 1
464#define ECP_PCISTOP 0x01
465
466/*
467 * Hardware configuration info for ONboard and Brumby boards. These
468 * defines apply to the directly accessible io ports of these boards.
469 */
470#define ONB_IOSIZE 16
471#define ONB_MEMSIZE (64 * 1024)
472#define ONB_ATPAGESIZE (64 * 1024)
473#define ONB_MCPAGESIZE (64 * 1024)
474#define ONB_EIMEMSIZE (128 * 1024)
475#define ONB_EIPAGESIZE (64 * 1024)
476
477/*
478 * Important defines for the ISA class of ONboard board.
479 */
480#define ONB_ATIREG 0
481#define ONB_ATMEMAR 1
482#define ONB_ATCONFR 2
483#define ONB_ATSTOP 0x4
484#define ONB_ATENABLE 0x01
485#define ONB_ATDISABLE 0x00
486#define ONB_ATADDRMASK 0xff0000
487#define ONB_ATADDRSHFT 16
488
489#define ONB_MEMENABLO 0
490#define ONB_MEMENABHI 0x02
491
492/*
493 * Important defines for the EISA class of ONboard board.
494 */
495#define ONB_EIIREG 0
496#define ONB_EIMEMARL 1
497#define ONB_EICONFR 2
498#define ONB_EIMEMARH 3
499#define ONB_EIENABLE 0x1
500#define ONB_EIDISABLE 0x0
501#define ONB_EISTOP 0x4
502#define ONB_EIEDGE 0x00
503#define ONB_EILEVEL 0x80
504#define ONB_EIADDRMASKL 0x00ff0000
505#define ONB_EIADDRSHFTL 16
506#define ONB_EIADDRMASKH 0xff000000
507#define ONB_EIADDRSHFTH 24
508#define ONB_EIBRDENAB 0xc84
509
510#define ONB_EISAID 0x1
511
512/*
513 * Important defines for the Brumby boards. They are pretty simple,
514 * there is not much that is programmably configurable.
515 */
516#define BBY_IOSIZE 16
517#define BBY_MEMSIZE (64 * 1024)
518#define BBY_PAGESIZE (16 * 1024)
519
520#define BBY_ATIREG 0
521#define BBY_ATCONFR 1
522#define BBY_ATSTOP 0x4
523
524/*
525 * Important defines for the Stallion boards. They are pretty simple,
526 * there is not much that is programmably configurable.
527 */
528#define STAL_IOSIZE 16
529#define STAL_MEMSIZE (64 * 1024)
530#define STAL_PAGESIZE (64 * 1024)
531
532/*
533 * Define the set of status register values for EasyConnection panels.
534 * The signature will return with the status value for each panel. From
535 * this we can determine what is attached to the board - before we have
536 * actually down loaded any code to it.
537 */
538#define ECH_PNLSTATUS 2
539#define ECH_PNL16PORT 0x20
540#define ECH_PNLIDMASK 0x07
541#define ECH_PNLXPID 0x40
542#define ECH_PNLINTRPEND 0x80
543
544/*
545 * Define some macros to do things to the board. Even those these boards
546 * are somewhat related there is often significantly different ways of
547 * doing some operation on it (like enable, paging, reset, etc). So each
548 * board class has a set of functions which do the commonly required
549 * operations. The macros below basically just call these functions,
550 * generally checking for a NULL function - which means that the board
551 * needs nothing done to it to achieve this operation!
552 */
553#define EBRDINIT(brdp) \
554 if (brdp->init != NULL) \
555 (* brdp->init)(brdp)
556
557#define EBRDENABLE(brdp) \
558 if (brdp->enable != NULL) \
559 (* brdp->enable)(brdp);
560
561#define EBRDDISABLE(brdp) \
562 if (brdp->disable != NULL) \
563 (* brdp->disable)(brdp);
564
565#define EBRDINTR(brdp) \
566 if (brdp->intr != NULL) \
567 (* brdp->intr)(brdp);
568
569#define EBRDRESET(brdp) \
570 if (brdp->reset != NULL) \
571 (* brdp->reset)(brdp);
572
573#define EBRDGETMEMPTR(brdp,offset) \
574 (* brdp->getmemptr)(brdp, offset, __LINE__)
575
576/*
577 * Define the maximal baud rate, and the default baud base for ports.
578 */
579#define STL_MAXBAUD 460800
580#define STL_BAUDBASE 115200
581#define STL_CLOSEDELAY (5 * HZ / 10)
582
583/*****************************************************************************/
584
585/*
586 * Define macros to extract a brd or port number from a minor number.
587 */
588#define MINOR2BRD(min) (((min) & 0xc0) >> 6)
589#define MINOR2PORT(min) ((min) & 0x3f)
590
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591/*****************************************************************************/
592
593/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594 * Prototype all functions in this driver!
595 */
596
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800597static int stli_parsebrd(struct stlconf *confp, char **argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700598static int stli_open(struct tty_struct *tty, struct file *filp);
599static void stli_close(struct tty_struct *tty, struct file *filp);
600static int stli_write(struct tty_struct *tty, const unsigned char *buf, int count);
Wang Chen42a77a12008-07-21 17:48:59 +0800601static int stli_putchar(struct tty_struct *tty, unsigned char ch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602static void stli_flushchars(struct tty_struct *tty);
603static int stli_writeroom(struct tty_struct *tty);
604static int stli_charsinbuffer(struct tty_struct *tty);
605static int stli_ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg);
Alan Cox606d0992006-12-08 02:38:45 -0800606static void stli_settermios(struct tty_struct *tty, struct ktermios *old);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607static void stli_throttle(struct tty_struct *tty);
608static void stli_unthrottle(struct tty_struct *tty);
609static void stli_stop(struct tty_struct *tty);
610static void stli_start(struct tty_struct *tty);
611static void stli_flushbuffer(struct tty_struct *tty);
Alan Cox9e989662008-07-22 11:18:03 +0100612static int stli_breakctl(struct tty_struct *tty, int state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700613static void stli_waituntilsent(struct tty_struct *tty, int timeout);
614static void stli_sendxchar(struct tty_struct *tty, char ch);
615static void stli_hangup(struct tty_struct *tty);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800616static int stli_portinfo(struct stlibrd *brdp, struct stliport *portp, int portnr, char *pos);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800618static int stli_brdinit(struct stlibrd *brdp);
619static int stli_startbrd(struct stlibrd *brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700620static ssize_t stli_memread(struct file *fp, char __user *buf, size_t count, loff_t *offp);
621static ssize_t stli_memwrite(struct file *fp, const char __user *buf, size_t count, loff_t *offp);
622static int stli_memioctl(struct inode *ip, struct file *fp, unsigned int cmd, unsigned long arg);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800623static void stli_brdpoll(struct stlibrd *brdp, cdkhdr_t __iomem *hdrp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700624static void stli_poll(unsigned long arg);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800625static int stli_hostcmd(struct stlibrd *brdp, struct stliport *portp);
Alan Coxd18a7502008-10-13 10:40:07 +0100626static int stli_initopen(struct tty_struct *tty, struct stlibrd *brdp, struct stliport *portp);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800627static int stli_rawopen(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait);
628static int stli_rawclose(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait);
Alan Coxd18a7502008-10-13 10:40:07 +0100629static int stli_setport(struct tty_struct *tty);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800630static int stli_cmdwait(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback);
631static void stli_sendcmd(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback);
632static void __stli_sendcmd(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback);
633static void stli_dodelaycmd(struct stliport *portp, cdkctrl_t __iomem *cp);
Alan Coxd18a7502008-10-13 10:40:07 +0100634static void stli_mkasyport(struct tty_struct *tty, struct stliport *portp, asyport_t *pp, struct ktermios *tiosp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635static void stli_mkasysigs(asysigs_t *sp, int dtr, int rts);
636static long stli_mktiocm(unsigned long sigvalue);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800637static void stli_read(struct stlibrd *brdp, struct stliport *portp);
638static int stli_getserial(struct stliport *portp, struct serial_struct __user *sp);
Alan Coxd18a7502008-10-13 10:40:07 +0100639static int stli_setserial(struct tty_struct *tty, struct serial_struct __user *sp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700640static int stli_getbrdstats(combrd_t __user *bp);
Alan Coxd18a7502008-10-13 10:40:07 +0100641static int stli_getportstats(struct tty_struct *tty, struct stliport *portp, comstats_t __user *cp);
642static int stli_portcmdstats(struct tty_struct *tty, struct stliport *portp);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800643static int stli_clrportstats(struct stliport *portp, comstats_t __user *cp);
644static int stli_getportstruct(struct stliport __user *arg);
645static int stli_getbrdstruct(struct stlibrd __user *arg);
646static struct stlibrd *stli_allocbrd(void);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800648static void stli_ecpinit(struct stlibrd *brdp);
649static void stli_ecpenable(struct stlibrd *brdp);
650static void stli_ecpdisable(struct stlibrd *brdp);
651static void __iomem *stli_ecpgetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
652static void stli_ecpreset(struct stlibrd *brdp);
653static void stli_ecpintr(struct stlibrd *brdp);
654static void stli_ecpeiinit(struct stlibrd *brdp);
655static void stli_ecpeienable(struct stlibrd *brdp);
656static void stli_ecpeidisable(struct stlibrd *brdp);
657static void __iomem *stli_ecpeigetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
658static void stli_ecpeireset(struct stlibrd *brdp);
659static void stli_ecpmcenable(struct stlibrd *brdp);
660static void stli_ecpmcdisable(struct stlibrd *brdp);
661static void __iomem *stli_ecpmcgetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
662static void stli_ecpmcreset(struct stlibrd *brdp);
663static void stli_ecppciinit(struct stlibrd *brdp);
664static void __iomem *stli_ecppcigetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
665static void stli_ecppcireset(struct stlibrd *brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800667static void stli_onbinit(struct stlibrd *brdp);
668static void stli_onbenable(struct stlibrd *brdp);
669static void stli_onbdisable(struct stlibrd *brdp);
670static void __iomem *stli_onbgetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
671static void stli_onbreset(struct stlibrd *brdp);
672static void stli_onbeinit(struct stlibrd *brdp);
673static void stli_onbeenable(struct stlibrd *brdp);
674static void stli_onbedisable(struct stlibrd *brdp);
675static void __iomem *stli_onbegetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
676static void stli_onbereset(struct stlibrd *brdp);
677static void stli_bbyinit(struct stlibrd *brdp);
678static void __iomem *stli_bbygetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
679static void stli_bbyreset(struct stlibrd *brdp);
680static void stli_stalinit(struct stlibrd *brdp);
681static void __iomem *stli_stalgetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
682static void stli_stalreset(struct stlibrd *brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683
Jiri Slaby1328d732006-12-08 02:39:19 -0800684static struct stliport *stli_getport(unsigned int brdnr, unsigned int panelnr, unsigned int portnr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700685
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800686static int stli_initecp(struct stlibrd *brdp);
687static int stli_initonb(struct stlibrd *brdp);
Jiri Slabya00f33f2006-12-08 02:39:20 -0800688#if STLI_EISAPROBE != 0
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800689static int stli_eisamemprobe(struct stlibrd *brdp);
Jiri Slabya00f33f2006-12-08 02:39:20 -0800690#endif
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800691static int stli_initports(struct stlibrd *brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693/*****************************************************************************/
694
695/*
696 * Define the driver info for a user level shared memory device. This
697 * device will work sort of like the /dev/kmem device - except that it
698 * will give access to the shared memory on the Stallion intelligent
699 * board. This is also a very useful debugging tool.
700 */
Arjan van de Ven62322d22006-07-03 00:24:21 -0700701static const struct file_operations stli_fsiomem = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 .owner = THIS_MODULE,
703 .read = stli_memread,
704 .write = stli_memwrite,
705 .ioctl = stli_memioctl,
706};
707
708/*****************************************************************************/
709
710/*
711 * Define a timer_list entry for our poll routine. The slave board
712 * is polled every so often to see if anything needs doing. This is
713 * much cheaper on host cpu than using interrupts. It turns out to
714 * not increase character latency by much either...
715 */
Ingo Molnar8d06afa2005-09-09 13:10:40 -0700716static DEFINE_TIMER(stli_timerlist, stli_poll, 0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700717
718static int stli_timeron;
719
720/*
721 * Define the calculation for the timeout routine.
722 */
723#define STLI_TIMEOUT (jiffies + 1)
724
725/*****************************************************************************/
726
gregkh@suse.deca8eca62005-03-23 09:53:09 -0800727static struct class *istallion_class;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700728
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800729static void stli_cleanup_ports(struct stlibrd *brdp)
Jiri Slaby845bead2006-12-08 02:39:17 -0800730{
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800731 struct stliport *portp;
Jiri Slaby845bead2006-12-08 02:39:17 -0800732 unsigned int j;
Alan Coxd18a7502008-10-13 10:40:07 +0100733 struct tty_struct *tty;
Jiri Slaby845bead2006-12-08 02:39:17 -0800734
735 for (j = 0; j < STL_MAXPORTS; j++) {
736 portp = brdp->ports[j];
737 if (portp != NULL) {
Alan Coxd18a7502008-10-13 10:40:07 +0100738 tty = tty_port_tty_get(&portp->port);
739 if (tty != NULL) {
740 tty_hangup(tty);
741 tty_kref_put(tty);
742 }
Jiri Slaby845bead2006-12-08 02:39:17 -0800743 kfree(portp);
744 }
745 }
746}
747
Linus Torvalds1da177e2005-04-16 15:20:36 -0700748/*****************************************************************************/
749
750/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700751 * Parse the supplied argument string, into the board conf struct.
752 */
753
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800754static int stli_parsebrd(struct stlconf *confp, char **argp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700755{
Jiri Slaby1328d732006-12-08 02:39:19 -0800756 unsigned int i;
Alan Cox4ac43602006-06-28 04:26:52 -0700757 char *sp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700758
Alan Cox4ac43602006-06-28 04:26:52 -0700759 if (argp[0] == NULL || *argp[0] == 0)
760 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761
762 for (sp = argp[0], i = 0; ((*sp != 0) && (i < 25)); sp++, i++)
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800763 *sp = tolower(*sp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700764
Tobias Klauserfe971072006-01-09 20:54:02 -0800765 for (i = 0; i < ARRAY_SIZE(stli_brdstr); i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700766 if (strcmp(stli_brdstr[i].name, argp[0]) == 0)
767 break;
768 }
Tobias Klauserfe971072006-01-09 20:54:02 -0800769 if (i == ARRAY_SIZE(stli_brdstr)) {
Alan Coxa6614992009-01-02 13:46:50 +0000770 printk(KERN_WARNING "istallion: unknown board name, %s?\n", argp[0]);
Tobias Klauserfe971072006-01-09 20:54:02 -0800771 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772 }
773
774 confp->brdtype = stli_brdstr[i].type;
Alan Cox4ac43602006-06-28 04:26:52 -0700775 if (argp[1] != NULL && *argp[1] != 0)
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800776 confp->ioaddr1 = simple_strtoul(argp[1], NULL, 0);
Alan Cox4ac43602006-06-28 04:26:52 -0700777 if (argp[2] != NULL && *argp[2] != 0)
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800778 confp->memaddr = simple_strtoul(argp[2], NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700779 return(1);
780}
781
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782/*****************************************************************************/
783
Linus Torvalds1da177e2005-04-16 15:20:36 -0700784static int stli_open(struct tty_struct *tty, struct file *filp)
785{
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800786 struct stlibrd *brdp;
787 struct stliport *portp;
Alan Cox2a6eadb2009-01-02 13:46:18 +0000788 struct tty_port *port;
Jiri Slaby1328d732006-12-08 02:39:19 -0800789 unsigned int minordev, brdnr, portnr;
790 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700791
792 minordev = tty->index;
793 brdnr = MINOR2BRD(minordev);
794 if (brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -0700795 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700796 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -0700797 if (brdp == NULL)
798 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799 if ((brdp->state & BST_STARTED) == 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700800 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700801 portnr = MINOR2PORT(minordev);
Jiri Slaby1328d732006-12-08 02:39:19 -0800802 if (portnr > brdp->nrports)
Alan Cox4ac43602006-06-28 04:26:52 -0700803 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700804
805 portp = brdp->ports[portnr];
Alan Cox4ac43602006-06-28 04:26:52 -0700806 if (portp == NULL)
807 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700808 if (portp->devnr < 1)
Alan Cox4ac43602006-06-28 04:26:52 -0700809 return -ENODEV;
Alan Cox2a6eadb2009-01-02 13:46:18 +0000810 port = &portp->port;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811
812/*
813 * On the first open of the device setup the port hardware, and
814 * initialize the per port data structure. Since initializing the port
815 * requires several commands to the board we will need to wait for any
816 * other open that is already initializing the port.
Alan Cox2a6eadb2009-01-02 13:46:18 +0000817 *
818 * Review - locking
Linus Torvalds1da177e2005-04-16 15:20:36 -0700819 */
Alan Cox2a6eadb2009-01-02 13:46:18 +0000820 tty_port_tty_set(port, tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821 tty->driver_data = portp;
Alan Cox2a6eadb2009-01-02 13:46:18 +0000822 port->count++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700823
824 wait_event_interruptible(portp->raw_wait,
825 !test_bit(ST_INITIALIZING, &portp->state));
826 if (signal_pending(current))
Alan Cox4ac43602006-06-28 04:26:52 -0700827 return -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700828
Alan Coxb02f5ad62008-07-16 21:55:53 +0100829 if ((portp->port.flags & ASYNC_INITIALIZED) == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700830 set_bit(ST_INITIALIZING, &portp->state);
Alan Coxd18a7502008-10-13 10:40:07 +0100831 if ((rc = stli_initopen(tty, brdp, portp)) >= 0) {
Alan Cox2a6eadb2009-01-02 13:46:18 +0000832 /* Locking */
833 port->flags |= ASYNC_INITIALIZED;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700834 clear_bit(TTY_IO_ERROR, &tty->flags);
835 }
836 clear_bit(ST_INITIALIZING, &portp->state);
837 wake_up_interruptible(&portp->raw_wait);
838 if (rc < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700839 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700840 }
Alan Cox2a6eadb2009-01-02 13:46:18 +0000841 return tty_port_block_til_ready(&portp->port, tty, filp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700842}
843
844/*****************************************************************************/
845
846static void stli_close(struct tty_struct *tty, struct file *filp)
847{
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800848 struct stlibrd *brdp;
849 struct stliport *portp;
Alan Cox2a6eadb2009-01-02 13:46:18 +0000850 struct tty_port *port;
Alan Cox4ac43602006-06-28 04:26:52 -0700851 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700852
853 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -0700854 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700855 return;
Alan Cox2a6eadb2009-01-02 13:46:18 +0000856 port = &portp->port;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857
Alan Coxa6614992009-01-02 13:46:50 +0000858 if (tty_port_close_start(port, tty, filp) == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700859 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860
861/*
862 * May want to wait for data to drain before closing. The BUSY flag
863 * keeps track of whether we are still transmitting or not. It is
864 * updated by messages from the slave - indicating when all chars
865 * really have drained.
866 */
Alan Cox2a6eadb2009-01-02 13:46:18 +0000867 spin_lock_irqsave(&stli_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868 if (tty == stli_txcooktty)
869 stli_flushchars(tty);
Alan Cox4ac43602006-06-28 04:26:52 -0700870 spin_unlock_irqrestore(&stli_lock, flags);
871
Alan Coxa6614992009-01-02 13:46:50 +0000872 /* We end up doing this twice for the moment. This needs looking at
873 eventually. Note we still use portp->closing_wait as a result */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700874 if (portp->closing_wait != ASYNC_CLOSING_WAIT_NONE)
875 tty_wait_until_sent(tty, portp->closing_wait);
876
Alan Cox2a6eadb2009-01-02 13:46:18 +0000877 /* FIXME: port locking here needs attending to */
878 port->flags &= ~ASYNC_INITIALIZED;
879
Linus Torvalds1da177e2005-04-16 15:20:36 -0700880 brdp = stli_brds[portp->brdnr];
881 stli_rawclose(brdp, portp, 0, 0);
882 if (tty->termios->c_cflag & HUPCL) {
883 stli_mkasysigs(&portp->asig, 0, 0);
884 if (test_bit(ST_CMDING, &portp->state))
885 set_bit(ST_DOSIGS, &portp->state);
886 else
887 stli_sendcmd(brdp, portp, A_SETSIGNALS, &portp->asig,
888 sizeof(asysigs_t), 0);
889 }
890 clear_bit(ST_TXBUSY, &portp->state);
891 clear_bit(ST_RXSTOP, &portp->state);
892 set_bit(TTY_IO_ERROR, &tty->flags);
Alan Coxed569bf2008-07-22 13:44:14 +0100893 tty_ldisc_flush(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700894 set_bit(ST_DOFLUSHRX, &portp->state);
895 stli_flushbuffer(tty);
896
Alan Coxa6614992009-01-02 13:46:50 +0000897 tty_port_close_end(port, tty);
898 tty_port_tty_set(port, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700899}
900
901/*****************************************************************************/
902
903/*
904 * Carry out first open operations on a port. This involves a number of
905 * commands to be sent to the slave. We need to open the port, set the
906 * notification events, set the initial port settings, get and set the
907 * initial signal values. We sleep and wait in between each one. But
908 * this still all happens pretty quickly.
909 */
910
Alan Coxd18a7502008-10-13 10:40:07 +0100911static int stli_initopen(struct tty_struct *tty,
912 struct stlibrd *brdp, struct stliport *portp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700913{
Alan Cox4ac43602006-06-28 04:26:52 -0700914 asynotify_t nt;
915 asyport_t aport;
916 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917
918 if ((rc = stli_rawopen(brdp, portp, 0, 1)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700919 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700920
921 memset(&nt, 0, sizeof(asynotify_t));
922 nt.data = (DT_TXLOW | DT_TXEMPTY | DT_RXBUSY | DT_RXBREAK);
923 nt.signal = SG_DCD;
924 if ((rc = stli_cmdwait(brdp, portp, A_SETNOTIFY, &nt,
925 sizeof(asynotify_t), 0)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700926 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700927
Alan Coxd18a7502008-10-13 10:40:07 +0100928 stli_mkasyport(tty, portp, &aport, tty->termios);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700929 if ((rc = stli_cmdwait(brdp, portp, A_SETPORT, &aport,
930 sizeof(asyport_t), 0)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700931 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700932
933 set_bit(ST_GETSIGS, &portp->state);
934 if ((rc = stli_cmdwait(brdp, portp, A_GETSIGNALS, &portp->asig,
935 sizeof(asysigs_t), 1)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700936 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 if (test_and_clear_bit(ST_GETSIGS, &portp->state))
938 portp->sigs = stli_mktiocm(portp->asig.sigvalue);
939 stli_mkasysigs(&portp->asig, 1, 1);
940 if ((rc = stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
941 sizeof(asysigs_t), 0)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700942 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700943
Alan Cox4ac43602006-06-28 04:26:52 -0700944 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700945}
946
947/*****************************************************************************/
948
949/*
950 * Send an open message to the slave. This will sleep waiting for the
951 * acknowledgement, so must have user context. We need to co-ordinate
952 * with close events here, since we don't want open and close events
953 * to overlap.
954 */
955
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800956static int stli_rawopen(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700957{
Alan Cox4ac43602006-06-28 04:26:52 -0700958 cdkhdr_t __iomem *hdrp;
959 cdkctrl_t __iomem *cp;
960 unsigned char __iomem *bits;
961 unsigned long flags;
962 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700963
964/*
965 * Send a message to the slave to open this port.
966 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700967
968/*
969 * Slave is already closing this port. This can happen if a hangup
970 * occurs on this port. So we must wait until it is complete. The
971 * order of opens and closes may not be preserved across shared
972 * memory, so we must wait until it is complete.
973 */
974 wait_event_interruptible(portp->raw_wait,
975 !test_bit(ST_CLOSING, &portp->state));
976 if (signal_pending(current)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700977 return -ERESTARTSYS;
978 }
979
980/*
981 * Everything is ready now, so write the open message into shared
982 * memory. Once the message is in set the service bits to say that
983 * this port wants service.
984 */
Alan Cox4ac43602006-06-28 04:26:52 -0700985 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700986 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -0700987 cp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl;
988 writel(arg, &cp->openarg);
989 writeb(1, &cp->open);
990 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
991 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -0700992 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -0700993 writeb(readb(bits) | portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994 EBRDDISABLE(brdp);
995
996 if (wait == 0) {
Alan Cox4ac43602006-06-28 04:26:52 -0700997 spin_unlock_irqrestore(&brd_lock, flags);
998 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700999 }
1000
1001/*
1002 * Slave is in action, so now we must wait for the open acknowledgment
1003 * to come back.
1004 */
1005 rc = 0;
1006 set_bit(ST_OPENING, &portp->state);
Alan Cox4ac43602006-06-28 04:26:52 -07001007 spin_unlock_irqrestore(&brd_lock, flags);
1008
Linus Torvalds1da177e2005-04-16 15:20:36 -07001009 wait_event_interruptible(portp->raw_wait,
1010 !test_bit(ST_OPENING, &portp->state));
1011 if (signal_pending(current))
1012 rc = -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001013
1014 if ((rc == 0) && (portp->rc != 0))
1015 rc = -EIO;
Alan Cox4ac43602006-06-28 04:26:52 -07001016 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001017}
1018
1019/*****************************************************************************/
1020
1021/*
1022 * Send a close message to the slave. Normally this will sleep waiting
1023 * for the acknowledgement, but if wait parameter is 0 it will not. If
1024 * wait is true then must have user context (to sleep).
1025 */
1026
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001027static int stli_rawclose(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001028{
Alan Cox4ac43602006-06-28 04:26:52 -07001029 cdkhdr_t __iomem *hdrp;
1030 cdkctrl_t __iomem *cp;
1031 unsigned char __iomem *bits;
1032 unsigned long flags;
1033 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001034
1035/*
1036 * Slave is already closing this port. This can happen if a hangup
1037 * occurs on this port.
1038 */
1039 if (wait) {
1040 wait_event_interruptible(portp->raw_wait,
1041 !test_bit(ST_CLOSING, &portp->state));
1042 if (signal_pending(current)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043 return -ERESTARTSYS;
1044 }
1045 }
1046
1047/*
1048 * Write the close command into shared memory.
1049 */
Alan Cox4ac43602006-06-28 04:26:52 -07001050 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001052 cp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl;
1053 writel(arg, &cp->closearg);
1054 writeb(1, &cp->close);
1055 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1056 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -07001057 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -07001058 writeb(readb(bits) |portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001059 EBRDDISABLE(brdp);
1060
1061 set_bit(ST_CLOSING, &portp->state);
Alan Cox4ac43602006-06-28 04:26:52 -07001062 spin_unlock_irqrestore(&brd_lock, flags);
1063
1064 if (wait == 0)
1065 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066
1067/*
1068 * Slave is in action, so now we must wait for the open acknowledgment
1069 * to come back.
1070 */
1071 rc = 0;
1072 wait_event_interruptible(portp->raw_wait,
1073 !test_bit(ST_CLOSING, &portp->state));
1074 if (signal_pending(current))
1075 rc = -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001076
1077 if ((rc == 0) && (portp->rc != 0))
1078 rc = -EIO;
Alan Cox4ac43602006-06-28 04:26:52 -07001079 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001080}
1081
1082/*****************************************************************************/
1083
1084/*
1085 * Send a command to the slave and wait for the response. This must
1086 * have user context (it sleeps). This routine is generic in that it
1087 * can send any type of command. Its purpose is to wait for that command
1088 * to complete (as opposed to initiating the command then returning).
1089 */
1090
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001091static int stli_cmdwait(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001092{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001093 wait_event_interruptible(portp->raw_wait,
1094 !test_bit(ST_CMDING, &portp->state));
Alan Cox4ac43602006-06-28 04:26:52 -07001095 if (signal_pending(current))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001096 return -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001097
1098 stli_sendcmd(brdp, portp, cmd, arg, size, copyback);
1099
1100 wait_event_interruptible(portp->raw_wait,
1101 !test_bit(ST_CMDING, &portp->state));
Alan Cox4ac43602006-06-28 04:26:52 -07001102 if (signal_pending(current))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001103 return -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001104
1105 if (portp->rc != 0)
Alan Cox4ac43602006-06-28 04:26:52 -07001106 return -EIO;
1107 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001108}
1109
1110/*****************************************************************************/
1111
1112/*
1113 * Send the termios settings for this port to the slave. This sleeps
1114 * waiting for the command to complete - so must have user context.
1115 */
1116
Alan Coxd18a7502008-10-13 10:40:07 +01001117static int stli_setport(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001118{
Alan Coxd18a7502008-10-13 10:40:07 +01001119 struct stliport *portp = tty->driver_data;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001120 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001121 asyport_t aport;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001122
Alan Cox4ac43602006-06-28 04:26:52 -07001123 if (portp == NULL)
1124 return -ENODEV;
Jiri Slaby1328d732006-12-08 02:39:19 -08001125 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001126 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001127 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001128 if (brdp == NULL)
1129 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001130
Alan Coxd18a7502008-10-13 10:40:07 +01001131 stli_mkasyport(tty, portp, &aport, tty->termios);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001132 return(stli_cmdwait(brdp, portp, A_SETPORT, &aport, sizeof(asyport_t), 0));
1133}
1134
1135/*****************************************************************************/
1136
Alan Cox31f35932009-01-02 13:45:05 +00001137static int stli_carrier_raised(struct tty_port *port)
1138{
1139 struct stliport *portp = container_of(port, struct stliport, port);
1140 return (portp->sigs & TIOCM_CD) ? 1 : 0;
1141}
1142
Alan Cox2a6eadb2009-01-02 13:46:18 +00001143static void stli_raise_dtr_rts(struct tty_port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001144{
Alan Cox2a6eadb2009-01-02 13:46:18 +00001145 struct stliport *portp = container_of(port, struct stliport, port);
1146 struct stlibrd *brdp = stli_brds[portp->brdnr];
1147 stli_mkasysigs(&portp->asig, 1, 1);
1148 if (stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
1149 sizeof(asysigs_t), 0) < 0)
1150 printk(KERN_WARNING "istallion: dtr raise failed.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001151}
1152
Alan Cox2a6eadb2009-01-02 13:46:18 +00001153
Linus Torvalds1da177e2005-04-16 15:20:36 -07001154/*****************************************************************************/
1155
1156/*
1157 * Write routine. Take the data and put it in the shared memory ring
1158 * queue. If port is not already sending chars then need to mark the
1159 * service bits for this port.
1160 */
1161
1162static int stli_write(struct tty_struct *tty, const unsigned char *buf, int count)
1163{
Alan Cox4ac43602006-06-28 04:26:52 -07001164 cdkasy_t __iomem *ap;
1165 cdkhdr_t __iomem *hdrp;
1166 unsigned char __iomem *bits;
1167 unsigned char __iomem *shbuf;
1168 unsigned char *chbuf;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001169 struct stliport *portp;
1170 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001171 unsigned int len, stlen, head, tail, size;
1172 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001173
Linus Torvalds1da177e2005-04-16 15:20:36 -07001174 if (tty == stli_txcooktty)
1175 stli_flushchars(tty);
1176 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001177 if (portp == NULL)
1178 return 0;
Jiri Slaby1328d732006-12-08 02:39:19 -08001179 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001180 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001181 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001182 if (brdp == NULL)
1183 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001184 chbuf = (unsigned char *) buf;
1185
1186/*
1187 * All data is now local, shove as much as possible into shared memory.
1188 */
Alan Cox4ac43602006-06-28 04:26:52 -07001189 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001190 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001191 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
1192 head = (unsigned int) readw(&ap->txq.head);
1193 tail = (unsigned int) readw(&ap->txq.tail);
1194 if (tail != ((unsigned int) readw(&ap->txq.tail)))
1195 tail = (unsigned int) readw(&ap->txq.tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001196 size = portp->txsize;
1197 if (head >= tail) {
1198 len = size - (head - tail) - 1;
1199 stlen = size - head;
1200 } else {
1201 len = tail - head - 1;
1202 stlen = len;
1203 }
1204
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08001205 len = min(len, (unsigned int)count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001206 count = 0;
Alan Cox4ac43602006-06-28 04:26:52 -07001207 shbuf = (char __iomem *) EBRDGETMEMPTR(brdp, portp->txoffset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001208
1209 while (len > 0) {
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08001210 stlen = min(len, stlen);
Alan Cox4ac43602006-06-28 04:26:52 -07001211 memcpy_toio(shbuf + head, chbuf, stlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001212 chbuf += stlen;
1213 len -= stlen;
1214 count += stlen;
1215 head += stlen;
1216 if (head >= size) {
1217 head = 0;
1218 stlen = tail;
1219 }
1220 }
1221
Alan Cox4ac43602006-06-28 04:26:52 -07001222 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
1223 writew(head, &ap->txq.head);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001224 if (test_bit(ST_TXBUSY, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07001225 if (readl(&ap->changed.data) & DT_TXEMPTY)
1226 writel(readl(&ap->changed.data) & ~DT_TXEMPTY, &ap->changed.data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001227 }
Alan Cox4ac43602006-06-28 04:26:52 -07001228 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1229 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -07001230 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -07001231 writeb(readb(bits) | portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001232 set_bit(ST_TXBUSY, &portp->state);
1233 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001234 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001235
1236 return(count);
1237}
1238
1239/*****************************************************************************/
1240
1241/*
1242 * Output a single character. We put it into a temporary local buffer
1243 * (for speed) then write out that buffer when the flushchars routine
1244 * is called. There is a safety catch here so that if some other port
1245 * writes chars before the current buffer has been, then we write them
1246 * first them do the new ports.
1247 */
1248
Wang Chen42a77a12008-07-21 17:48:59 +08001249static int stli_putchar(struct tty_struct *tty, unsigned char ch)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001250{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001251 if (tty != stli_txcooktty) {
Alan Cox4ac43602006-06-28 04:26:52 -07001252 if (stli_txcooktty != NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001253 stli_flushchars(stli_txcooktty);
1254 stli_txcooktty = tty;
1255 }
1256
1257 stli_txcookbuf[stli_txcooksize++] = ch;
Wang Chen42a77a12008-07-21 17:48:59 +08001258 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001259}
1260
1261/*****************************************************************************/
1262
1263/*
1264 * Transfer characters from the local TX cooking buffer to the board.
1265 * We sort of ignore the tty that gets passed in here. We rely on the
1266 * info stored with the TX cook buffer to tell us which port to flush
1267 * the data on. In any case we clean out the TX cook buffer, for re-use
1268 * by someone else.
1269 */
1270
1271static void stli_flushchars(struct tty_struct *tty)
1272{
Alan Cox4ac43602006-06-28 04:26:52 -07001273 cdkhdr_t __iomem *hdrp;
1274 unsigned char __iomem *bits;
1275 cdkasy_t __iomem *ap;
1276 struct tty_struct *cooktty;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001277 struct stliport *portp;
1278 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001279 unsigned int len, stlen, head, tail, size, count, cooksize;
1280 unsigned char *buf;
1281 unsigned char __iomem *shbuf;
1282 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001283
1284 cooksize = stli_txcooksize;
1285 cooktty = stli_txcooktty;
1286 stli_txcooksize = 0;
1287 stli_txcookrealsize = 0;
Alan Cox4ac43602006-06-28 04:26:52 -07001288 stli_txcooktty = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001289
Alan Cox4ac43602006-06-28 04:26:52 -07001290 if (cooktty == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001291 return;
1292 if (tty != cooktty)
1293 tty = cooktty;
1294 if (cooksize == 0)
1295 return;
1296
1297 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001298 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001299 return;
Jiri Slaby1328d732006-12-08 02:39:19 -08001300 if (portp->brdnr >= stli_nrbrds)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001301 return;
1302 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001303 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001304 return;
1305
Alan Cox4ac43602006-06-28 04:26:52 -07001306 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001307 EBRDENABLE(brdp);
1308
Alan Cox4ac43602006-06-28 04:26:52 -07001309 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
1310 head = (unsigned int) readw(&ap->txq.head);
1311 tail = (unsigned int) readw(&ap->txq.tail);
1312 if (tail != ((unsigned int) readw(&ap->txq.tail)))
1313 tail = (unsigned int) readw(&ap->txq.tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001314 size = portp->txsize;
1315 if (head >= tail) {
1316 len = size - (head - tail) - 1;
1317 stlen = size - head;
1318 } else {
1319 len = tail - head - 1;
1320 stlen = len;
1321 }
1322
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08001323 len = min(len, cooksize);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001324 count = 0;
Al Viro29756fa2006-10-10 22:47:27 +01001325 shbuf = EBRDGETMEMPTR(brdp, portp->txoffset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001326 buf = stli_txcookbuf;
1327
1328 while (len > 0) {
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08001329 stlen = min(len, stlen);
Alan Cox4ac43602006-06-28 04:26:52 -07001330 memcpy_toio(shbuf + head, buf, stlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001331 buf += stlen;
1332 len -= stlen;
1333 count += stlen;
1334 head += stlen;
1335 if (head >= size) {
1336 head = 0;
1337 stlen = tail;
1338 }
1339 }
1340
Alan Cox4ac43602006-06-28 04:26:52 -07001341 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
1342 writew(head, &ap->txq.head);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001343
1344 if (test_bit(ST_TXBUSY, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07001345 if (readl(&ap->changed.data) & DT_TXEMPTY)
1346 writel(readl(&ap->changed.data) & ~DT_TXEMPTY, &ap->changed.data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001347 }
Alan Cox4ac43602006-06-28 04:26:52 -07001348 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1349 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -07001350 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -07001351 writeb(readb(bits) | portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352 set_bit(ST_TXBUSY, &portp->state);
1353
1354 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001355 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001356}
1357
1358/*****************************************************************************/
1359
1360static int stli_writeroom(struct tty_struct *tty)
1361{
Alan Cox4ac43602006-06-28 04:26:52 -07001362 cdkasyrq_t __iomem *rp;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001363 struct stliport *portp;
1364 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001365 unsigned int head, tail, len;
1366 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001367
Linus Torvalds1da177e2005-04-16 15:20:36 -07001368 if (tty == stli_txcooktty) {
1369 if (stli_txcookrealsize != 0) {
1370 len = stli_txcookrealsize - stli_txcooksize;
Alan Cox4ac43602006-06-28 04:26:52 -07001371 return len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001372 }
1373 }
1374
1375 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001376 if (portp == NULL)
1377 return 0;
Jiri Slaby1328d732006-12-08 02:39:19 -08001378 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001379 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001380 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001381 if (brdp == NULL)
1382 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001383
Alan Cox4ac43602006-06-28 04:26:52 -07001384 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001385 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001386 rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->txq;
1387 head = (unsigned int) readw(&rp->head);
1388 tail = (unsigned int) readw(&rp->tail);
1389 if (tail != ((unsigned int) readw(&rp->tail)))
1390 tail = (unsigned int) readw(&rp->tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001391 len = (head >= tail) ? (portp->txsize - (head - tail)) : (tail - head);
1392 len--;
1393 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001394 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001395
1396 if (tty == stli_txcooktty) {
1397 stli_txcookrealsize = len;
1398 len -= stli_txcooksize;
1399 }
Alan Cox4ac43602006-06-28 04:26:52 -07001400 return len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001401}
1402
1403/*****************************************************************************/
1404
1405/*
1406 * Return the number of characters in the transmit buffer. Normally we
1407 * will return the number of chars in the shared memory ring queue.
1408 * We need to kludge around the case where the shared memory buffer is
1409 * empty but not all characters have drained yet, for this case just
1410 * return that there is 1 character in the buffer!
1411 */
1412
1413static int stli_charsinbuffer(struct tty_struct *tty)
1414{
Alan Cox4ac43602006-06-28 04:26:52 -07001415 cdkasyrq_t __iomem *rp;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001416 struct stliport *portp;
1417 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001418 unsigned int head, tail, len;
1419 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001420
Linus Torvalds1da177e2005-04-16 15:20:36 -07001421 if (tty == stli_txcooktty)
1422 stli_flushchars(tty);
1423 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001424 if (portp == NULL)
1425 return 0;
Jiri Slaby1328d732006-12-08 02:39:19 -08001426 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001427 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001428 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001429 if (brdp == NULL)
1430 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001431
Alan Cox4ac43602006-06-28 04:26:52 -07001432 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001433 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001434 rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->txq;
1435 head = (unsigned int) readw(&rp->head);
1436 tail = (unsigned int) readw(&rp->tail);
1437 if (tail != ((unsigned int) readw(&rp->tail)))
1438 tail = (unsigned int) readw(&rp->tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001439 len = (head >= tail) ? (head - tail) : (portp->txsize - (tail - head));
1440 if ((len == 0) && test_bit(ST_TXBUSY, &portp->state))
1441 len = 1;
1442 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001443 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001444
Alan Cox4ac43602006-06-28 04:26:52 -07001445 return len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001446}
1447
1448/*****************************************************************************/
1449
1450/*
1451 * Generate the serial struct info.
1452 */
1453
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001454static int stli_getserial(struct stliport *portp, struct serial_struct __user *sp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001455{
Alan Cox4ac43602006-06-28 04:26:52 -07001456 struct serial_struct sio;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001457 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001458
1459 memset(&sio, 0, sizeof(struct serial_struct));
1460 sio.type = PORT_UNKNOWN;
1461 sio.line = portp->portnr;
1462 sio.irq = 0;
Alan Coxb02f5ad62008-07-16 21:55:53 +01001463 sio.flags = portp->port.flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001464 sio.baud_base = portp->baud_base;
Alan Coxa6614992009-01-02 13:46:50 +00001465 sio.close_delay = portp->port.close_delay;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001466 sio.closing_wait = portp->closing_wait;
1467 sio.custom_divisor = portp->custom_divisor;
1468 sio.xmit_fifo_size = 0;
1469 sio.hub6 = 0;
1470
1471 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001472 if (brdp != NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001473 sio.port = brdp->iobase;
1474
1475 return copy_to_user(sp, &sio, sizeof(struct serial_struct)) ?
1476 -EFAULT : 0;
1477}
1478
1479/*****************************************************************************/
1480
1481/*
1482 * Set port according to the serial struct info.
1483 * At this point we do not do any auto-configure stuff, so we will
1484 * just quietly ignore any requests to change irq, etc.
1485 */
1486
Alan Coxd18a7502008-10-13 10:40:07 +01001487static int stli_setserial(struct tty_struct *tty, struct serial_struct __user *sp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001488{
Alan Cox4ac43602006-06-28 04:26:52 -07001489 struct serial_struct sio;
1490 int rc;
Alan Coxd18a7502008-10-13 10:40:07 +01001491 struct stliport *portp = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001492
1493 if (copy_from_user(&sio, sp, sizeof(struct serial_struct)))
1494 return -EFAULT;
1495 if (!capable(CAP_SYS_ADMIN)) {
1496 if ((sio.baud_base != portp->baud_base) ||
Alan Coxa6614992009-01-02 13:46:50 +00001497 (sio.close_delay != portp->port.close_delay) ||
Linus Torvalds1da177e2005-04-16 15:20:36 -07001498 ((sio.flags & ~ASYNC_USR_MASK) !=
Alan Coxb02f5ad62008-07-16 21:55:53 +01001499 (portp->port.flags & ~ASYNC_USR_MASK)))
Alan Cox4ac43602006-06-28 04:26:52 -07001500 return -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001501 }
1502
Alan Coxb02f5ad62008-07-16 21:55:53 +01001503 portp->port.flags = (portp->port.flags & ~ASYNC_USR_MASK) |
Linus Torvalds1da177e2005-04-16 15:20:36 -07001504 (sio.flags & ASYNC_USR_MASK);
1505 portp->baud_base = sio.baud_base;
Alan Coxa6614992009-01-02 13:46:50 +00001506 portp->port.close_delay = sio.close_delay;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001507 portp->closing_wait = sio.closing_wait;
1508 portp->custom_divisor = sio.custom_divisor;
1509
Alan Coxd18a7502008-10-13 10:40:07 +01001510 if ((rc = stli_setport(tty)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -07001511 return rc;
1512 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001513}
1514
1515/*****************************************************************************/
1516
1517static int stli_tiocmget(struct tty_struct *tty, struct file *file)
1518{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001519 struct stliport *portp = tty->driver_data;
1520 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001521 int rc;
1522
Alan Cox4ac43602006-06-28 04:26:52 -07001523 if (portp == NULL)
1524 return -ENODEV;
Jiri Slaby1328d732006-12-08 02:39:19 -08001525 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001526 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001527 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001528 if (brdp == NULL)
1529 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001530 if (tty->flags & (1 << TTY_IO_ERROR))
Alan Cox4ac43602006-06-28 04:26:52 -07001531 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001532
1533 if ((rc = stli_cmdwait(brdp, portp, A_GETSIGNALS,
1534 &portp->asig, sizeof(asysigs_t), 1)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -07001535 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001536
1537 return stli_mktiocm(portp->asig.sigvalue);
1538}
1539
1540static int stli_tiocmset(struct tty_struct *tty, struct file *file,
1541 unsigned int set, unsigned int clear)
1542{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001543 struct stliport *portp = tty->driver_data;
1544 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001545 int rts = -1, dtr = -1;
1546
Alan Cox4ac43602006-06-28 04:26:52 -07001547 if (portp == NULL)
1548 return -ENODEV;
Jiri Slaby1328d732006-12-08 02:39:19 -08001549 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001550 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001551 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001552 if (brdp == NULL)
1553 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001554 if (tty->flags & (1 << TTY_IO_ERROR))
Alan Cox4ac43602006-06-28 04:26:52 -07001555 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001556
1557 if (set & TIOCM_RTS)
1558 rts = 1;
1559 if (set & TIOCM_DTR)
1560 dtr = 1;
1561 if (clear & TIOCM_RTS)
1562 rts = 0;
1563 if (clear & TIOCM_DTR)
1564 dtr = 0;
1565
1566 stli_mkasysigs(&portp->asig, dtr, rts);
1567
1568 return stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
1569 sizeof(asysigs_t), 0);
1570}
1571
1572static int stli_ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg)
1573{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001574 struct stliport *portp;
1575 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001576 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001577 void __user *argp = (void __user *)arg;
1578
Linus Torvalds1da177e2005-04-16 15:20:36 -07001579 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001580 if (portp == NULL)
1581 return -ENODEV;
Jiri Slaby1328d732006-12-08 02:39:19 -08001582 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001583 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001584 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001585 if (brdp == NULL)
1586 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001587
1588 if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
1589 (cmd != COM_GETPORTSTATS) && (cmd != COM_CLRPORTSTATS)) {
1590 if (tty->flags & (1 << TTY_IO_ERROR))
Alan Cox4ac43602006-06-28 04:26:52 -07001591 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001592 }
1593
1594 rc = 0;
1595
1596 switch (cmd) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001597 case TIOCGSERIAL:
1598 rc = stli_getserial(portp, argp);
1599 break;
1600 case TIOCSSERIAL:
Alan Coxd18a7502008-10-13 10:40:07 +01001601 rc = stli_setserial(tty, argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001602 break;
1603 case STL_GETPFLAG:
1604 rc = put_user(portp->pflag, (unsigned __user *)argp);
1605 break;
1606 case STL_SETPFLAG:
1607 if ((rc = get_user(portp->pflag, (unsigned __user *)argp)) == 0)
Alan Coxd18a7502008-10-13 10:40:07 +01001608 stli_setport(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001609 break;
1610 case COM_GETPORTSTATS:
Alan Coxd18a7502008-10-13 10:40:07 +01001611 rc = stli_getportstats(tty, portp, argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001612 break;
1613 case COM_CLRPORTSTATS:
1614 rc = stli_clrportstats(portp, argp);
1615 break;
1616 case TIOCSERCONFIG:
1617 case TIOCSERGWILD:
1618 case TIOCSERSWILD:
1619 case TIOCSERGETLSR:
1620 case TIOCSERGSTRUCT:
1621 case TIOCSERGETMULTI:
1622 case TIOCSERSETMULTI:
1623 default:
1624 rc = -ENOIOCTLCMD;
1625 break;
1626 }
1627
Alan Cox4ac43602006-06-28 04:26:52 -07001628 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001629}
1630
1631/*****************************************************************************/
1632
1633/*
1634 * This routine assumes that we have user context and can sleep.
1635 * Looks like it is true for the current ttys implementation..!!
1636 */
1637
Alan Cox606d0992006-12-08 02:38:45 -08001638static void stli_settermios(struct tty_struct *tty, struct ktermios *old)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001639{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001640 struct stliport *portp;
1641 struct stlibrd *brdp;
Alan Cox606d0992006-12-08 02:38:45 -08001642 struct ktermios *tiosp;
Alan Cox4ac43602006-06-28 04:26:52 -07001643 asyport_t aport;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001644
Linus Torvalds1da177e2005-04-16 15:20:36 -07001645 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001646 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001647 return;
Jiri Slaby1328d732006-12-08 02:39:19 -08001648 if (portp->brdnr >= stli_nrbrds)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001649 return;
1650 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001651 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001652 return;
1653
1654 tiosp = tty->termios;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001655
Alan Coxd18a7502008-10-13 10:40:07 +01001656 stli_mkasyport(tty, portp, &aport, tiosp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001657 stli_cmdwait(brdp, portp, A_SETPORT, &aport, sizeof(asyport_t), 0);
1658 stli_mkasysigs(&portp->asig, ((tiosp->c_cflag & CBAUD) ? 1 : 0), -1);
1659 stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
1660 sizeof(asysigs_t), 0);
1661 if ((old->c_cflag & CRTSCTS) && ((tiosp->c_cflag & CRTSCTS) == 0))
1662 tty->hw_stopped = 0;
1663 if (((old->c_cflag & CLOCAL) == 0) && (tiosp->c_cflag & CLOCAL))
Alan Coxb02f5ad62008-07-16 21:55:53 +01001664 wake_up_interruptible(&portp->port.open_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001665}
1666
1667/*****************************************************************************/
1668
1669/*
1670 * Attempt to flow control who ever is sending us data. We won't really
1671 * do any flow control action here. We can't directly, and even if we
1672 * wanted to we would have to send a command to the slave. The slave
1673 * knows how to flow control, and will do so when its buffers reach its
1674 * internal high water marks. So what we will do is set a local state
1675 * bit that will stop us sending any RX data up from the poll routine
1676 * (which is the place where RX data from the slave is handled).
1677 */
1678
1679static void stli_throttle(struct tty_struct *tty)
1680{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001681 struct stliport *portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001682 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001683 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001684 set_bit(ST_RXSTOP, &portp->state);
1685}
1686
1687/*****************************************************************************/
1688
1689/*
1690 * Unflow control the device sending us data... That means that all
1691 * we have to do is clear the RXSTOP state bit. The next poll call
1692 * will then be able to pass the RX data back up.
1693 */
1694
1695static void stli_unthrottle(struct tty_struct *tty)
1696{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001697 struct stliport *portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001698 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001699 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001700 clear_bit(ST_RXSTOP, &portp->state);
1701}
1702
1703/*****************************************************************************/
1704
1705/*
Alan Cox4ac43602006-06-28 04:26:52 -07001706 * Stop the transmitter.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001707 */
1708
1709static void stli_stop(struct tty_struct *tty)
1710{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001711}
1712
1713/*****************************************************************************/
1714
1715/*
Alan Cox4ac43602006-06-28 04:26:52 -07001716 * Start the transmitter again.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001717 */
1718
1719static void stli_start(struct tty_struct *tty)
1720{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001721}
1722
1723/*****************************************************************************/
1724
1725/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001726 * Hangup this port. This is pretty much like closing the port, only
1727 * a little more brutal. No waiting for data to drain. Shutdown the
1728 * port and maybe drop signals. This is rather tricky really. We want
1729 * to close the port as well.
1730 */
1731
1732static void stli_hangup(struct tty_struct *tty)
1733{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001734 struct stliport *portp;
1735 struct stlibrd *brdp;
Alan Cox2a6eadb2009-01-02 13:46:18 +00001736 struct tty_port *port;
Alan Cox4ac43602006-06-28 04:26:52 -07001737 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001738
Linus Torvalds1da177e2005-04-16 15:20:36 -07001739 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001740 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001741 return;
Jiri Slaby1328d732006-12-08 02:39:19 -08001742 if (portp->brdnr >= stli_nrbrds)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001743 return;
1744 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001745 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001746 return;
Alan Cox2a6eadb2009-01-02 13:46:18 +00001747 port = &portp->port;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001748
Alan Cox2a6eadb2009-01-02 13:46:18 +00001749 spin_lock_irqsave(&port->lock, flags);
1750 port->flags &= ~ASYNC_INITIALIZED;
1751 spin_unlock_irqrestore(&port->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001752
Alan Cox4ac43602006-06-28 04:26:52 -07001753 if (!test_bit(ST_CLOSING, &portp->state))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001754 stli_rawclose(brdp, portp, 0, 0);
Alan Cox4ac43602006-06-28 04:26:52 -07001755
1756 spin_lock_irqsave(&stli_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001757 if (tty->termios->c_cflag & HUPCL) {
1758 stli_mkasysigs(&portp->asig, 0, 0);
1759 if (test_bit(ST_CMDING, &portp->state)) {
1760 set_bit(ST_DOSIGS, &portp->state);
1761 set_bit(ST_DOFLUSHTX, &portp->state);
1762 set_bit(ST_DOFLUSHRX, &portp->state);
1763 } else {
1764 stli_sendcmd(brdp, portp, A_SETSIGNALSF,
1765 &portp->asig, sizeof(asysigs_t), 0);
1766 }
1767 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001768
1769 clear_bit(ST_TXBUSY, &portp->state);
1770 clear_bit(ST_RXSTOP, &portp->state);
1771 set_bit(TTY_IO_ERROR, &tty->flags);
Alan Cox4ac43602006-06-28 04:26:52 -07001772 spin_unlock_irqrestore(&stli_lock, flags);
1773
Alan Cox2a6eadb2009-01-02 13:46:18 +00001774 tty_port_hangup(port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001775}
1776
1777/*****************************************************************************/
1778
1779/*
1780 * Flush characters from the lower buffer. We may not have user context
1781 * so we cannot sleep waiting for it to complete. Also we need to check
1782 * if there is chars for this port in the TX cook buffer, and flush them
1783 * as well.
1784 */
1785
1786static void stli_flushbuffer(struct tty_struct *tty)
1787{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001788 struct stliport *portp;
1789 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001790 unsigned long ftype, flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001791
Linus Torvalds1da177e2005-04-16 15:20:36 -07001792 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001793 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001794 return;
Jiri Slaby1328d732006-12-08 02:39:19 -08001795 if (portp->brdnr >= stli_nrbrds)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001796 return;
1797 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001798 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001799 return;
1800
Alan Cox4ac43602006-06-28 04:26:52 -07001801 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001802 if (tty == stli_txcooktty) {
Alan Cox4ac43602006-06-28 04:26:52 -07001803 stli_txcooktty = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001804 stli_txcooksize = 0;
1805 stli_txcookrealsize = 0;
1806 }
1807 if (test_bit(ST_CMDING, &portp->state)) {
1808 set_bit(ST_DOFLUSHTX, &portp->state);
1809 } else {
1810 ftype = FLUSHTX;
1811 if (test_bit(ST_DOFLUSHRX, &portp->state)) {
1812 ftype |= FLUSHRX;
1813 clear_bit(ST_DOFLUSHRX, &portp->state);
1814 }
Alan Cox4ac43602006-06-28 04:26:52 -07001815 __stli_sendcmd(brdp, portp, A_FLUSH, &ftype, sizeof(u32), 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001816 }
Alan Cox4ac43602006-06-28 04:26:52 -07001817 spin_unlock_irqrestore(&brd_lock, flags);
1818 tty_wakeup(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001819}
1820
1821/*****************************************************************************/
1822
Alan Cox9e989662008-07-22 11:18:03 +01001823static int stli_breakctl(struct tty_struct *tty, int state)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001824{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001825 struct stlibrd *brdp;
1826 struct stliport *portp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001827 long arg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001828
Linus Torvalds1da177e2005-04-16 15:20:36 -07001829 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001830 if (portp == NULL)
Alan Cox9e989662008-07-22 11:18:03 +01001831 return -EINVAL;
Jiri Slaby1328d732006-12-08 02:39:19 -08001832 if (portp->brdnr >= stli_nrbrds)
Alan Cox9e989662008-07-22 11:18:03 +01001833 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001834 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001835 if (brdp == NULL)
Alan Cox9e989662008-07-22 11:18:03 +01001836 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001837
Linus Torvalds1da177e2005-04-16 15:20:36 -07001838 arg = (state == -1) ? BREAKON : BREAKOFF;
1839 stli_cmdwait(brdp, portp, A_BREAK, &arg, sizeof(long), 0);
Alan Cox9e989662008-07-22 11:18:03 +01001840 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001841}
1842
1843/*****************************************************************************/
1844
1845static void stli_waituntilsent(struct tty_struct *tty, int timeout)
1846{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001847 struct stliport *portp;
Alan Cox4ac43602006-06-28 04:26:52 -07001848 unsigned long tend;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001849
Linus Torvalds1da177e2005-04-16 15:20:36 -07001850 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001851 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001852 return;
1853
1854 if (timeout == 0)
1855 timeout = HZ;
1856 tend = jiffies + timeout;
1857
1858 while (test_bit(ST_TXBUSY, &portp->state)) {
1859 if (signal_pending(current))
1860 break;
1861 msleep_interruptible(20);
1862 if (time_after_eq(jiffies, tend))
1863 break;
1864 }
1865}
1866
1867/*****************************************************************************/
1868
1869static void stli_sendxchar(struct tty_struct *tty, char ch)
1870{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001871 struct stlibrd *brdp;
1872 struct stliport *portp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001873 asyctrl_t actrl;
1874
Linus Torvalds1da177e2005-04-16 15:20:36 -07001875 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001876 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001877 return;
Jiri Slaby1328d732006-12-08 02:39:19 -08001878 if (portp->brdnr >= stli_nrbrds)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001879 return;
1880 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001881 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001882 return;
1883
1884 memset(&actrl, 0, sizeof(asyctrl_t));
1885 if (ch == STOP_CHAR(tty)) {
1886 actrl.rxctrl = CT_STOPFLOW;
1887 } else if (ch == START_CHAR(tty)) {
1888 actrl.rxctrl = CT_STARTFLOW;
1889 } else {
1890 actrl.txctrl = CT_SENDCHR;
1891 actrl.tximdch = ch;
1892 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001893 stli_cmdwait(brdp, portp, A_PORTCTRL, &actrl, sizeof(asyctrl_t), 0);
1894}
1895
1896/*****************************************************************************/
1897
1898#define MAXLINE 80
1899
1900/*
1901 * Format info for a specified port. The line is deliberately limited
1902 * to 80 characters. (If it is too long it will be truncated, if too
1903 * short then padded with spaces).
1904 */
1905
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001906static int stli_portinfo(struct stlibrd *brdp, struct stliport *portp, int portnr, char *pos)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001907{
Alan Cox4ac43602006-06-28 04:26:52 -07001908 char *sp, *uart;
1909 int rc, cnt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001910
Alan Coxd18a7502008-10-13 10:40:07 +01001911 rc = stli_portcmdstats(NULL, portp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001912
1913 uart = "UNKNOWN";
1914 if (brdp->state & BST_STARTED) {
1915 switch (stli_comstats.hwid) {
Alan Cox4ac43602006-06-28 04:26:52 -07001916 case 0: uart = "2681"; break;
1917 case 1: uart = "SC26198"; break;
1918 default:uart = "CD1400"; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001919 }
1920 }
1921
1922 sp = pos;
1923 sp += sprintf(sp, "%d: uart:%s ", portnr, uart);
1924
1925 if ((brdp->state & BST_STARTED) && (rc >= 0)) {
1926 sp += sprintf(sp, "tx:%d rx:%d", (int) stli_comstats.txtotal,
1927 (int) stli_comstats.rxtotal);
1928
1929 if (stli_comstats.rxframing)
1930 sp += sprintf(sp, " fe:%d",
1931 (int) stli_comstats.rxframing);
1932 if (stli_comstats.rxparity)
1933 sp += sprintf(sp, " pe:%d",
1934 (int) stli_comstats.rxparity);
1935 if (stli_comstats.rxbreaks)
1936 sp += sprintf(sp, " brk:%d",
1937 (int) stli_comstats.rxbreaks);
1938 if (stli_comstats.rxoverrun)
1939 sp += sprintf(sp, " oe:%d",
1940 (int) stli_comstats.rxoverrun);
1941
1942 cnt = sprintf(sp, "%s%s%s%s%s ",
1943 (stli_comstats.signals & TIOCM_RTS) ? "|RTS" : "",
1944 (stli_comstats.signals & TIOCM_CTS) ? "|CTS" : "",
1945 (stli_comstats.signals & TIOCM_DTR) ? "|DTR" : "",
1946 (stli_comstats.signals & TIOCM_CD) ? "|DCD" : "",
1947 (stli_comstats.signals & TIOCM_DSR) ? "|DSR" : "");
1948 *sp = ' ';
1949 sp += cnt;
1950 }
1951
1952 for (cnt = (sp - pos); (cnt < (MAXLINE - 1)); cnt++)
1953 *sp++ = ' ';
1954 if (cnt >= MAXLINE)
1955 pos[(MAXLINE - 2)] = '+';
1956 pos[(MAXLINE - 1)] = '\n';
1957
1958 return(MAXLINE);
1959}
1960
1961/*****************************************************************************/
1962
1963/*
1964 * Port info, read from the /proc file system.
1965 */
1966
1967static int stli_readproc(char *page, char **start, off_t off, int count, int *eof, void *data)
1968{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001969 struct stlibrd *brdp;
1970 struct stliport *portp;
Jiri Slaby1328d732006-12-08 02:39:19 -08001971 unsigned int brdnr, portnr, totalport;
Alan Cox4ac43602006-06-28 04:26:52 -07001972 int curoff, maxoff;
1973 char *pos;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001974
1975 pos = page;
1976 totalport = 0;
1977 curoff = 0;
1978
1979 if (off == 0) {
1980 pos += sprintf(pos, "%s: version %s", stli_drvtitle,
1981 stli_drvversion);
1982 while (pos < (page + MAXLINE - 1))
1983 *pos++ = ' ';
1984 *pos++ = '\n';
1985 }
1986 curoff = MAXLINE;
1987
1988/*
1989 * We scan through for each board, panel and port. The offset is
1990 * calculated on the fly, and irrelevant ports are skipped.
1991 */
1992 for (brdnr = 0; (brdnr < stli_nrbrds); brdnr++) {
1993 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001994 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001995 continue;
1996 if (brdp->state == 0)
1997 continue;
1998
1999 maxoff = curoff + (brdp->nrports * MAXLINE);
2000 if (off >= maxoff) {
2001 curoff = maxoff;
2002 continue;
2003 }
2004
2005 totalport = brdnr * STL_MAXPORTS;
2006 for (portnr = 0; (portnr < brdp->nrports); portnr++,
2007 totalport++) {
2008 portp = brdp->ports[portnr];
Alan Cox4ac43602006-06-28 04:26:52 -07002009 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002010 continue;
2011 if (off >= (curoff += MAXLINE))
2012 continue;
2013 if ((pos - page + MAXLINE) > count)
2014 goto stli_readdone;
2015 pos += stli_portinfo(brdp, portp, totalport, pos);
2016 }
2017 }
2018
2019 *eof = 1;
2020
2021stli_readdone:
2022 *start = page;
2023 return(pos - page);
2024}
2025
2026/*****************************************************************************/
2027
2028/*
2029 * Generic send command routine. This will send a message to the slave,
2030 * of the specified type with the specified argument. Must be very
2031 * careful of data that will be copied out from shared memory -
2032 * containing command results. The command completion is all done from
2033 * a poll routine that does not have user context. Therefore you cannot
2034 * copy back directly into user space, or to the kernel stack of a
2035 * process. This routine does not sleep, so can be called from anywhere.
Alan Cox4ac43602006-06-28 04:26:52 -07002036 *
2037 * The caller must hold the brd_lock (see also stli_sendcmd the usual
2038 * entry point)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002039 */
2040
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002041static void __stli_sendcmd(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002042{
Alan Cox4ac43602006-06-28 04:26:52 -07002043 cdkhdr_t __iomem *hdrp;
2044 cdkctrl_t __iomem *cp;
2045 unsigned char __iomem *bits;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002046
2047 if (test_bit(ST_CMDING, &portp->state)) {
Alan Coxa6614992009-01-02 13:46:50 +00002048 printk(KERN_ERR "istallion: command already busy, cmd=%x!\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07002049 (int) cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002050 return;
2051 }
2052
2053 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07002054 cp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002055 if (size > 0) {
Alan Cox4ac43602006-06-28 04:26:52 -07002056 memcpy_toio((void __iomem *) &(cp->args[0]), arg, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002057 if (copyback) {
2058 portp->argp = arg;
2059 portp->argsize = size;
2060 }
2061 }
Alan Cox4ac43602006-06-28 04:26:52 -07002062 writel(0, &cp->status);
2063 writel(cmd, &cp->cmd);
2064 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
2065 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -07002066 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -07002067 writeb(readb(bits) | portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002068 set_bit(ST_CMDING, &portp->state);
2069 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07002070}
2071
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002072static void stli_sendcmd(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback)
Alan Cox4ac43602006-06-28 04:26:52 -07002073{
2074 unsigned long flags;
2075
2076 spin_lock_irqsave(&brd_lock, flags);
2077 __stli_sendcmd(brdp, portp, cmd, arg, size, copyback);
2078 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002079}
2080
2081/*****************************************************************************/
2082
2083/*
2084 * Read data from shared memory. This assumes that the shared memory
2085 * is enabled and that interrupts are off. Basically we just empty out
2086 * the shared memory buffer into the tty buffer. Must be careful to
2087 * handle the case where we fill up the tty buffer, but still have
2088 * more chars to unload.
2089 */
2090
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002091static void stli_read(struct stlibrd *brdp, struct stliport *portp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002092{
Alan Cox4ac43602006-06-28 04:26:52 -07002093 cdkasyrq_t __iomem *rp;
2094 char __iomem *shbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002095 struct tty_struct *tty;
Alan Cox4ac43602006-06-28 04:26:52 -07002096 unsigned int head, tail, size;
2097 unsigned int len, stlen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002098
2099 if (test_bit(ST_RXSTOP, &portp->state))
2100 return;
Alan Coxd18a7502008-10-13 10:40:07 +01002101 tty = tty_port_tty_get(&portp->port);
Alan Cox4ac43602006-06-28 04:26:52 -07002102 if (tty == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002103 return;
2104
Alan Cox4ac43602006-06-28 04:26:52 -07002105 rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->rxq;
2106 head = (unsigned int) readw(&rp->head);
2107 if (head != ((unsigned int) readw(&rp->head)))
2108 head = (unsigned int) readw(&rp->head);
2109 tail = (unsigned int) readw(&rp->tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002110 size = portp->rxsize;
2111 if (head >= tail) {
2112 len = head - tail;
2113 stlen = len;
2114 } else {
2115 len = size - (tail - head);
2116 stlen = size - tail;
2117 }
2118
Alan Cox33f0f882006-01-09 20:54:13 -08002119 len = tty_buffer_request_room(tty, len);
Alan Cox4ac43602006-06-28 04:26:52 -07002120
2121 shbuf = (char __iomem *) EBRDGETMEMPTR(brdp, portp->rxoffset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002122
2123 while (len > 0) {
Alan Cox4ac43602006-06-28 04:26:52 -07002124 unsigned char *cptr;
2125
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08002126 stlen = min(len, stlen);
Alan Cox4ac43602006-06-28 04:26:52 -07002127 tty_prepare_flip_string(tty, &cptr, stlen);
2128 memcpy_fromio(cptr, shbuf + tail, stlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002129 len -= stlen;
2130 tail += stlen;
2131 if (tail >= size) {
2132 tail = 0;
2133 stlen = head;
2134 }
2135 }
Alan Cox4ac43602006-06-28 04:26:52 -07002136 rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->rxq;
2137 writew(tail, &rp->tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002138
2139 if (head != tail)
2140 set_bit(ST_RXING, &portp->state);
2141
2142 tty_schedule_flip(tty);
Alan Coxd18a7502008-10-13 10:40:07 +01002143 tty_kref_put(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002144}
2145
2146/*****************************************************************************/
2147
2148/*
2149 * Set up and carry out any delayed commands. There is only a small set
2150 * of slave commands that can be done "off-level". So it is not too
2151 * difficult to deal with them here.
2152 */
2153
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002154static void stli_dodelaycmd(struct stliport *portp, cdkctrl_t __iomem *cp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002155{
Alan Cox4ac43602006-06-28 04:26:52 -07002156 int cmd;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002157
2158 if (test_bit(ST_DOSIGS, &portp->state)) {
2159 if (test_bit(ST_DOFLUSHTX, &portp->state) &&
2160 test_bit(ST_DOFLUSHRX, &portp->state))
2161 cmd = A_SETSIGNALSF;
2162 else if (test_bit(ST_DOFLUSHTX, &portp->state))
2163 cmd = A_SETSIGNALSFTX;
2164 else if (test_bit(ST_DOFLUSHRX, &portp->state))
2165 cmd = A_SETSIGNALSFRX;
2166 else
2167 cmd = A_SETSIGNALS;
2168 clear_bit(ST_DOFLUSHTX, &portp->state);
2169 clear_bit(ST_DOFLUSHRX, &portp->state);
2170 clear_bit(ST_DOSIGS, &portp->state);
Alan Cox4ac43602006-06-28 04:26:52 -07002171 memcpy_toio((void __iomem *) &(cp->args[0]), (void *) &portp->asig,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002172 sizeof(asysigs_t));
Alan Cox4ac43602006-06-28 04:26:52 -07002173 writel(0, &cp->status);
2174 writel(cmd, &cp->cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002175 set_bit(ST_CMDING, &portp->state);
2176 } else if (test_bit(ST_DOFLUSHTX, &portp->state) ||
2177 test_bit(ST_DOFLUSHRX, &portp->state)) {
2178 cmd = ((test_bit(ST_DOFLUSHTX, &portp->state)) ? FLUSHTX : 0);
2179 cmd |= ((test_bit(ST_DOFLUSHRX, &portp->state)) ? FLUSHRX : 0);
2180 clear_bit(ST_DOFLUSHTX, &portp->state);
2181 clear_bit(ST_DOFLUSHRX, &portp->state);
Alan Cox4ac43602006-06-28 04:26:52 -07002182 memcpy_toio((void __iomem *) &(cp->args[0]), (void *) &cmd, sizeof(int));
2183 writel(0, &cp->status);
2184 writel(A_FLUSH, &cp->cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002185 set_bit(ST_CMDING, &portp->state);
2186 }
2187}
2188
2189/*****************************************************************************/
2190
2191/*
2192 * Host command service checking. This handles commands or messages
2193 * coming from the slave to the host. Must have board shared memory
2194 * enabled and interrupts off when called. Notice that by servicing the
2195 * read data last we don't need to change the shared memory pointer
2196 * during processing (which is a slow IO operation).
2197 * Return value indicates if this port is still awaiting actions from
2198 * the slave (like open, command, or even TX data being sent). If 0
2199 * then port is still busy, otherwise no longer busy.
2200 */
2201
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002202static int stli_hostcmd(struct stlibrd *brdp, struct stliport *portp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002203{
Alan Cox4ac43602006-06-28 04:26:52 -07002204 cdkasy_t __iomem *ap;
2205 cdkctrl_t __iomem *cp;
2206 struct tty_struct *tty;
2207 asynotify_t nt;
2208 unsigned long oldsigs;
2209 int rc, donerx;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002210
Alan Cox4ac43602006-06-28 04:26:52 -07002211 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002212 cp = &ap->ctrl;
2213
2214/*
2215 * Check if we are waiting for an open completion message.
2216 */
2217 if (test_bit(ST_OPENING, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002218 rc = readl(&cp->openarg);
2219 if (readb(&cp->open) == 0 && rc != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002220 if (rc > 0)
2221 rc--;
Alan Cox4ac43602006-06-28 04:26:52 -07002222 writel(0, &cp->openarg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002223 portp->rc = rc;
2224 clear_bit(ST_OPENING, &portp->state);
2225 wake_up_interruptible(&portp->raw_wait);
2226 }
2227 }
2228
2229/*
2230 * Check if we are waiting for a close completion message.
2231 */
2232 if (test_bit(ST_CLOSING, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002233 rc = (int) readl(&cp->closearg);
2234 if (readb(&cp->close) == 0 && rc != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002235 if (rc > 0)
2236 rc--;
Alan Cox4ac43602006-06-28 04:26:52 -07002237 writel(0, &cp->closearg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002238 portp->rc = rc;
2239 clear_bit(ST_CLOSING, &portp->state);
2240 wake_up_interruptible(&portp->raw_wait);
2241 }
2242 }
2243
2244/*
2245 * Check if we are waiting for a command completion message. We may
2246 * need to copy out the command results associated with this command.
2247 */
2248 if (test_bit(ST_CMDING, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002249 rc = readl(&cp->status);
2250 if (readl(&cp->cmd) == 0 && rc != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002251 if (rc > 0)
2252 rc--;
Alan Cox4ac43602006-06-28 04:26:52 -07002253 if (portp->argp != NULL) {
2254 memcpy_fromio(portp->argp, (void __iomem *) &(cp->args[0]),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002255 portp->argsize);
Alan Cox4ac43602006-06-28 04:26:52 -07002256 portp->argp = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002257 }
Alan Cox4ac43602006-06-28 04:26:52 -07002258 writel(0, &cp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002259 portp->rc = rc;
2260 clear_bit(ST_CMDING, &portp->state);
2261 stli_dodelaycmd(portp, cp);
2262 wake_up_interruptible(&portp->raw_wait);
2263 }
2264 }
2265
2266/*
2267 * Check for any notification messages ready. This includes lots of
2268 * different types of events - RX chars ready, RX break received,
2269 * TX data low or empty in the slave, modem signals changed state.
2270 */
2271 donerx = 0;
2272
2273 if (ap->notify) {
2274 nt = ap->changed;
2275 ap->notify = 0;
Alan Coxd18a7502008-10-13 10:40:07 +01002276 tty = tty_port_tty_get(&portp->port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002277
2278 if (nt.signal & SG_DCD) {
2279 oldsigs = portp->sigs;
2280 portp->sigs = stli_mktiocm(nt.sigvalue);
2281 clear_bit(ST_GETSIGS, &portp->state);
2282 if ((portp->sigs & TIOCM_CD) &&
2283 ((oldsigs & TIOCM_CD) == 0))
Alan Coxb02f5ad62008-07-16 21:55:53 +01002284 wake_up_interruptible(&portp->port.open_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002285 if ((oldsigs & TIOCM_CD) &&
2286 ((portp->sigs & TIOCM_CD) == 0)) {
Alan Coxb02f5ad62008-07-16 21:55:53 +01002287 if (portp->port.flags & ASYNC_CHECK_CD) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002288 if (tty)
Jiri Slabycfccaee2008-02-07 00:16:38 -08002289 tty_hangup(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002290 }
2291 }
2292 }
2293
2294 if (nt.data & DT_TXEMPTY)
2295 clear_bit(ST_TXBUSY, &portp->state);
2296 if (nt.data & (DT_TXEMPTY | DT_TXLOW)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002297 if (tty != NULL) {
2298 tty_wakeup(tty);
2299 EBRDENABLE(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002300 }
2301 }
2302
2303 if ((nt.data & DT_RXBREAK) && (portp->rxmarkmsk & BRKINT)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002304 if (tty != NULL) {
Alan Cox33f0f882006-01-09 20:54:13 -08002305 tty_insert_flip_char(tty, 0, TTY_BREAK);
Alan Coxb02f5ad62008-07-16 21:55:53 +01002306 if (portp->port.flags & ASYNC_SAK) {
Alan Cox33f0f882006-01-09 20:54:13 -08002307 do_SAK(tty);
2308 EBRDENABLE(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002309 }
Alan Cox33f0f882006-01-09 20:54:13 -08002310 tty_schedule_flip(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002311 }
2312 }
Alan Coxd18a7502008-10-13 10:40:07 +01002313 tty_kref_put(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002314
2315 if (nt.data & DT_RXBUSY) {
2316 donerx++;
2317 stli_read(brdp, portp);
2318 }
2319 }
2320
2321/*
2322 * It might seem odd that we are checking for more RX chars here.
2323 * But, we need to handle the case where the tty buffer was previously
2324 * filled, but we had more characters to pass up. The slave will not
2325 * send any more RX notify messages until the RX buffer has been emptied.
2326 * But it will leave the service bits on (since the buffer is not empty).
2327 * So from here we can try to process more RX chars.
2328 */
2329 if ((!donerx) && test_bit(ST_RXING, &portp->state)) {
2330 clear_bit(ST_RXING, &portp->state);
2331 stli_read(brdp, portp);
2332 }
2333
2334 return((test_bit(ST_OPENING, &portp->state) ||
2335 test_bit(ST_CLOSING, &portp->state) ||
2336 test_bit(ST_CMDING, &portp->state) ||
2337 test_bit(ST_TXBUSY, &portp->state) ||
2338 test_bit(ST_RXING, &portp->state)) ? 0 : 1);
2339}
2340
2341/*****************************************************************************/
2342
2343/*
2344 * Service all ports on a particular board. Assumes that the boards
2345 * shared memory is enabled, and that the page pointer is pointed
2346 * at the cdk header structure.
2347 */
2348
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002349static void stli_brdpoll(struct stlibrd *brdp, cdkhdr_t __iomem *hdrp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002350{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002351 struct stliport *portp;
Alan Cox4ac43602006-06-28 04:26:52 -07002352 unsigned char hostbits[(STL_MAXCHANS / 8) + 1];
2353 unsigned char slavebits[(STL_MAXCHANS / 8) + 1];
2354 unsigned char __iomem *slavep;
2355 int bitpos, bitat, bitsize;
2356 int channr, nrdevs, slavebitchange;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002357
2358 bitsize = brdp->bitsize;
2359 nrdevs = brdp->nrdevs;
2360
2361/*
2362 * Check if slave wants any service. Basically we try to do as
2363 * little work as possible here. There are 2 levels of service
2364 * bits. So if there is nothing to do we bail early. We check
2365 * 8 service bits at a time in the inner loop, so we can bypass
2366 * the lot if none of them want service.
2367 */
Alan Cox4ac43602006-06-28 04:26:52 -07002368 memcpy_fromio(&hostbits[0], (((unsigned char __iomem *) hdrp) + brdp->hostoffset),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002369 bitsize);
2370
2371 memset(&slavebits[0], 0, bitsize);
2372 slavebitchange = 0;
2373
2374 for (bitpos = 0; (bitpos < bitsize); bitpos++) {
2375 if (hostbits[bitpos] == 0)
2376 continue;
2377 channr = bitpos * 8;
2378 for (bitat = 0x1; (channr < nrdevs); channr++, bitat <<= 1) {
2379 if (hostbits[bitpos] & bitat) {
2380 portp = brdp->ports[(channr - 1)];
2381 if (stli_hostcmd(brdp, portp)) {
2382 slavebitchange++;
2383 slavebits[bitpos] |= bitat;
2384 }
2385 }
2386 }
2387 }
2388
2389/*
2390 * If any of the ports are no longer busy then update them in the
2391 * slave request bits. We need to do this after, since a host port
2392 * service may initiate more slave requests.
2393 */
2394 if (slavebitchange) {
Alan Cox4ac43602006-06-28 04:26:52 -07002395 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
2396 slavep = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002397 for (bitpos = 0; (bitpos < bitsize); bitpos++) {
Alan Cox4ac43602006-06-28 04:26:52 -07002398 if (readb(slavebits + bitpos))
2399 writeb(readb(slavep + bitpos) & ~slavebits[bitpos], slavebits + bitpos);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002400 }
2401 }
2402}
2403
2404/*****************************************************************************/
2405
2406/*
2407 * Driver poll routine. This routine polls the boards in use and passes
2408 * messages back up to host when necessary. This is actually very
2409 * CPU efficient, since we will always have the kernel poll clock, it
2410 * adds only a few cycles when idle (since board service can be
2411 * determined very easily), but when loaded generates no interrupts
2412 * (with their expensive associated context change).
2413 */
2414
2415static void stli_poll(unsigned long arg)
2416{
Alan Cox4ac43602006-06-28 04:26:52 -07002417 cdkhdr_t __iomem *hdrp;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002418 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08002419 unsigned int brdnr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002420
Jiri Slabyff8efe92006-12-08 02:39:27 -08002421 mod_timer(&stli_timerlist, STLI_TIMEOUT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002422
2423/*
2424 * Check each board and do any servicing required.
2425 */
2426 for (brdnr = 0; (brdnr < stli_nrbrds); brdnr++) {
2427 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07002428 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002429 continue;
2430 if ((brdp->state & BST_STARTED) == 0)
2431 continue;
2432
Alan Cox4ac43602006-06-28 04:26:52 -07002433 spin_lock(&brd_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002434 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07002435 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
2436 if (readb(&hdrp->hostreq))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002437 stli_brdpoll(brdp, hdrp);
2438 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07002439 spin_unlock(&brd_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002440 }
2441}
2442
2443/*****************************************************************************/
2444
2445/*
2446 * Translate the termios settings into the port setting structure of
2447 * the slave.
2448 */
2449
Alan Coxd18a7502008-10-13 10:40:07 +01002450static void stli_mkasyport(struct tty_struct *tty, struct stliport *portp,
2451 asyport_t *pp, struct ktermios *tiosp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002452{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002453 memset(pp, 0, sizeof(asyport_t));
2454
2455/*
2456 * Start of by setting the baud, char size, parity and stop bit info.
2457 */
Alan Coxd18a7502008-10-13 10:40:07 +01002458 pp->baudout = tty_get_baud_rate(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002459 if ((tiosp->c_cflag & CBAUD) == B38400) {
Alan Coxb02f5ad62008-07-16 21:55:53 +01002460 if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002461 pp->baudout = 57600;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002462 else if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002463 pp->baudout = 115200;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002464 else if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002465 pp->baudout = 230400;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002466 else if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002467 pp->baudout = 460800;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002468 else if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002469 pp->baudout = (portp->baud_base / portp->custom_divisor);
2470 }
2471 if (pp->baudout > STL_MAXBAUD)
2472 pp->baudout = STL_MAXBAUD;
2473 pp->baudin = pp->baudout;
2474
2475 switch (tiosp->c_cflag & CSIZE) {
2476 case CS5:
2477 pp->csize = 5;
2478 break;
2479 case CS6:
2480 pp->csize = 6;
2481 break;
2482 case CS7:
2483 pp->csize = 7;
2484 break;
2485 default:
2486 pp->csize = 8;
2487 break;
2488 }
2489
2490 if (tiosp->c_cflag & CSTOPB)
2491 pp->stopbs = PT_STOP2;
2492 else
2493 pp->stopbs = PT_STOP1;
2494
2495 if (tiosp->c_cflag & PARENB) {
2496 if (tiosp->c_cflag & PARODD)
2497 pp->parity = PT_ODDPARITY;
2498 else
2499 pp->parity = PT_EVENPARITY;
2500 } else {
2501 pp->parity = PT_NOPARITY;
2502 }
2503
2504/*
2505 * Set up any flow control options enabled.
2506 */
2507 if (tiosp->c_iflag & IXON) {
2508 pp->flow |= F_IXON;
2509 if (tiosp->c_iflag & IXANY)
2510 pp->flow |= F_IXANY;
2511 }
2512 if (tiosp->c_cflag & CRTSCTS)
2513 pp->flow |= (F_RTSFLOW | F_CTSFLOW);
2514
2515 pp->startin = tiosp->c_cc[VSTART];
2516 pp->stopin = tiosp->c_cc[VSTOP];
2517 pp->startout = tiosp->c_cc[VSTART];
2518 pp->stopout = tiosp->c_cc[VSTOP];
2519
2520/*
2521 * Set up the RX char marking mask with those RX error types we must
2522 * catch. We can get the slave to help us out a little here, it will
2523 * ignore parity errors and breaks for us, and mark parity errors in
2524 * the data stream.
2525 */
2526 if (tiosp->c_iflag & IGNPAR)
2527 pp->iflag |= FI_IGNRXERRS;
2528 if (tiosp->c_iflag & IGNBRK)
2529 pp->iflag |= FI_IGNBREAK;
2530
2531 portp->rxmarkmsk = 0;
2532 if (tiosp->c_iflag & (INPCK | PARMRK))
2533 pp->iflag |= FI_1MARKRXERRS;
2534 if (tiosp->c_iflag & BRKINT)
2535 portp->rxmarkmsk |= BRKINT;
2536
2537/*
2538 * Set up clocal processing as required.
2539 */
2540 if (tiosp->c_cflag & CLOCAL)
Alan Coxb02f5ad62008-07-16 21:55:53 +01002541 portp->port.flags &= ~ASYNC_CHECK_CD;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002542 else
Alan Coxb02f5ad62008-07-16 21:55:53 +01002543 portp->port.flags |= ASYNC_CHECK_CD;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002544
2545/*
2546 * Transfer any persistent flags into the asyport structure.
2547 */
2548 pp->pflag = (portp->pflag & 0xffff);
2549 pp->vmin = (portp->pflag & P_RXIMIN) ? 1 : 0;
2550 pp->vtime = (portp->pflag & P_RXITIME) ? 1 : 0;
2551 pp->cc[1] = (portp->pflag & P_RXTHOLD) ? 1 : 0;
2552}
2553
2554/*****************************************************************************/
2555
2556/*
2557 * Construct a slave signals structure for setting the DTR and RTS
2558 * signals as specified.
2559 */
2560
2561static void stli_mkasysigs(asysigs_t *sp, int dtr, int rts)
2562{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002563 memset(sp, 0, sizeof(asysigs_t));
2564 if (dtr >= 0) {
2565 sp->signal |= SG_DTR;
2566 sp->sigvalue |= ((dtr > 0) ? SG_DTR : 0);
2567 }
2568 if (rts >= 0) {
2569 sp->signal |= SG_RTS;
2570 sp->sigvalue |= ((rts > 0) ? SG_RTS : 0);
2571 }
2572}
2573
2574/*****************************************************************************/
2575
2576/*
2577 * Convert the signals returned from the slave into a local TIOCM type
2578 * signals value. We keep them locally in TIOCM format.
2579 */
2580
2581static long stli_mktiocm(unsigned long sigvalue)
2582{
Alan Cox4ac43602006-06-28 04:26:52 -07002583 long tiocm = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002584 tiocm |= ((sigvalue & SG_DCD) ? TIOCM_CD : 0);
2585 tiocm |= ((sigvalue & SG_CTS) ? TIOCM_CTS : 0);
2586 tiocm |= ((sigvalue & SG_RI) ? TIOCM_RI : 0);
2587 tiocm |= ((sigvalue & SG_DSR) ? TIOCM_DSR : 0);
2588 tiocm |= ((sigvalue & SG_DTR) ? TIOCM_DTR : 0);
2589 tiocm |= ((sigvalue & SG_RTS) ? TIOCM_RTS : 0);
2590 return(tiocm);
2591}
2592
2593/*****************************************************************************/
2594
2595/*
2596 * All panels and ports actually attached have been worked out. All
2597 * we need to do here is set up the appropriate per port data structures.
2598 */
2599
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002600static int stli_initports(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002601{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002602 struct stliport *portp;
Jiri Slaby1328d732006-12-08 02:39:19 -08002603 unsigned int i, panelnr, panelport;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002604
Linus Torvalds1da177e2005-04-16 15:20:36 -07002605 for (i = 0, panelnr = 0, panelport = 0; (i < brdp->nrports); i++) {
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002606 portp = kzalloc(sizeof(struct stliport), GFP_KERNEL);
Tobias Klauserb0b4ed72006-03-31 02:30:56 -08002607 if (!portp) {
Alan Coxa6614992009-01-02 13:46:50 +00002608 printk(KERN_WARNING "istallion: failed to allocate port structure\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002609 continue;
2610 }
Alan Coxd18a7502008-10-13 10:40:07 +01002611 tty_port_init(&portp->port);
Alan Cox31f35932009-01-02 13:45:05 +00002612 portp->port.ops = &stli_port_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002613 portp->magic = STLI_PORTMAGIC;
2614 portp->portnr = i;
2615 portp->brdnr = brdp->brdnr;
2616 portp->panelnr = panelnr;
2617 portp->baud_base = STL_BAUDBASE;
Alan Coxa6614992009-01-02 13:46:50 +00002618 portp->port.close_delay = STL_CLOSEDELAY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002619 portp->closing_wait = 30 * HZ;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002620 init_waitqueue_head(&portp->port.open_wait);
2621 init_waitqueue_head(&portp->port.close_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002622 init_waitqueue_head(&portp->raw_wait);
2623 panelport++;
2624 if (panelport >= brdp->panels[panelnr]) {
2625 panelport = 0;
2626 panelnr++;
2627 }
2628 brdp->ports[i] = portp;
2629 }
2630
Alan Cox4ac43602006-06-28 04:26:52 -07002631 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002632}
2633
2634/*****************************************************************************/
2635
2636/*
2637 * All the following routines are board specific hardware operations.
2638 */
2639
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002640static void stli_ecpinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002641{
2642 unsigned long memconf;
2643
Linus Torvalds1da177e2005-04-16 15:20:36 -07002644 outb(ECP_ATSTOP, (brdp->iobase + ECP_ATCONFR));
2645 udelay(10);
2646 outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR));
2647 udelay(100);
2648
2649 memconf = (brdp->memaddr & ECP_ATADDRMASK) >> ECP_ATADDRSHFT;
2650 outb(memconf, (brdp->iobase + ECP_ATMEMAR));
2651}
2652
2653/*****************************************************************************/
2654
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002655static void stli_ecpenable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002656{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002657 outb(ECP_ATENABLE, (brdp->iobase + ECP_ATCONFR));
2658}
2659
2660/*****************************************************************************/
2661
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002662static void stli_ecpdisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002663{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002664 outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR));
2665}
2666
2667/*****************************************************************************/
2668
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002669static void __iomem *stli_ecpgetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002670{
Al Viro29756fa2006-10-10 22:47:27 +01002671 void __iomem *ptr;
Alan Cox4ac43602006-06-28 04:26:52 -07002672 unsigned char val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002673
2674 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002675 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002676 "range at line=%d(%d), brd=%d\n",
2677 (int) offset, line, __LINE__, brdp->brdnr);
2678 ptr = NULL;
2679 val = 0;
2680 } else {
2681 ptr = brdp->membase + (offset % ECP_ATPAGESIZE);
2682 val = (unsigned char) (offset / ECP_ATPAGESIZE);
2683 }
2684 outb(val, (brdp->iobase + ECP_ATMEMPR));
2685 return(ptr);
2686}
2687
2688/*****************************************************************************/
2689
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002690static void stli_ecpreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002691{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002692 outb(ECP_ATSTOP, (brdp->iobase + ECP_ATCONFR));
2693 udelay(10);
2694 outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR));
2695 udelay(500);
2696}
2697
2698/*****************************************************************************/
2699
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002700static void stli_ecpintr(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002701{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002702 outb(0x1, brdp->iobase);
2703}
2704
2705/*****************************************************************************/
2706
2707/*
2708 * The following set of functions act on ECP EISA boards.
2709 */
2710
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002711static void stli_ecpeiinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002712{
2713 unsigned long memconf;
2714
Linus Torvalds1da177e2005-04-16 15:20:36 -07002715 outb(0x1, (brdp->iobase + ECP_EIBRDENAB));
2716 outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR));
2717 udelay(10);
2718 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
2719 udelay(500);
2720
2721 memconf = (brdp->memaddr & ECP_EIADDRMASKL) >> ECP_EIADDRSHFTL;
2722 outb(memconf, (brdp->iobase + ECP_EIMEMARL));
2723 memconf = (brdp->memaddr & ECP_EIADDRMASKH) >> ECP_EIADDRSHFTH;
2724 outb(memconf, (brdp->iobase + ECP_EIMEMARH));
2725}
2726
2727/*****************************************************************************/
2728
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002729static void stli_ecpeienable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002730{
2731 outb(ECP_EIENABLE, (brdp->iobase + ECP_EICONFR));
2732}
2733
2734/*****************************************************************************/
2735
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002736static void stli_ecpeidisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002737{
2738 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
2739}
2740
2741/*****************************************************************************/
2742
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002743static void __iomem *stli_ecpeigetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002744{
Al Viro29756fa2006-10-10 22:47:27 +01002745 void __iomem *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002746 unsigned char val;
2747
Linus Torvalds1da177e2005-04-16 15:20:36 -07002748 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002749 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002750 "range at line=%d(%d), brd=%d\n",
2751 (int) offset, line, __LINE__, brdp->brdnr);
2752 ptr = NULL;
2753 val = 0;
2754 } else {
2755 ptr = brdp->membase + (offset % ECP_EIPAGESIZE);
2756 if (offset < ECP_EIPAGESIZE)
2757 val = ECP_EIENABLE;
2758 else
2759 val = ECP_EIENABLE | 0x40;
2760 }
2761 outb(val, (brdp->iobase + ECP_EICONFR));
2762 return(ptr);
2763}
2764
2765/*****************************************************************************/
2766
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002767static void stli_ecpeireset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002768{
2769 outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR));
2770 udelay(10);
2771 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
2772 udelay(500);
2773}
2774
2775/*****************************************************************************/
2776
2777/*
2778 * The following set of functions act on ECP MCA boards.
2779 */
2780
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002781static void stli_ecpmcenable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002782{
2783 outb(ECP_MCENABLE, (brdp->iobase + ECP_MCCONFR));
2784}
2785
2786/*****************************************************************************/
2787
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002788static void stli_ecpmcdisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002789{
2790 outb(ECP_MCDISABLE, (brdp->iobase + ECP_MCCONFR));
2791}
2792
2793/*****************************************************************************/
2794
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002795static void __iomem *stli_ecpmcgetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002796{
Al Viro29756fa2006-10-10 22:47:27 +01002797 void __iomem *ptr;
Alan Cox4ac43602006-06-28 04:26:52 -07002798 unsigned char val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002799
2800 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002801 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002802 "range at line=%d(%d), brd=%d\n",
2803 (int) offset, line, __LINE__, brdp->brdnr);
2804 ptr = NULL;
2805 val = 0;
2806 } else {
2807 ptr = brdp->membase + (offset % ECP_MCPAGESIZE);
2808 val = ((unsigned char) (offset / ECP_MCPAGESIZE)) | ECP_MCENABLE;
2809 }
2810 outb(val, (brdp->iobase + ECP_MCCONFR));
2811 return(ptr);
2812}
2813
2814/*****************************************************************************/
2815
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002816static void stli_ecpmcreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002817{
2818 outb(ECP_MCSTOP, (brdp->iobase + ECP_MCCONFR));
2819 udelay(10);
2820 outb(ECP_MCDISABLE, (brdp->iobase + ECP_MCCONFR));
2821 udelay(500);
2822}
2823
2824/*****************************************************************************/
2825
2826/*
2827 * The following set of functions act on ECP PCI boards.
2828 */
2829
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002830static void stli_ecppciinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002831{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002832 outb(ECP_PCISTOP, (brdp->iobase + ECP_PCICONFR));
2833 udelay(10);
2834 outb(0, (brdp->iobase + ECP_PCICONFR));
2835 udelay(500);
2836}
2837
2838/*****************************************************************************/
2839
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002840static void __iomem *stli_ecppcigetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002841{
Al Viro29756fa2006-10-10 22:47:27 +01002842 void __iomem *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002843 unsigned char val;
2844
Linus Torvalds1da177e2005-04-16 15:20:36 -07002845 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002846 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002847 "range at line=%d(%d), board=%d\n",
2848 (int) offset, line, __LINE__, brdp->brdnr);
2849 ptr = NULL;
2850 val = 0;
2851 } else {
2852 ptr = brdp->membase + (offset % ECP_PCIPAGESIZE);
2853 val = (offset / ECP_PCIPAGESIZE) << 1;
2854 }
2855 outb(val, (brdp->iobase + ECP_PCICONFR));
2856 return(ptr);
2857}
2858
2859/*****************************************************************************/
2860
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002861static void stli_ecppcireset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002862{
2863 outb(ECP_PCISTOP, (brdp->iobase + ECP_PCICONFR));
2864 udelay(10);
2865 outb(0, (brdp->iobase + ECP_PCICONFR));
2866 udelay(500);
2867}
2868
2869/*****************************************************************************/
2870
2871/*
2872 * The following routines act on ONboards.
2873 */
2874
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002875static void stli_onbinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002876{
2877 unsigned long memconf;
2878
Linus Torvalds1da177e2005-04-16 15:20:36 -07002879 outb(ONB_ATSTOP, (brdp->iobase + ONB_ATCONFR));
2880 udelay(10);
2881 outb(ONB_ATDISABLE, (brdp->iobase + ONB_ATCONFR));
2882 mdelay(1000);
2883
2884 memconf = (brdp->memaddr & ONB_ATADDRMASK) >> ONB_ATADDRSHFT;
2885 outb(memconf, (brdp->iobase + ONB_ATMEMAR));
2886 outb(0x1, brdp->iobase);
2887 mdelay(1);
2888}
2889
2890/*****************************************************************************/
2891
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002892static void stli_onbenable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002893{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002894 outb((brdp->enabval | ONB_ATENABLE), (brdp->iobase + ONB_ATCONFR));
2895}
2896
2897/*****************************************************************************/
2898
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002899static void stli_onbdisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002900{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002901 outb((brdp->enabval | ONB_ATDISABLE), (brdp->iobase + ONB_ATCONFR));
2902}
2903
2904/*****************************************************************************/
2905
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002906static void __iomem *stli_onbgetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002907{
Al Viro29756fa2006-10-10 22:47:27 +01002908 void __iomem *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002909
Linus Torvalds1da177e2005-04-16 15:20:36 -07002910 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002911 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002912 "range at line=%d(%d), brd=%d\n",
2913 (int) offset, line, __LINE__, brdp->brdnr);
2914 ptr = NULL;
2915 } else {
2916 ptr = brdp->membase + (offset % ONB_ATPAGESIZE);
2917 }
2918 return(ptr);
2919}
2920
2921/*****************************************************************************/
2922
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002923static void stli_onbreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002924{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002925 outb(ONB_ATSTOP, (brdp->iobase + ONB_ATCONFR));
2926 udelay(10);
2927 outb(ONB_ATDISABLE, (brdp->iobase + ONB_ATCONFR));
2928 mdelay(1000);
2929}
2930
2931/*****************************************************************************/
2932
2933/*
2934 * The following routines act on ONboard EISA.
2935 */
2936
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002937static void stli_onbeinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002938{
2939 unsigned long memconf;
2940
Linus Torvalds1da177e2005-04-16 15:20:36 -07002941 outb(0x1, (brdp->iobase + ONB_EIBRDENAB));
2942 outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR));
2943 udelay(10);
2944 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
2945 mdelay(1000);
2946
2947 memconf = (brdp->memaddr & ONB_EIADDRMASKL) >> ONB_EIADDRSHFTL;
2948 outb(memconf, (brdp->iobase + ONB_EIMEMARL));
2949 memconf = (brdp->memaddr & ONB_EIADDRMASKH) >> ONB_EIADDRSHFTH;
2950 outb(memconf, (brdp->iobase + ONB_EIMEMARH));
2951 outb(0x1, brdp->iobase);
2952 mdelay(1);
2953}
2954
2955/*****************************************************************************/
2956
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002957static void stli_onbeenable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002958{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002959 outb(ONB_EIENABLE, (brdp->iobase + ONB_EICONFR));
2960}
2961
2962/*****************************************************************************/
2963
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002964static void stli_onbedisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002965{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002966 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
2967}
2968
2969/*****************************************************************************/
2970
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002971static void __iomem *stli_onbegetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002972{
Al Viro29756fa2006-10-10 22:47:27 +01002973 void __iomem *ptr;
Alan Cox4ac43602006-06-28 04:26:52 -07002974 unsigned char val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002975
2976 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002977 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002978 "range at line=%d(%d), brd=%d\n",
2979 (int) offset, line, __LINE__, brdp->brdnr);
2980 ptr = NULL;
2981 val = 0;
2982 } else {
2983 ptr = brdp->membase + (offset % ONB_EIPAGESIZE);
2984 if (offset < ONB_EIPAGESIZE)
2985 val = ONB_EIENABLE;
2986 else
2987 val = ONB_EIENABLE | 0x40;
2988 }
2989 outb(val, (brdp->iobase + ONB_EICONFR));
2990 return(ptr);
2991}
2992
2993/*****************************************************************************/
2994
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002995static void stli_onbereset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002996{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002997 outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR));
2998 udelay(10);
2999 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
3000 mdelay(1000);
3001}
3002
3003/*****************************************************************************/
3004
3005/*
3006 * The following routines act on Brumby boards.
3007 */
3008
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003009static void stli_bbyinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003010{
Linus Torvalds1da177e2005-04-16 15:20:36 -07003011 outb(BBY_ATSTOP, (brdp->iobase + BBY_ATCONFR));
3012 udelay(10);
3013 outb(0, (brdp->iobase + BBY_ATCONFR));
3014 mdelay(1000);
3015 outb(0x1, brdp->iobase);
3016 mdelay(1);
3017}
3018
3019/*****************************************************************************/
3020
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003021static void __iomem *stli_bbygetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003022{
Al Viro29756fa2006-10-10 22:47:27 +01003023 void __iomem *ptr;
Alan Cox4ac43602006-06-28 04:26:52 -07003024 unsigned char val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003025
Alan Cox4ac43602006-06-28 04:26:52 -07003026 BUG_ON(offset > brdp->memsize);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003027
Alan Cox4ac43602006-06-28 04:26:52 -07003028 ptr = brdp->membase + (offset % BBY_PAGESIZE);
3029 val = (unsigned char) (offset / BBY_PAGESIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003030 outb(val, (brdp->iobase + BBY_ATCONFR));
3031 return(ptr);
3032}
3033
3034/*****************************************************************************/
3035
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003036static void stli_bbyreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003037{
Linus Torvalds1da177e2005-04-16 15:20:36 -07003038 outb(BBY_ATSTOP, (brdp->iobase + BBY_ATCONFR));
3039 udelay(10);
3040 outb(0, (brdp->iobase + BBY_ATCONFR));
3041 mdelay(1000);
3042}
3043
3044/*****************************************************************************/
3045
3046/*
3047 * The following routines act on original old Stallion boards.
3048 */
3049
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003050static void stli_stalinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003051{
Linus Torvalds1da177e2005-04-16 15:20:36 -07003052 outb(0x1, brdp->iobase);
3053 mdelay(1000);
3054}
3055
3056/*****************************************************************************/
3057
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003058static void __iomem *stli_stalgetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003059{
Alan Cox4ac43602006-06-28 04:26:52 -07003060 BUG_ON(offset > brdp->memsize);
3061 return brdp->membase + (offset % STAL_PAGESIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003062}
3063
3064/*****************************************************************************/
3065
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003066static void stli_stalreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003067{
Alan Cox4ac43602006-06-28 04:26:52 -07003068 u32 __iomem *vecp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003069
Alan Cox4ac43602006-06-28 04:26:52 -07003070 vecp = (u32 __iomem *) (brdp->membase + 0x30);
3071 writel(0xffff0000, vecp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003072 outb(0, brdp->iobase);
3073 mdelay(1000);
3074}
3075
3076/*****************************************************************************/
3077
3078/*
3079 * Try to find an ECP board and initialize it. This handles only ECP
3080 * board types.
3081 */
3082
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003083static int stli_initecp(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003084{
Alan Cox4ac43602006-06-28 04:26:52 -07003085 cdkecpsig_t sig;
3086 cdkecpsig_t __iomem *sigsp;
3087 unsigned int status, nxtid;
3088 char *name;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003089 int retval, panelnr, nrports;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003090
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003091 if ((brdp->iobase == 0) || (brdp->memaddr == 0)) {
3092 retval = -ENODEV;
3093 goto err;
3094 }
3095
Ingo Korbb3061222007-07-17 04:05:23 -07003096 brdp->iosize = ECP_IOSIZE;
3097
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003098 if (!request_region(brdp->iobase, brdp->iosize, "istallion")) {
3099 retval = -EIO;
3100 goto err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003101 }
3102
Linus Torvalds1da177e2005-04-16 15:20:36 -07003103/*
3104 * Based on the specific board type setup the common vars to access
3105 * and enable shared memory. Set all board specific information now
3106 * as well.
3107 */
3108 switch (brdp->brdtype) {
3109 case BRD_ECP:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003110 brdp->memsize = ECP_MEMSIZE;
3111 brdp->pagesize = ECP_ATPAGESIZE;
3112 brdp->init = stli_ecpinit;
3113 brdp->enable = stli_ecpenable;
3114 brdp->reenable = stli_ecpenable;
3115 brdp->disable = stli_ecpdisable;
3116 brdp->getmemptr = stli_ecpgetmemptr;
3117 brdp->intr = stli_ecpintr;
3118 brdp->reset = stli_ecpreset;
3119 name = "serial(EC8/64)";
3120 break;
3121
3122 case BRD_ECPE:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003123 brdp->memsize = ECP_MEMSIZE;
3124 brdp->pagesize = ECP_EIPAGESIZE;
3125 brdp->init = stli_ecpeiinit;
3126 brdp->enable = stli_ecpeienable;
3127 brdp->reenable = stli_ecpeienable;
3128 brdp->disable = stli_ecpeidisable;
3129 brdp->getmemptr = stli_ecpeigetmemptr;
3130 brdp->intr = stli_ecpintr;
3131 brdp->reset = stli_ecpeireset;
3132 name = "serial(EC8/64-EI)";
3133 break;
3134
3135 case BRD_ECPMC:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003136 brdp->memsize = ECP_MEMSIZE;
3137 brdp->pagesize = ECP_MCPAGESIZE;
3138 brdp->init = NULL;
3139 brdp->enable = stli_ecpmcenable;
3140 brdp->reenable = stli_ecpmcenable;
3141 brdp->disable = stli_ecpmcdisable;
3142 brdp->getmemptr = stli_ecpmcgetmemptr;
3143 brdp->intr = stli_ecpintr;
3144 brdp->reset = stli_ecpmcreset;
3145 name = "serial(EC8/64-MCA)";
3146 break;
3147
3148 case BRD_ECPPCI:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003149 brdp->memsize = ECP_PCIMEMSIZE;
3150 brdp->pagesize = ECP_PCIPAGESIZE;
3151 brdp->init = stli_ecppciinit;
3152 brdp->enable = NULL;
3153 brdp->reenable = NULL;
3154 brdp->disable = NULL;
3155 brdp->getmemptr = stli_ecppcigetmemptr;
3156 brdp->intr = stli_ecpintr;
3157 brdp->reset = stli_ecppcireset;
3158 name = "serial(EC/RA-PCI)";
3159 break;
3160
3161 default:
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003162 retval = -EINVAL;
3163 goto err_reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003164 }
3165
3166/*
3167 * The per-board operations structure is all set up, so now let's go
3168 * and get the board operational. Firstly initialize board configuration
3169 * registers. Set the memory mapping info so we can get at the boards
3170 * shared memory.
3171 */
3172 EBRDINIT(brdp);
3173
Alan Cox24cb2332008-04-30 00:54:19 -07003174 brdp->membase = ioremap_nocache(brdp->memaddr, brdp->memsize);
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003175 if (brdp->membase == NULL) {
3176 retval = -ENOMEM;
3177 goto err_reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003178 }
3179
3180/*
3181 * Now that all specific code is set up, enable the shared memory and
3182 * look for the a signature area that will tell us exactly what board
3183 * this is, and what it is connected to it.
3184 */
3185 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07003186 sigsp = (cdkecpsig_t __iomem *) EBRDGETMEMPTR(brdp, CDK_SIGADDR);
Al Viro634965f2006-09-23 01:20:31 +01003187 memcpy_fromio(&sig, sigsp, sizeof(cdkecpsig_t));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003188 EBRDDISABLE(brdp);
3189
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003190 if (sig.magic != cpu_to_le32(ECP_MAGIC)) {
3191 retval = -ENODEV;
3192 goto err_unmap;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003193 }
3194
3195/*
3196 * Scan through the signature looking at the panels connected to the
3197 * board. Calculate the total number of ports as we go.
3198 */
3199 for (panelnr = 0, nxtid = 0; (panelnr < STL_MAXPANELS); panelnr++) {
3200 status = sig.panelid[nxtid];
3201 if ((status & ECH_PNLIDMASK) != nxtid)
3202 break;
3203
3204 brdp->panelids[panelnr] = status;
3205 nrports = (status & ECH_PNL16PORT) ? 16 : 8;
3206 if ((nrports == 16) && ((status & ECH_PNLXPID) == 0))
3207 nxtid++;
3208 brdp->panels[panelnr] = nrports;
3209 brdp->nrports += nrports;
3210 nxtid++;
3211 brdp->nrpanels++;
3212 }
3213
3214
3215 brdp->state |= BST_FOUND;
Alan Cox4ac43602006-06-28 04:26:52 -07003216 return 0;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003217err_unmap:
3218 iounmap(brdp->membase);
3219 brdp->membase = NULL;
3220err_reg:
3221 release_region(brdp->iobase, brdp->iosize);
3222err:
3223 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003224}
3225
3226/*****************************************************************************/
3227
3228/*
3229 * Try to find an ONboard, Brumby or Stallion board and initialize it.
3230 * This handles only these board types.
3231 */
3232
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003233static int stli_initonb(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003234{
Alan Cox4ac43602006-06-28 04:26:52 -07003235 cdkonbsig_t sig;
3236 cdkonbsig_t __iomem *sigsp;
3237 char *name;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003238 int i, retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003239
3240/*
3241 * Do a basic sanity check on the IO and memory addresses.
3242 */
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003243 if (brdp->iobase == 0 || brdp->memaddr == 0) {
3244 retval = -ENODEV;
3245 goto err;
3246 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003247
3248 brdp->iosize = ONB_IOSIZE;
3249
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003250 if (!request_region(brdp->iobase, brdp->iosize, "istallion")) {
3251 retval = -EIO;
3252 goto err;
3253 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003254
3255/*
3256 * Based on the specific board type setup the common vars to access
3257 * and enable shared memory. Set all board specific information now
3258 * as well.
3259 */
3260 switch (brdp->brdtype) {
3261 case BRD_ONBOARD:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003262 case BRD_ONBOARD2:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003263 brdp->memsize = ONB_MEMSIZE;
3264 brdp->pagesize = ONB_ATPAGESIZE;
3265 brdp->init = stli_onbinit;
3266 brdp->enable = stli_onbenable;
3267 brdp->reenable = stli_onbenable;
3268 brdp->disable = stli_onbdisable;
3269 brdp->getmemptr = stli_onbgetmemptr;
3270 brdp->intr = stli_ecpintr;
3271 brdp->reset = stli_onbreset;
3272 if (brdp->memaddr > 0x100000)
3273 brdp->enabval = ONB_MEMENABHI;
3274 else
3275 brdp->enabval = ONB_MEMENABLO;
3276 name = "serial(ONBoard)";
3277 break;
3278
3279 case BRD_ONBOARDE:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003280 brdp->memsize = ONB_EIMEMSIZE;
3281 brdp->pagesize = ONB_EIPAGESIZE;
3282 brdp->init = stli_onbeinit;
3283 brdp->enable = stli_onbeenable;
3284 brdp->reenable = stli_onbeenable;
3285 brdp->disable = stli_onbedisable;
3286 brdp->getmemptr = stli_onbegetmemptr;
3287 brdp->intr = stli_ecpintr;
3288 brdp->reset = stli_onbereset;
3289 name = "serial(ONBoard/E)";
3290 break;
3291
3292 case BRD_BRUMBY4:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003293 brdp->memsize = BBY_MEMSIZE;
3294 brdp->pagesize = BBY_PAGESIZE;
3295 brdp->init = stli_bbyinit;
3296 brdp->enable = NULL;
3297 brdp->reenable = NULL;
3298 brdp->disable = NULL;
3299 brdp->getmemptr = stli_bbygetmemptr;
3300 brdp->intr = stli_ecpintr;
3301 brdp->reset = stli_bbyreset;
3302 name = "serial(Brumby)";
3303 break;
3304
3305 case BRD_STALLION:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003306 brdp->memsize = STAL_MEMSIZE;
3307 brdp->pagesize = STAL_PAGESIZE;
3308 brdp->init = stli_stalinit;
3309 brdp->enable = NULL;
3310 brdp->reenable = NULL;
3311 brdp->disable = NULL;
3312 brdp->getmemptr = stli_stalgetmemptr;
3313 brdp->intr = stli_ecpintr;
3314 brdp->reset = stli_stalreset;
3315 name = "serial(Stallion)";
3316 break;
3317
3318 default:
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003319 retval = -EINVAL;
3320 goto err_reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003321 }
3322
3323/*
3324 * The per-board operations structure is all set up, so now let's go
3325 * and get the board operational. Firstly initialize board configuration
3326 * registers. Set the memory mapping info so we can get at the boards
3327 * shared memory.
3328 */
3329 EBRDINIT(brdp);
3330
Alan Cox24cb2332008-04-30 00:54:19 -07003331 brdp->membase = ioremap_nocache(brdp->memaddr, brdp->memsize);
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003332 if (brdp->membase == NULL) {
3333 retval = -ENOMEM;
3334 goto err_reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003335 }
3336
3337/*
3338 * Now that all specific code is set up, enable the shared memory and
3339 * look for the a signature area that will tell us exactly what board
3340 * this is, and how many ports.
3341 */
3342 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07003343 sigsp = (cdkonbsig_t __iomem *) EBRDGETMEMPTR(brdp, CDK_SIGADDR);
3344 memcpy_fromio(&sig, sigsp, sizeof(cdkonbsig_t));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003345 EBRDDISABLE(brdp);
3346
Alan Cox4ac43602006-06-28 04:26:52 -07003347 if (sig.magic0 != cpu_to_le16(ONB_MAGIC0) ||
3348 sig.magic1 != cpu_to_le16(ONB_MAGIC1) ||
3349 sig.magic2 != cpu_to_le16(ONB_MAGIC2) ||
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003350 sig.magic3 != cpu_to_le16(ONB_MAGIC3)) {
3351 retval = -ENODEV;
3352 goto err_unmap;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003353 }
3354
3355/*
3356 * Scan through the signature alive mask and calculate how many ports
3357 * there are on this board.
3358 */
3359 brdp->nrpanels = 1;
3360 if (sig.amask1) {
3361 brdp->nrports = 32;
3362 } else {
3363 for (i = 0; (i < 16); i++) {
3364 if (((sig.amask0 << i) & 0x8000) == 0)
3365 break;
3366 }
3367 brdp->nrports = i;
3368 }
3369 brdp->panels[0] = brdp->nrports;
3370
3371
3372 brdp->state |= BST_FOUND;
Alan Cox4ac43602006-06-28 04:26:52 -07003373 return 0;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003374err_unmap:
3375 iounmap(brdp->membase);
3376 brdp->membase = NULL;
3377err_reg:
3378 release_region(brdp->iobase, brdp->iosize);
3379err:
3380 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003381}
3382
3383/*****************************************************************************/
3384
3385/*
3386 * Start up a running board. This routine is only called after the
3387 * code has been down loaded to the board and is operational. It will
3388 * read in the memory map, and get the show on the road...
3389 */
3390
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003391static int stli_startbrd(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003392{
Alan Cox4ac43602006-06-28 04:26:52 -07003393 cdkhdr_t __iomem *hdrp;
3394 cdkmem_t __iomem *memp;
3395 cdkasy_t __iomem *ap;
3396 unsigned long flags;
Jiri Slaby1328d732006-12-08 02:39:19 -08003397 unsigned int portnr, nrdevs, i;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003398 struct stliport *portp;
Jiri Slaby1328d732006-12-08 02:39:19 -08003399 int rc = 0;
Alan Cox4ac43602006-06-28 04:26:52 -07003400 u32 memoff;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003401
Alan Cox4ac43602006-06-28 04:26:52 -07003402 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003403 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07003404 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003405 nrdevs = hdrp->nrdevs;
3406
3407#if 0
3408 printk("%s(%d): CDK version %d.%d.%d --> "
3409 "nrdevs=%d memp=%x hostp=%x slavep=%x\n",
Alan Cox4ac43602006-06-28 04:26:52 -07003410 __FILE__, __LINE__, readb(&hdrp->ver_release), readb(&hdrp->ver_modification),
3411 readb(&hdrp->ver_fix), nrdevs, (int) readl(&hdrp->memp), readl(&hdrp->hostp),
3412 readl(&hdrp->slavep));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003413#endif
3414
3415 if (nrdevs < (brdp->nrports + 1)) {
Alan Coxa6614992009-01-02 13:46:50 +00003416 printk(KERN_ERR "istallion: slave failed to allocate memory for "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003417 "all devices, devices=%d\n", nrdevs);
3418 brdp->nrports = nrdevs - 1;
3419 }
3420 brdp->nrdevs = nrdevs;
3421 brdp->hostoffset = hdrp->hostp - CDK_CDKADDR;
3422 brdp->slaveoffset = hdrp->slavep - CDK_CDKADDR;
3423 brdp->bitsize = (nrdevs + 7) / 8;
Alan Cox4ac43602006-06-28 04:26:52 -07003424 memoff = readl(&hdrp->memp);
3425 if (memoff > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00003426 printk(KERN_ERR "istallion: corrupted shared memory region?\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003427 rc = -EIO;
3428 goto stli_donestartup;
3429 }
Alan Cox4ac43602006-06-28 04:26:52 -07003430 memp = (cdkmem_t __iomem *) EBRDGETMEMPTR(brdp, memoff);
3431 if (readw(&memp->dtype) != TYP_ASYNCTRL) {
Alan Coxa6614992009-01-02 13:46:50 +00003432 printk(KERN_ERR "istallion: no slave control device found\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003433 goto stli_donestartup;
3434 }
3435 memp++;
3436
3437/*
3438 * Cycle through memory allocation of each port. We are guaranteed to
3439 * have all ports inside the first page of slave window, so no need to
3440 * change pages while reading memory map.
3441 */
3442 for (i = 1, portnr = 0; (i < nrdevs); i++, portnr++, memp++) {
Alan Cox4ac43602006-06-28 04:26:52 -07003443 if (readw(&memp->dtype) != TYP_ASYNC)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003444 break;
3445 portp = brdp->ports[portnr];
Alan Cox4ac43602006-06-28 04:26:52 -07003446 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003447 break;
3448 portp->devnr = i;
Alan Cox4ac43602006-06-28 04:26:52 -07003449 portp->addr = readl(&memp->offset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003450 portp->reqbit = (unsigned char) (0x1 << (i * 8 / nrdevs));
3451 portp->portidx = (unsigned char) (i / 8);
3452 portp->portbit = (unsigned char) (0x1 << (i % 8));
3453 }
3454
Alan Cox4ac43602006-06-28 04:26:52 -07003455 writeb(0xff, &hdrp->slavereq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003456
3457/*
3458 * For each port setup a local copy of the RX and TX buffer offsets
3459 * and sizes. We do this separate from the above, because we need to
3460 * move the shared memory page...
3461 */
3462 for (i = 1, portnr = 0; (i < nrdevs); i++, portnr++) {
3463 portp = brdp->ports[portnr];
Alan Cox4ac43602006-06-28 04:26:52 -07003464 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003465 break;
3466 if (portp->addr == 0)
3467 break;
Alan Cox4ac43602006-06-28 04:26:52 -07003468 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
3469 if (ap != NULL) {
3470 portp->rxsize = readw(&ap->rxq.size);
3471 portp->txsize = readw(&ap->txq.size);
3472 portp->rxoffset = readl(&ap->rxq.offset);
3473 portp->txoffset = readl(&ap->txq.offset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003474 }
3475 }
3476
3477stli_donestartup:
3478 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07003479 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003480
3481 if (rc == 0)
3482 brdp->state |= BST_STARTED;
3483
3484 if (! stli_timeron) {
3485 stli_timeron++;
Jiri Slabyff8efe92006-12-08 02:39:27 -08003486 mod_timer(&stli_timerlist, STLI_TIMEOUT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003487 }
3488
Alan Cox4ac43602006-06-28 04:26:52 -07003489 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003490}
3491
3492/*****************************************************************************/
3493
3494/*
3495 * Probe and initialize the specified board.
3496 */
3497
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003498static int __devinit stli_brdinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003499{
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003500 int retval;
3501
Linus Torvalds1da177e2005-04-16 15:20:36 -07003502 switch (brdp->brdtype) {
3503 case BRD_ECP:
3504 case BRD_ECPE:
3505 case BRD_ECPMC:
3506 case BRD_ECPPCI:
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003507 retval = stli_initecp(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003508 break;
3509 case BRD_ONBOARD:
3510 case BRD_ONBOARDE:
3511 case BRD_ONBOARD2:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003512 case BRD_BRUMBY4:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003513 case BRD_STALLION:
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003514 retval = stli_initonb(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003515 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003516 default:
Alan Coxa6614992009-01-02 13:46:50 +00003517 printk(KERN_ERR "istallion: board=%d is unknown board "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003518 "type=%d\n", brdp->brdnr, brdp->brdtype);
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003519 retval = -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003520 }
3521
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003522 if (retval)
3523 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003524
3525 stli_initports(brdp);
Alan Coxa6614992009-01-02 13:46:50 +00003526 printk(KERN_INFO "istallion: %s found, board=%d io=%x mem=%x "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003527 "nrpanels=%d nrports=%d\n", stli_brdnames[brdp->brdtype],
3528 brdp->brdnr, brdp->iobase, (int) brdp->memaddr,
3529 brdp->nrpanels, brdp->nrports);
Alan Cox4ac43602006-06-28 04:26:52 -07003530 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003531}
3532
Jiri Slabya00f33f2006-12-08 02:39:20 -08003533#if STLI_EISAPROBE != 0
Linus Torvalds1da177e2005-04-16 15:20:36 -07003534/*****************************************************************************/
3535
3536/*
3537 * Probe around trying to find where the EISA boards shared memory
3538 * might be. This is a bit if hack, but it is the best we can do.
3539 */
3540
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003541static int stli_eisamemprobe(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003542{
Alan Cox4ac43602006-06-28 04:26:52 -07003543 cdkecpsig_t ecpsig, __iomem *ecpsigp;
3544 cdkonbsig_t onbsig, __iomem *onbsigp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003545 int i, foundit;
3546
Linus Torvalds1da177e2005-04-16 15:20:36 -07003547/*
3548 * First up we reset the board, to get it into a known state. There
3549 * is only 2 board types here we need to worry about. Don;t use the
3550 * standard board init routine here, it programs up the shared
3551 * memory address, and we don't know it yet...
3552 */
3553 if (brdp->brdtype == BRD_ECPE) {
3554 outb(0x1, (brdp->iobase + ECP_EIBRDENAB));
3555 outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR));
3556 udelay(10);
3557 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
3558 udelay(500);
3559 stli_ecpeienable(brdp);
3560 } else if (brdp->brdtype == BRD_ONBOARDE) {
3561 outb(0x1, (brdp->iobase + ONB_EIBRDENAB));
3562 outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR));
3563 udelay(10);
3564 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
3565 mdelay(100);
3566 outb(0x1, brdp->iobase);
3567 mdelay(1);
3568 stli_onbeenable(brdp);
3569 } else {
Alan Cox4ac43602006-06-28 04:26:52 -07003570 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003571 }
3572
3573 foundit = 0;
3574 brdp->memsize = ECP_MEMSIZE;
3575
3576/*
3577 * Board shared memory is enabled, so now we have a poke around and
3578 * see if we can find it.
3579 */
3580 for (i = 0; (i < stli_eisamempsize); i++) {
3581 brdp->memaddr = stli_eisamemprobeaddrs[i];
Alan Cox24cb2332008-04-30 00:54:19 -07003582 brdp->membase = ioremap_nocache(brdp->memaddr, brdp->memsize);
Alan Cox4ac43602006-06-28 04:26:52 -07003583 if (brdp->membase == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003584 continue;
3585
3586 if (brdp->brdtype == BRD_ECPE) {
Al Viro29756fa2006-10-10 22:47:27 +01003587 ecpsigp = stli_ecpeigetmemptr(brdp,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003588 CDK_SIGADDR, __LINE__);
Alan Cox4ac43602006-06-28 04:26:52 -07003589 memcpy_fromio(&ecpsig, ecpsigp, sizeof(cdkecpsig_t));
3590 if (ecpsig.magic == cpu_to_le32(ECP_MAGIC))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003591 foundit = 1;
3592 } else {
Alan Cox4ac43602006-06-28 04:26:52 -07003593 onbsigp = (cdkonbsig_t __iomem *) stli_onbegetmemptr(brdp,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003594 CDK_SIGADDR, __LINE__);
Alan Cox4ac43602006-06-28 04:26:52 -07003595 memcpy_fromio(&onbsig, onbsigp, sizeof(cdkonbsig_t));
3596 if ((onbsig.magic0 == cpu_to_le16(ONB_MAGIC0)) &&
3597 (onbsig.magic1 == cpu_to_le16(ONB_MAGIC1)) &&
3598 (onbsig.magic2 == cpu_to_le16(ONB_MAGIC2)) &&
3599 (onbsig.magic3 == cpu_to_le16(ONB_MAGIC3)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003600 foundit = 1;
3601 }
3602
3603 iounmap(brdp->membase);
3604 if (foundit)
3605 break;
3606 }
3607
3608/*
3609 * Regardless of whether we found the shared memory or not we must
3610 * disable the region. After that return success or failure.
3611 */
3612 if (brdp->brdtype == BRD_ECPE)
3613 stli_ecpeidisable(brdp);
3614 else
3615 stli_onbedisable(brdp);
3616
3617 if (! foundit) {
3618 brdp->memaddr = 0;
3619 brdp->membase = NULL;
Alan Coxa6614992009-01-02 13:46:50 +00003620 printk(KERN_ERR "istallion: failed to probe shared memory "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003621 "region for %s in EISA slot=%d\n",
3622 stli_brdnames[brdp->brdtype], (brdp->iobase >> 12));
Alan Cox4ac43602006-06-28 04:26:52 -07003623 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003624 }
Alan Cox4ac43602006-06-28 04:26:52 -07003625 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003626}
Jiri Slabya00f33f2006-12-08 02:39:20 -08003627#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003628
3629static int stli_getbrdnr(void)
3630{
Jiri Slaby1328d732006-12-08 02:39:19 -08003631 unsigned int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003632
3633 for (i = 0; i < STL_MAXBRDS; i++) {
3634 if (!stli_brds[i]) {
3635 if (i >= stli_nrbrds)
3636 stli_nrbrds = i + 1;
3637 return i;
3638 }
3639 }
3640 return -1;
3641}
3642
Jiri Slabya00f33f2006-12-08 02:39:20 -08003643#if STLI_EISAPROBE != 0
Linus Torvalds1da177e2005-04-16 15:20:36 -07003644/*****************************************************************************/
3645
3646/*
3647 * Probe around and try to find any EISA boards in system. The biggest
3648 * problem here is finding out what memory address is associated with
3649 * an EISA board after it is found. The registers of the ECPE and
3650 * ONboardE are not readable - so we can't read them from there. We
3651 * don't have access to the EISA CMOS (or EISA BIOS) so we don't
3652 * actually have any way to find out the real value. The best we can
3653 * do is go probing around in the usual places hoping we can find it.
3654 */
3655
Al Viro6005e3e2008-11-22 17:34:14 +00003656static int __init stli_findeisabrds(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003657{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003658 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08003659 unsigned int iobase, eid, i;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003660 int brdnr, found = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003661
3662/*
Alan Cox4ac43602006-06-28 04:26:52 -07003663 * Firstly check if this is an EISA system. If this is not an EISA system then
Linus Torvalds1da177e2005-04-16 15:20:36 -07003664 * don't bother going any further!
3665 */
Alan Cox4ac43602006-06-28 04:26:52 -07003666 if (EISA_bus)
3667 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003668
3669/*
3670 * Looks like an EISA system, so go searching for EISA boards.
3671 */
3672 for (iobase = 0x1000; (iobase <= 0xc000); iobase += 0x1000) {
3673 outb(0xff, (iobase + 0xc80));
3674 eid = inb(iobase + 0xc80);
3675 eid |= inb(iobase + 0xc81) << 8;
3676 if (eid != STL_EISAID)
3677 continue;
3678
3679/*
3680 * We have found a board. Need to check if this board was
3681 * statically configured already (just in case!).
3682 */
3683 for (i = 0; (i < STL_MAXBRDS); i++) {
3684 brdp = stli_brds[i];
Alan Cox4ac43602006-06-28 04:26:52 -07003685 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003686 continue;
3687 if (brdp->iobase == iobase)
3688 break;
3689 }
3690 if (i < STL_MAXBRDS)
3691 continue;
3692
3693/*
3694 * We have found a Stallion board and it is not configured already.
3695 * Allocate a board structure and initialize it.
3696 */
Alan Cox4ac43602006-06-28 04:26:52 -07003697 if ((brdp = stli_allocbrd()) == NULL)
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003698 return found ? : -ENOMEM;
Jiri Slaby1328d732006-12-08 02:39:19 -08003699 brdnr = stli_getbrdnr();
3700 if (brdnr < 0)
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003701 return found ? : -ENOMEM;
Jiri Slaby1328d732006-12-08 02:39:19 -08003702 brdp->brdnr = (unsigned int)brdnr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003703 eid = inb(iobase + 0xc82);
3704 if (eid == ECP_EISAID)
3705 brdp->brdtype = BRD_ECPE;
3706 else if (eid == ONB_EISAID)
3707 brdp->brdtype = BRD_ONBOARDE;
3708 else
3709 brdp->brdtype = BRD_UNKNOWN;
3710 brdp->iobase = iobase;
3711 outb(0x1, (iobase + 0xc84));
3712 if (stli_eisamemprobe(brdp))
3713 outb(0, (iobase + 0xc84));
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003714 if (stli_brdinit(brdp) < 0) {
3715 kfree(brdp);
3716 continue;
3717 }
3718
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003719 stli_brds[brdp->brdnr] = brdp;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003720 found++;
Jiri Slabyec3dde52006-12-08 02:39:26 -08003721
3722 for (i = 0; i < brdp->nrports; i++)
3723 tty_register_device(stli_serial,
3724 brdp->brdnr * STL_MAXPORTS + i, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003725 }
3726
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003727 return found;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003728}
Jiri Slabya00f33f2006-12-08 02:39:20 -08003729#else
3730static inline int stli_findeisabrds(void) { return 0; }
3731#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003732
3733/*****************************************************************************/
3734
3735/*
3736 * Find the next available board number that is free.
3737 */
3738
3739/*****************************************************************************/
3740
Linus Torvalds1da177e2005-04-16 15:20:36 -07003741/*
3742 * We have a Stallion board. Allocate a board structure and
3743 * initialize it. Read its IO and MEMORY resources from PCI
3744 * configuration space.
3745 */
3746
Jiri Slaby845bead2006-12-08 02:39:17 -08003747static int __devinit stli_pciprobe(struct pci_dev *pdev,
3748 const struct pci_device_id *ent)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003749{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003750 struct stlibrd *brdp;
Jiri Slabyec3dde52006-12-08 02:39:26 -08003751 unsigned int i;
Jiri Slaby1328d732006-12-08 02:39:19 -08003752 int brdnr, retval = -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003753
Jiri Slaby845bead2006-12-08 02:39:17 -08003754 retval = pci_enable_device(pdev);
3755 if (retval)
3756 goto err;
3757 brdp = stli_allocbrd();
3758 if (brdp == NULL) {
3759 retval = -ENOMEM;
3760 goto err;
3761 }
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003762 mutex_lock(&stli_brdslock);
Jiri Slaby1328d732006-12-08 02:39:19 -08003763 brdnr = stli_getbrdnr();
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003764 if (brdnr < 0) {
Alan Coxa6614992009-01-02 13:46:50 +00003765 printk(KERN_INFO "istallion: too many boards found, "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003766 "maximum supported %d\n", STL_MAXBRDS);
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003767 mutex_unlock(&stli_brdslock);
Jiri Slaby845bead2006-12-08 02:39:17 -08003768 retval = -EIO;
3769 goto err_fr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003770 }
Jiri Slaby1328d732006-12-08 02:39:19 -08003771 brdp->brdnr = (unsigned int)brdnr;
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003772 stli_brds[brdp->brdnr] = brdp;
3773 mutex_unlock(&stli_brdslock);
Jiri Slaby845bead2006-12-08 02:39:17 -08003774 brdp->brdtype = BRD_ECPPCI;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003775/*
3776 * We have all resources from the board, so lets setup the actual
3777 * board structure now.
3778 */
Jiri Slaby845bead2006-12-08 02:39:17 -08003779 brdp->iobase = pci_resource_start(pdev, 3);
3780 brdp->memaddr = pci_resource_start(pdev, 2);
3781 retval = stli_brdinit(brdp);
3782 if (retval)
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003783 goto err_null;
Jiri Slaby845bead2006-12-08 02:39:17 -08003784
Jiri Slaby39014172006-12-08 02:39:22 -08003785 brdp->state |= BST_PROBED;
Jiri Slaby845bead2006-12-08 02:39:17 -08003786 pci_set_drvdata(pdev, brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003787
Jiri Slaby140e92a2006-12-08 02:39:24 -08003788 EBRDENABLE(brdp);
3789 brdp->enable = NULL;
3790 brdp->disable = NULL;
3791
Jiri Slabyec3dde52006-12-08 02:39:26 -08003792 for (i = 0; i < brdp->nrports; i++)
3793 tty_register_device(stli_serial, brdp->brdnr * STL_MAXPORTS + i,
3794 &pdev->dev);
3795
Alan Cox4ac43602006-06-28 04:26:52 -07003796 return 0;
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003797err_null:
3798 stli_brds[brdp->brdnr] = NULL;
Jiri Slaby845bead2006-12-08 02:39:17 -08003799err_fr:
3800 kfree(brdp);
3801err:
3802 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003803}
3804
Jiri Slaby845bead2006-12-08 02:39:17 -08003805static void stli_pciremove(struct pci_dev *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003806{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003807 struct stlibrd *brdp = pci_get_drvdata(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003808
Jiri Slaby845bead2006-12-08 02:39:17 -08003809 stli_cleanup_ports(brdp);
3810
3811 iounmap(brdp->membase);
3812 if (brdp->iosize > 0)
3813 release_region(brdp->iobase, brdp->iosize);
3814
3815 stli_brds[brdp->brdnr] = NULL;
3816 kfree(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003817}
3818
Jiri Slaby845bead2006-12-08 02:39:17 -08003819static struct pci_driver stli_pcidriver = {
3820 .name = "istallion",
3821 .id_table = istallion_pci_tbl,
3822 .probe = stli_pciprobe,
3823 .remove = __devexit_p(stli_pciremove)
3824};
Linus Torvalds1da177e2005-04-16 15:20:36 -07003825/*****************************************************************************/
3826
3827/*
3828 * Allocate a new board structure. Fill out the basic info in it.
3829 */
3830
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003831static struct stlibrd *stli_allocbrd(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003832{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003833 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003834
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003835 brdp = kzalloc(sizeof(struct stlibrd), GFP_KERNEL);
Tobias Klauserb0b4ed72006-03-31 02:30:56 -08003836 if (!brdp) {
Alan Coxa6614992009-01-02 13:46:50 +00003837 printk(KERN_ERR "istallion: failed to allocate memory "
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003838 "(size=%Zd)\n", sizeof(struct stlibrd));
Tobias Klauserb0b4ed72006-03-31 02:30:56 -08003839 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003840 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003841 brdp->magic = STLI_BOARDMAGIC;
Alan Cox4ac43602006-06-28 04:26:52 -07003842 return brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003843}
3844
3845/*****************************************************************************/
3846
3847/*
3848 * Scan through all the boards in the configuration and see what we
3849 * can find.
3850 */
3851
Al Viro6005e3e2008-11-22 17:34:14 +00003852static int __init stli_initbrds(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003853{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003854 struct stlibrd *brdp, *nxtbrdp;
3855 struct stlconf conf;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003856 unsigned int i, j, found = 0;
Jiri Slaby1328d732006-12-08 02:39:19 -08003857 int retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003858
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08003859 for (stli_nrbrds = 0; stli_nrbrds < ARRAY_SIZE(stli_brdsp);
3860 stli_nrbrds++) {
3861 memset(&conf, 0, sizeof(conf));
3862 if (stli_parsebrd(&conf, stli_brdsp[stli_nrbrds]) == 0)
3863 continue;
Alan Cox4ac43602006-06-28 04:26:52 -07003864 if ((brdp = stli_allocbrd()) == NULL)
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08003865 continue;
3866 brdp->brdnr = stli_nrbrds;
3867 brdp->brdtype = conf.brdtype;
3868 brdp->iobase = conf.ioaddr1;
3869 brdp->memaddr = conf.memaddr;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003870 if (stli_brdinit(brdp) < 0) {
3871 kfree(brdp);
3872 continue;
3873 }
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003874 stli_brds[brdp->brdnr] = brdp;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003875 found++;
Jiri Slabyec3dde52006-12-08 02:39:26 -08003876
3877 for (i = 0; i < brdp->nrports; i++)
3878 tty_register_device(stli_serial,
3879 brdp->brdnr * STL_MAXPORTS + i, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003880 }
3881
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003882 retval = stli_findeisabrds();
3883 if (retval > 0)
3884 found += retval;
Jiri Slaby845bead2006-12-08 02:39:17 -08003885
Linus Torvalds1da177e2005-04-16 15:20:36 -07003886/*
3887 * All found boards are initialized. Now for a little optimization, if
3888 * no boards are sharing the "shared memory" regions then we can just
3889 * leave them all enabled. This is in fact the usual case.
3890 */
3891 stli_shared = 0;
3892 if (stli_nrbrds > 1) {
3893 for (i = 0; (i < stli_nrbrds); i++) {
3894 brdp = stli_brds[i];
Alan Cox4ac43602006-06-28 04:26:52 -07003895 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003896 continue;
3897 for (j = i + 1; (j < stli_nrbrds); j++) {
3898 nxtbrdp = stli_brds[j];
Alan Cox4ac43602006-06-28 04:26:52 -07003899 if (nxtbrdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003900 continue;
3901 if ((brdp->membase >= nxtbrdp->membase) &&
3902 (brdp->membase <= (nxtbrdp->membase +
3903 nxtbrdp->memsize - 1))) {
3904 stli_shared++;
3905 break;
3906 }
3907 }
3908 }
3909 }
3910
3911 if (stli_shared == 0) {
3912 for (i = 0; (i < stli_nrbrds); i++) {
3913 brdp = stli_brds[i];
Alan Cox4ac43602006-06-28 04:26:52 -07003914 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003915 continue;
3916 if (brdp->state & BST_FOUND) {
3917 EBRDENABLE(brdp);
3918 brdp->enable = NULL;
3919 brdp->disable = NULL;
3920 }
3921 }
3922 }
3923
Jiri Slaby140e92a2006-12-08 02:39:24 -08003924 retval = pci_register_driver(&stli_pcidriver);
3925 if (retval && found == 0) {
3926 printk(KERN_ERR "Neither isa nor eisa cards found nor pci "
3927 "driver can be registered!\n");
3928 goto err;
3929 }
3930
Alan Cox4ac43602006-06-28 04:26:52 -07003931 return 0;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003932err:
3933 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003934}
3935
3936/*****************************************************************************/
3937
3938/*
3939 * Code to handle an "staliomem" read operation. This device is the
3940 * contents of the board shared memory. It is used for down loading
3941 * the slave image (and debugging :-)
3942 */
3943
3944static ssize_t stli_memread(struct file *fp, char __user *buf, size_t count, loff_t *offp)
3945{
Alan Cox4ac43602006-06-28 04:26:52 -07003946 unsigned long flags;
Al Viro29756fa2006-10-10 22:47:27 +01003947 void __iomem *memptr;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003948 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08003949 unsigned int brdnr;
3950 int size, n;
Alan Cox4ac43602006-06-28 04:26:52 -07003951 void *p;
3952 loff_t off = *offp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003953
Josef Sipeka7113a92006-12-08 02:36:55 -08003954 brdnr = iminor(fp->f_path.dentry->d_inode);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003955 if (brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07003956 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003957 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07003958 if (brdp == NULL)
3959 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003960 if (brdp->state == 0)
Alan Cox4ac43602006-06-28 04:26:52 -07003961 return -ENODEV;
3962 if (off >= brdp->memsize || off + count < off)
3963 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003964
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08003965 size = min(count, (size_t)(brdp->memsize - off));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003966
Alan Cox4ac43602006-06-28 04:26:52 -07003967 /*
3968 * Copy the data a page at a time
3969 */
3970
3971 p = (void *)__get_free_page(GFP_KERNEL);
3972 if(p == NULL)
3973 return -ENOMEM;
3974
Linus Torvalds1da177e2005-04-16 15:20:36 -07003975 while (size > 0) {
Alan Cox4ac43602006-06-28 04:26:52 -07003976 spin_lock_irqsave(&brd_lock, flags);
3977 EBRDENABLE(brdp);
Al Viro29756fa2006-10-10 22:47:27 +01003978 memptr = EBRDGETMEMPTR(brdp, off);
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08003979 n = min(size, (int)(brdp->pagesize - (((unsigned long) off) % brdp->pagesize)));
3980 n = min(n, (int)PAGE_SIZE);
Alan Cox4ac43602006-06-28 04:26:52 -07003981 memcpy_fromio(p, memptr, n);
3982 EBRDDISABLE(brdp);
3983 spin_unlock_irqrestore(&brd_lock, flags);
3984 if (copy_to_user(buf, p, n)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003985 count = -EFAULT;
3986 goto out;
3987 }
Alan Cox4ac43602006-06-28 04:26:52 -07003988 off += n;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003989 buf += n;
3990 size -= n;
3991 }
3992out:
Alan Cox4ac43602006-06-28 04:26:52 -07003993 *offp = off;
3994 free_page((unsigned long)p);
3995 return count;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003996}
3997
3998/*****************************************************************************/
3999
4000/*
4001 * Code to handle an "staliomem" write operation. This device is the
4002 * contents of the board shared memory. It is used for down loading
4003 * the slave image (and debugging :-)
Alan Cox4ac43602006-06-28 04:26:52 -07004004 *
4005 * FIXME: copy under lock
Linus Torvalds1da177e2005-04-16 15:20:36 -07004006 */
4007
4008static ssize_t stli_memwrite(struct file *fp, const char __user *buf, size_t count, loff_t *offp)
4009{
Alan Cox4ac43602006-06-28 04:26:52 -07004010 unsigned long flags;
Al Viro29756fa2006-10-10 22:47:27 +01004011 void __iomem *memptr;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004012 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07004013 char __user *chbuf;
Jiri Slaby1328d732006-12-08 02:39:19 -08004014 unsigned int brdnr;
4015 int size, n;
Alan Cox4ac43602006-06-28 04:26:52 -07004016 void *p;
4017 loff_t off = *offp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004018
Josef Sipeka7113a92006-12-08 02:36:55 -08004019 brdnr = iminor(fp->f_path.dentry->d_inode);
Alan Cox4ac43602006-06-28 04:26:52 -07004020
Linus Torvalds1da177e2005-04-16 15:20:36 -07004021 if (brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07004022 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004023 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07004024 if (brdp == NULL)
4025 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004026 if (brdp->state == 0)
Alan Cox4ac43602006-06-28 04:26:52 -07004027 return -ENODEV;
4028 if (off >= brdp->memsize || off + count < off)
4029 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004030
4031 chbuf = (char __user *) buf;
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08004032 size = min(count, (size_t)(brdp->memsize - off));
Linus Torvalds1da177e2005-04-16 15:20:36 -07004033
Alan Cox4ac43602006-06-28 04:26:52 -07004034 /*
4035 * Copy the data a page at a time
4036 */
4037
4038 p = (void *)__get_free_page(GFP_KERNEL);
4039 if(p == NULL)
4040 return -ENOMEM;
4041
Linus Torvalds1da177e2005-04-16 15:20:36 -07004042 while (size > 0) {
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08004043 n = min(size, (int)(brdp->pagesize - (((unsigned long) off) % brdp->pagesize)));
4044 n = min(n, (int)PAGE_SIZE);
Alan Cox4ac43602006-06-28 04:26:52 -07004045 if (copy_from_user(p, chbuf, n)) {
4046 if (count == 0)
4047 count = -EFAULT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004048 goto out;
4049 }
Alan Cox4ac43602006-06-28 04:26:52 -07004050 spin_lock_irqsave(&brd_lock, flags);
4051 EBRDENABLE(brdp);
Al Viro29756fa2006-10-10 22:47:27 +01004052 memptr = EBRDGETMEMPTR(brdp, off);
Alan Cox4ac43602006-06-28 04:26:52 -07004053 memcpy_toio(memptr, p, n);
4054 EBRDDISABLE(brdp);
4055 spin_unlock_irqrestore(&brd_lock, flags);
4056 off += n;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004057 chbuf += n;
4058 size -= n;
4059 }
4060out:
Alan Cox4ac43602006-06-28 04:26:52 -07004061 free_page((unsigned long) p);
4062 *offp = off;
4063 return count;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004064}
4065
4066/*****************************************************************************/
4067
4068/*
4069 * Return the board stats structure to user app.
4070 */
4071
4072static int stli_getbrdstats(combrd_t __user *bp)
4073{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004074 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08004075 unsigned int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004076
4077 if (copy_from_user(&stli_brdstats, bp, sizeof(combrd_t)))
4078 return -EFAULT;
4079 if (stli_brdstats.brd >= STL_MAXBRDS)
Alan Cox4ac43602006-06-28 04:26:52 -07004080 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004081 brdp = stli_brds[stli_brdstats.brd];
Alan Cox4ac43602006-06-28 04:26:52 -07004082 if (brdp == NULL)
4083 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004084
4085 memset(&stli_brdstats, 0, sizeof(combrd_t));
4086 stli_brdstats.brd = brdp->brdnr;
4087 stli_brdstats.type = brdp->brdtype;
4088 stli_brdstats.hwid = 0;
4089 stli_brdstats.state = brdp->state;
4090 stli_brdstats.ioaddr = brdp->iobase;
4091 stli_brdstats.memaddr = brdp->memaddr;
4092 stli_brdstats.nrpanels = brdp->nrpanels;
4093 stli_brdstats.nrports = brdp->nrports;
4094 for (i = 0; (i < brdp->nrpanels); i++) {
4095 stli_brdstats.panels[i].panel = i;
4096 stli_brdstats.panels[i].hwid = brdp->panelids[i];
4097 stli_brdstats.panels[i].nrports = brdp->panels[i];
4098 }
4099
4100 if (copy_to_user(bp, &stli_brdstats, sizeof(combrd_t)))
4101 return -EFAULT;
Alan Cox4ac43602006-06-28 04:26:52 -07004102 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004103}
4104
4105/*****************************************************************************/
4106
4107/*
4108 * Resolve the referenced port number into a port struct pointer.
4109 */
4110
Jiri Slaby1328d732006-12-08 02:39:19 -08004111static struct stliport *stli_getport(unsigned int brdnr, unsigned int panelnr,
4112 unsigned int portnr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004113{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004114 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08004115 unsigned int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004116
Jiri Slaby1328d732006-12-08 02:39:19 -08004117 if (brdnr >= STL_MAXBRDS)
Alan Cox4ac43602006-06-28 04:26:52 -07004118 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004119 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07004120 if (brdp == NULL)
4121 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004122 for (i = 0; (i < panelnr); i++)
4123 portnr += brdp->panels[i];
Jiri Slaby1328d732006-12-08 02:39:19 -08004124 if (portnr >= brdp->nrports)
Alan Cox4ac43602006-06-28 04:26:52 -07004125 return NULL;
4126 return brdp->ports[portnr];
Linus Torvalds1da177e2005-04-16 15:20:36 -07004127}
4128
4129/*****************************************************************************/
4130
4131/*
4132 * Return the port stats structure to user app. A NULL port struct
4133 * pointer passed in means that we need to find out from the app
4134 * what port to get stats for (used through board control device).
4135 */
4136
Alan Coxd18a7502008-10-13 10:40:07 +01004137static int stli_portcmdstats(struct tty_struct *tty, struct stliport *portp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004138{
4139 unsigned long flags;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004140 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004141 int rc;
4142
4143 memset(&stli_comstats, 0, sizeof(comstats_t));
4144
Alan Cox4ac43602006-06-28 04:26:52 -07004145 if (portp == NULL)
4146 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004147 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07004148 if (brdp == NULL)
4149 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004150
4151 if (brdp->state & BST_STARTED) {
4152 if ((rc = stli_cmdwait(brdp, portp, A_GETSTATS,
4153 &stli_cdkstats, sizeof(asystats_t), 1)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -07004154 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004155 } else {
4156 memset(&stli_cdkstats, 0, sizeof(asystats_t));
4157 }
4158
4159 stli_comstats.brd = portp->brdnr;
4160 stli_comstats.panel = portp->panelnr;
4161 stli_comstats.port = portp->portnr;
4162 stli_comstats.state = portp->state;
Wang Chen42a77a12008-07-21 17:48:59 +08004163 stli_comstats.flags = portp->port.flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004164
Alan Cox4ac43602006-06-28 04:26:52 -07004165 spin_lock_irqsave(&brd_lock, flags);
Alan Coxd18a7502008-10-13 10:40:07 +01004166 if (tty != NULL) {
4167 if (portp->port.tty == tty) {
4168 stli_comstats.ttystate = tty->flags;
Alan Cox4ac43602006-06-28 04:26:52 -07004169 stli_comstats.rxbuffered = -1;
Alan Coxd18a7502008-10-13 10:40:07 +01004170 if (tty->termios != NULL) {
4171 stli_comstats.cflags = tty->termios->c_cflag;
4172 stli_comstats.iflags = tty->termios->c_iflag;
4173 stli_comstats.oflags = tty->termios->c_oflag;
4174 stli_comstats.lflags = tty->termios->c_lflag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004175 }
4176 }
4177 }
Alan Cox4ac43602006-06-28 04:26:52 -07004178 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004179
4180 stli_comstats.txtotal = stli_cdkstats.txchars;
4181 stli_comstats.rxtotal = stli_cdkstats.rxchars + stli_cdkstats.ringover;
4182 stli_comstats.txbuffered = stli_cdkstats.txringq;
4183 stli_comstats.rxbuffered += stli_cdkstats.rxringq;
4184 stli_comstats.rxoverrun = stli_cdkstats.overruns;
4185 stli_comstats.rxparity = stli_cdkstats.parity;
4186 stli_comstats.rxframing = stli_cdkstats.framing;
4187 stli_comstats.rxlost = stli_cdkstats.ringover;
4188 stli_comstats.rxbreaks = stli_cdkstats.rxbreaks;
4189 stli_comstats.txbreaks = stli_cdkstats.txbreaks;
4190 stli_comstats.txxon = stli_cdkstats.txstart;
4191 stli_comstats.txxoff = stli_cdkstats.txstop;
4192 stli_comstats.rxxon = stli_cdkstats.rxstart;
4193 stli_comstats.rxxoff = stli_cdkstats.rxstop;
4194 stli_comstats.rxrtsoff = stli_cdkstats.rtscnt / 2;
4195 stli_comstats.rxrtson = stli_cdkstats.rtscnt - stli_comstats.rxrtsoff;
4196 stli_comstats.modem = stli_cdkstats.dcdcnt;
4197 stli_comstats.hwid = stli_cdkstats.hwid;
4198 stli_comstats.signals = stli_mktiocm(stli_cdkstats.signals);
4199
Alan Cox4ac43602006-06-28 04:26:52 -07004200 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004201}
4202
4203/*****************************************************************************/
4204
4205/*
4206 * Return the port stats structure to user app. A NULL port struct
4207 * pointer passed in means that we need to find out from the app
4208 * what port to get stats for (used through board control device).
4209 */
4210
Alan Coxd18a7502008-10-13 10:40:07 +01004211static int stli_getportstats(struct tty_struct *tty, struct stliport *portp,
4212 comstats_t __user *cp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004213{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004214 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07004215 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004216
4217 if (!portp) {
4218 if (copy_from_user(&stli_comstats, cp, sizeof(comstats_t)))
4219 return -EFAULT;
4220 portp = stli_getport(stli_comstats.brd, stli_comstats.panel,
4221 stli_comstats.port);
4222 if (!portp)
4223 return -ENODEV;
4224 }
4225
4226 brdp = stli_brds[portp->brdnr];
4227 if (!brdp)
4228 return -ENODEV;
4229
Alan Coxd18a7502008-10-13 10:40:07 +01004230 if ((rc = stli_portcmdstats(tty, portp)) < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004231 return rc;
4232
4233 return copy_to_user(cp, &stli_comstats, sizeof(comstats_t)) ?
4234 -EFAULT : 0;
4235}
4236
4237/*****************************************************************************/
4238
4239/*
4240 * Clear the port stats structure. We also return it zeroed out...
4241 */
4242
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004243static int stli_clrportstats(struct stliport *portp, comstats_t __user *cp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004244{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004245 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07004246 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004247
4248 if (!portp) {
4249 if (copy_from_user(&stli_comstats, cp, sizeof(comstats_t)))
4250 return -EFAULT;
4251 portp = stli_getport(stli_comstats.brd, stli_comstats.panel,
4252 stli_comstats.port);
4253 if (!portp)
4254 return -ENODEV;
4255 }
4256
4257 brdp = stli_brds[portp->brdnr];
4258 if (!brdp)
4259 return -ENODEV;
4260
4261 if (brdp->state & BST_STARTED) {
4262 if ((rc = stli_cmdwait(brdp, portp, A_CLEARSTATS, NULL, 0, 0)) < 0)
4263 return rc;
4264 }
4265
4266 memset(&stli_comstats, 0, sizeof(comstats_t));
4267 stli_comstats.brd = portp->brdnr;
4268 stli_comstats.panel = portp->panelnr;
4269 stli_comstats.port = portp->portnr;
4270
4271 if (copy_to_user(cp, &stli_comstats, sizeof(comstats_t)))
4272 return -EFAULT;
4273 return 0;
4274}
4275
4276/*****************************************************************************/
4277
4278/*
4279 * Return the entire driver ports structure to a user app.
4280 */
4281
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004282static int stli_getportstruct(struct stliport __user *arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004283{
Jiri Slaby1328d732006-12-08 02:39:19 -08004284 struct stliport stli_dummyport;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004285 struct stliport *portp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004286
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004287 if (copy_from_user(&stli_dummyport, arg, sizeof(struct stliport)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004288 return -EFAULT;
4289 portp = stli_getport(stli_dummyport.brdnr, stli_dummyport.panelnr,
4290 stli_dummyport.portnr);
4291 if (!portp)
4292 return -ENODEV;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004293 if (copy_to_user(arg, portp, sizeof(struct stliport)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004294 return -EFAULT;
4295 return 0;
4296}
4297
4298/*****************************************************************************/
4299
4300/*
4301 * Return the entire driver board structure to a user app.
4302 */
4303
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004304static int stli_getbrdstruct(struct stlibrd __user *arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004305{
Jiri Slaby1328d732006-12-08 02:39:19 -08004306 struct stlibrd stli_dummybrd;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004307 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004308
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004309 if (copy_from_user(&stli_dummybrd, arg, sizeof(struct stlibrd)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004310 return -EFAULT;
Jiri Slaby1328d732006-12-08 02:39:19 -08004311 if (stli_dummybrd.brdnr >= STL_MAXBRDS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004312 return -ENODEV;
4313 brdp = stli_brds[stli_dummybrd.brdnr];
4314 if (!brdp)
4315 return -ENODEV;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004316 if (copy_to_user(arg, brdp, sizeof(struct stlibrd)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004317 return -EFAULT;
4318 return 0;
4319}
4320
4321/*****************************************************************************/
4322
4323/*
4324 * The "staliomem" device is also required to do some special operations on
4325 * the board. We need to be able to send an interrupt to the board,
4326 * reset it, and start/stop it.
4327 */
4328
4329static int stli_memioctl(struct inode *ip, struct file *fp, unsigned int cmd, unsigned long arg)
4330{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004331 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07004332 int brdnr, rc, done;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004333 void __user *argp = (void __user *)arg;
4334
Linus Torvalds1da177e2005-04-16 15:20:36 -07004335/*
4336 * First up handle the board independent ioctls.
4337 */
4338 done = 0;
4339 rc = 0;
4340
Alan Cox37361132008-04-30 00:53:19 -07004341 lock_kernel();
4342
Linus Torvalds1da177e2005-04-16 15:20:36 -07004343 switch (cmd) {
4344 case COM_GETPORTSTATS:
Alan Coxd18a7502008-10-13 10:40:07 +01004345 rc = stli_getportstats(NULL, NULL, argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004346 done++;
4347 break;
4348 case COM_CLRPORTSTATS:
4349 rc = stli_clrportstats(NULL, argp);
4350 done++;
4351 break;
4352 case COM_GETBRDSTATS:
4353 rc = stli_getbrdstats(argp);
4354 done++;
4355 break;
4356 case COM_READPORT:
4357 rc = stli_getportstruct(argp);
4358 done++;
4359 break;
4360 case COM_READBOARD:
4361 rc = stli_getbrdstruct(argp);
4362 done++;
4363 break;
4364 }
Alan Cox37361132008-04-30 00:53:19 -07004365 unlock_kernel();
Linus Torvalds1da177e2005-04-16 15:20:36 -07004366
4367 if (done)
Alan Cox4ac43602006-06-28 04:26:52 -07004368 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004369
4370/*
4371 * Now handle the board specific ioctls. These all depend on the
4372 * minor number of the device they were called from.
4373 */
4374 brdnr = iminor(ip);
4375 if (brdnr >= STL_MAXBRDS)
Alan Cox4ac43602006-06-28 04:26:52 -07004376 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004377 brdp = stli_brds[brdnr];
4378 if (!brdp)
Alan Cox4ac43602006-06-28 04:26:52 -07004379 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004380 if (brdp->state == 0)
Alan Cox4ac43602006-06-28 04:26:52 -07004381 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004382
Alan Cox37361132008-04-30 00:53:19 -07004383 lock_kernel();
4384
Linus Torvalds1da177e2005-04-16 15:20:36 -07004385 switch (cmd) {
4386 case STL_BINTR:
4387 EBRDINTR(brdp);
4388 break;
4389 case STL_BSTART:
4390 rc = stli_startbrd(brdp);
4391 break;
4392 case STL_BSTOP:
4393 brdp->state &= ~BST_STARTED;
4394 break;
4395 case STL_BRESET:
4396 brdp->state &= ~BST_STARTED;
4397 EBRDRESET(brdp);
4398 if (stli_shared == 0) {
4399 if (brdp->reenable != NULL)
4400 (* brdp->reenable)(brdp);
4401 }
4402 break;
4403 default:
4404 rc = -ENOIOCTLCMD;
4405 break;
4406 }
Alan Cox37361132008-04-30 00:53:19 -07004407 unlock_kernel();
Alan Cox4ac43602006-06-28 04:26:52 -07004408 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004409}
4410
Jeff Dikeb68e31d2006-10-02 02:17:18 -07004411static const struct tty_operations stli_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004412 .open = stli_open,
4413 .close = stli_close,
4414 .write = stli_write,
4415 .put_char = stli_putchar,
4416 .flush_chars = stli_flushchars,
4417 .write_room = stli_writeroom,
4418 .chars_in_buffer = stli_charsinbuffer,
4419 .ioctl = stli_ioctl,
4420 .set_termios = stli_settermios,
4421 .throttle = stli_throttle,
4422 .unthrottle = stli_unthrottle,
4423 .stop = stli_stop,
4424 .start = stli_start,
4425 .hangup = stli_hangup,
4426 .flush_buffer = stli_flushbuffer,
4427 .break_ctl = stli_breakctl,
4428 .wait_until_sent = stli_waituntilsent,
4429 .send_xchar = stli_sendxchar,
4430 .read_proc = stli_readproc,
4431 .tiocmget = stli_tiocmget,
4432 .tiocmset = stli_tiocmset,
4433};
4434
Alan Cox31f35932009-01-02 13:45:05 +00004435static const struct tty_port_operations stli_port_ops = {
4436 .carrier_raised = stli_carrier_raised,
Alan Cox2a6eadb2009-01-02 13:46:18 +00004437 .raise_dtr_rts = stli_raise_dtr_rts,
Alan Cox31f35932009-01-02 13:45:05 +00004438};
4439
Linus Torvalds1da177e2005-04-16 15:20:36 -07004440/*****************************************************************************/
Jiri Slabyf1cc54f2006-12-08 02:39:24 -08004441/*
4442 * Loadable module initialization stuff.
4443 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07004444
Jiri Slabyf2362c92006-12-08 02:39:25 -08004445static void istallion_cleanup_isa(void)
Jiri Slabyf1cc54f2006-12-08 02:39:24 -08004446{
4447 struct stlibrd *brdp;
4448 unsigned int j;
Jiri Slabyf1cc54f2006-12-08 02:39:24 -08004449
4450 for (j = 0; (j < stli_nrbrds); j++) {
4451 if ((brdp = stli_brds[j]) == NULL || (brdp->state & BST_PROBED))
4452 continue;
4453
4454 stli_cleanup_ports(brdp);
4455
4456 iounmap(brdp->membase);
4457 if (brdp->iosize > 0)
4458 release_region(brdp->iobase, brdp->iosize);
4459 kfree(brdp);
4460 stli_brds[j] = NULL;
4461 }
4462}
4463
Jiri Slabyf2362c92006-12-08 02:39:25 -08004464static int __init istallion_module_init(void)
4465{
4466 unsigned int i;
4467 int retval;
4468
4469 printk(KERN_INFO "%s: version %s\n", stli_drvtitle, stli_drvversion);
4470
4471 spin_lock_init(&stli_lock);
4472 spin_lock_init(&brd_lock);
4473
4474 stli_txcookbuf = kmalloc(STLI_TXBUFSIZE, GFP_KERNEL);
4475 if (!stli_txcookbuf) {
Alan Coxa6614992009-01-02 13:46:50 +00004476 printk(KERN_ERR "istallion: failed to allocate memory "
Jiri Slabyf2362c92006-12-08 02:39:25 -08004477 "(size=%d)\n", STLI_TXBUFSIZE);
4478 retval = -ENOMEM;
4479 goto err;
4480 }
4481
4482 stli_serial = alloc_tty_driver(STL_MAXBRDS * STL_MAXPORTS);
4483 if (!stli_serial) {
4484 retval = -ENOMEM;
4485 goto err_free;
4486 }
4487
4488 stli_serial->owner = THIS_MODULE;
4489 stli_serial->driver_name = stli_drvname;
4490 stli_serial->name = stli_serialname;
4491 stli_serial->major = STL_SERIALMAJOR;
4492 stli_serial->minor_start = 0;
4493 stli_serial->type = TTY_DRIVER_TYPE_SERIAL;
4494 stli_serial->subtype = SERIAL_TYPE_NORMAL;
4495 stli_serial->init_termios = stli_deftermios;
Jiri Slabyec3dde52006-12-08 02:39:26 -08004496 stli_serial->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
Jiri Slabyf2362c92006-12-08 02:39:25 -08004497 tty_set_operations(stli_serial, &stli_ops);
4498
4499 retval = tty_register_driver(stli_serial);
4500 if (retval) {
Alan Coxa6614992009-01-02 13:46:50 +00004501 printk(KERN_ERR "istallion: failed to register serial driver\n");
Jiri Slabyf2362c92006-12-08 02:39:25 -08004502 goto err_ttyput;
4503 }
4504
4505 retval = stli_initbrds();
4506 if (retval)
4507 goto err_ttyunr;
4508
4509/*
4510 * Set up a character driver for the shared memory region. We need this
4511 * to down load the slave code image. Also it is a useful debugging tool.
4512 */
4513 retval = register_chrdev(STL_SIOMEMMAJOR, "staliomem", &stli_fsiomem);
4514 if (retval) {
Alan Coxa6614992009-01-02 13:46:50 +00004515 printk(KERN_ERR "istallion: failed to register serial memory "
Jiri Slabyf2362c92006-12-08 02:39:25 -08004516 "device\n");
4517 goto err_deinit;
4518 }
4519
4520 istallion_class = class_create(THIS_MODULE, "staliomem");
4521 for (i = 0; i < 4; i++)
Greg Kroah-Hartman03457cd2008-07-21 20:03:34 -07004522 device_create(istallion_class, NULL, MKDEV(STL_SIOMEMMAJOR, i),
4523 NULL, "staliomem%d", i);
Jiri Slabyf2362c92006-12-08 02:39:25 -08004524
4525 return 0;
4526err_deinit:
4527 pci_unregister_driver(&stli_pcidriver);
4528 istallion_cleanup_isa();
4529err_ttyunr:
4530 tty_unregister_driver(stli_serial);
4531err_ttyput:
4532 put_tty_driver(stli_serial);
4533err_free:
4534 kfree(stli_txcookbuf);
4535err:
4536 return retval;
4537}
4538
4539/*****************************************************************************/
4540
4541static void __exit istallion_module_exit(void)
4542{
4543 unsigned int j;
4544
4545 printk(KERN_INFO "Unloading %s: version %s\n", stli_drvtitle,
4546 stli_drvversion);
4547
4548 if (stli_timeron) {
4549 stli_timeron = 0;
4550 del_timer_sync(&stli_timerlist);
4551 }
4552
4553 unregister_chrdev(STL_SIOMEMMAJOR, "staliomem");
4554
4555 for (j = 0; j < 4; j++)
tonyj@suse.de07c015e2007-08-07 22:28:44 -07004556 device_destroy(istallion_class, MKDEV(STL_SIOMEMMAJOR, j));
Jiri Slabyf2362c92006-12-08 02:39:25 -08004557 class_destroy(istallion_class);
4558
4559 pci_unregister_driver(&stli_pcidriver);
4560 istallion_cleanup_isa();
4561
4562 tty_unregister_driver(stli_serial);
4563 put_tty_driver(stli_serial);
4564
4565 kfree(stli_txcookbuf);
4566}
4567
Jiri Slabyf1cc54f2006-12-08 02:39:24 -08004568module_init(istallion_module_init);
4569module_exit(istallion_module_exit);