blob: 667abd23ad6ab91b81fa957f3c80260e9c7735a6 [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>
Alexey Dobriyand43c36d2009-10-07 17:09:06 +040022#include <linux/sched.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070023#include <linux/slab.h>
Alexey Dobriyan405f5572009-07-11 22:08:37 +040024#include <linux/smp_lock.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070025#include <linux/interrupt.h>
26#include <linux/tty.h>
27#include <linux/tty_flip.h>
28#include <linux/serial.h>
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -070029#include <linux/seq_file.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070030#include <linux/cdk.h>
31#include <linux/comstats.h>
32#include <linux/istallion.h>
33#include <linux/ioport.h>
34#include <linux/delay.h>
35#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070036#include <linux/device.h>
37#include <linux/wait.h>
Alan Cox4ac43602006-06-28 04:26:52 -070038#include <linux/eisa.h>
Jiri Slabya3f8d9d2006-12-08 02:39:18 -080039#include <linux/ctype.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070040
41#include <asm/io.h>
42#include <asm/uaccess.h>
43
Linus Torvalds1da177e2005-04-16 15:20:36 -070044#include <linux/pci.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070045
46/*****************************************************************************/
47
48/*
49 * Define different board types. Not all of the following board types
50 * are supported by this driver. But I will use the standard "assigned"
51 * board numbers. Currently supported boards are abbreviated as:
52 * ECP = EasyConnection 8/64, ONB = ONboard, BBY = Brumby and
53 * STAL = Stallion.
54 */
55#define BRD_UNKNOWN 0
56#define BRD_STALLION 1
57#define BRD_BRUMBY4 2
58#define BRD_ONBOARD2 3
59#define BRD_ONBOARD 4
Linus Torvalds1da177e2005-04-16 15:20:36 -070060#define BRD_ONBOARDE 7
Linus Torvalds1da177e2005-04-16 15:20:36 -070061#define BRD_ECP 23
62#define BRD_ECPE 24
63#define BRD_ECPMC 25
Linus Torvalds1da177e2005-04-16 15:20:36 -070064#define BRD_ECPPCI 29
65
66#define BRD_BRUMBY BRD_BRUMBY4
67
68/*
69 * Define a configuration structure to hold the board configuration.
70 * Need to set this up in the code (for now) with the boards that are
71 * to be configured into the system. This is what needs to be modified
72 * when adding/removing/modifying boards. Each line entry in the
73 * stli_brdconf[] array is a board. Each line contains io/irq/memory
74 * ranges for that board (as well as what type of board it is).
75 * Some examples:
76 * { BRD_ECP, 0x2a0, 0, 0xcc000, 0, 0 },
77 * This line will configure an EasyConnection 8/64 at io address 2a0,
78 * and shared memory address of cc000. Multiple EasyConnection 8/64
79 * boards can share the same shared memory address space. No interrupt
80 * is required for this board type.
81 * Another example:
82 * { BRD_ECPE, 0x5000, 0, 0x80000000, 0, 0 },
83 * This line will configure an EasyConnection 8/64 EISA in slot 5 and
84 * shared memory address of 0x80000000 (2 GByte). Multiple
85 * EasyConnection 8/64 EISA boards can share the same shared memory
86 * address space. No interrupt is required for this board type.
87 * Another example:
88 * { BRD_ONBOARD, 0x240, 0, 0xd0000, 0, 0 },
89 * This line will configure an ONboard (ISA type) at io address 240,
90 * and shared memory address of d0000. Multiple ONboards can share
91 * the same shared memory address space. No interrupt required.
92 * Another example:
93 * { BRD_BRUMBY4, 0x360, 0, 0xc8000, 0, 0 },
94 * This line will configure a Brumby board (any number of ports!) at
95 * io address 360 and shared memory address of c8000. All Brumby boards
96 * configured into a system must have their own separate io and memory
97 * addresses. No interrupt is required.
98 * Another example:
99 * { BRD_STALLION, 0x330, 0, 0xd0000, 0, 0 },
100 * This line will configure an original Stallion board at io address 330
101 * and shared memory address d0000 (this would only be valid for a "V4.0"
102 * or Rev.O Stallion board). All Stallion boards configured into the
103 * system must have their own separate io and memory addresses. No
104 * interrupt is required.
105 */
106
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800107struct stlconf {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108 int brdtype;
109 int ioaddr1;
110 int ioaddr2;
111 unsigned long memaddr;
112 int irq;
113 int irqtype;
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800114};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700115
Jiri Slaby1328d732006-12-08 02:39:19 -0800116static unsigned int stli_nrbrds;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117
Alan Cox4ac43602006-06-28 04:26:52 -0700118/* stli_lock must NOT be taken holding brd_lock */
119static spinlock_t stli_lock; /* TTY logic lock */
120static spinlock_t brd_lock; /* Board logic lock */
121
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122/*
123 * There is some experimental EISA board detection code in this driver.
124 * By default it is disabled, but for those that want to try it out,
125 * then set the define below to be 1.
126 */
127#define STLI_EISAPROBE 0
128
129/*****************************************************************************/
130
131/*
132 * Define some important driver characteristics. Device major numbers
133 * allocated as per Linux Device Registry.
134 */
135#ifndef STL_SIOMEMMAJOR
136#define STL_SIOMEMMAJOR 28
137#endif
138#ifndef STL_SERIALMAJOR
139#define STL_SERIALMAJOR 24
140#endif
141#ifndef STL_CALLOUTMAJOR
142#define STL_CALLOUTMAJOR 25
143#endif
144
145/*****************************************************************************/
146
147/*
148 * Define our local driver identity first. Set up stuff to deal with
149 * all the local structures required by a serial tty driver.
150 */
151static char *stli_drvtitle = "Stallion Intelligent Multiport Serial Driver";
152static char *stli_drvname = "istallion";
153static char *stli_drvversion = "5.6.0";
154static char *stli_serialname = "ttyE";
155
156static struct tty_driver *stli_serial;
Alan Cox31f35932009-01-02 13:45:05 +0000157static const struct tty_port_operations stli_port_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158
159#define STLI_TXBUFSIZE 4096
160
161/*
162 * Use a fast local buffer for cooked characters. Typically a whole
163 * bunch of cooked characters come in for a port, 1 at a time. So we
164 * save those up into a local buffer, then write out the whole lot
165 * with a large memcpy. Just use 1 buffer for all ports, since its
166 * use it is only need for short periods of time by each port.
167 */
168static char *stli_txcookbuf;
169static int stli_txcooksize;
170static int stli_txcookrealsize;
171static struct tty_struct *stli_txcooktty;
172
173/*
174 * Define a local default termios struct. All ports will be created
175 * with this termios initially. Basically all it defines is a raw port
176 * at 9600 baud, 8 data bits, no parity, 1 stop bit.
177 */
Alan Cox606d0992006-12-08 02:38:45 -0800178static struct ktermios stli_deftermios = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179 .c_cflag = (B9600 | CS8 | CREAD | HUPCL | CLOCAL),
180 .c_cc = INIT_C_CC,
Alan Cox606d0992006-12-08 02:38:45 -0800181 .c_ispeed = 9600,
182 .c_ospeed = 9600,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183};
184
185/*
186 * Define global stats structures. Not used often, and can be
187 * re-used for each stats call.
188 */
189static comstats_t stli_comstats;
190static combrd_t stli_brdstats;
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800191static struct asystats stli_cdkstats;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700192
193/*****************************************************************************/
194
Jiri Slabyb103b5c2006-12-08 02:39:21 -0800195static DEFINE_MUTEX(stli_brdslock);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800196static struct stlibrd *stli_brds[STL_MAXBRDS];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197
198static int stli_shared;
199
200/*
201 * Per board state flags. Used with the state field of the board struct.
202 * Not really much here... All we need to do is keep track of whether
203 * the board has been detected, and whether it is actually running a slave
204 * or not.
205 */
Alan Cox8a1e8032010-06-01 22:52:42 +0200206#define BST_FOUND 0
207#define BST_STARTED 1
208#define BST_PROBED 2
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209
210/*
211 * Define the set of port state flags. These are marked for internal
212 * state purposes only, usually to do with the state of communications
213 * with the slave. Most of them need to be updated atomically, so always
214 * use the bit setting operations (unless protected by cli/sti).
215 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216#define ST_OPENING 2
217#define ST_CLOSING 3
218#define ST_CMDING 4
219#define ST_TXBUSY 5
220#define ST_RXING 6
221#define ST_DOFLUSHRX 7
222#define ST_DOFLUSHTX 8
223#define ST_DOSIGS 9
224#define ST_RXSTOP 10
225#define ST_GETSIGS 11
226
227/*
228 * Define an array of board names as printable strings. Handy for
229 * referencing boards when printing trace and stuff.
230 */
231static char *stli_brdnames[] = {
232 "Unknown",
233 "Stallion",
234 "Brumby",
235 "ONboard-MC",
236 "ONboard",
237 "Brumby",
238 "Brumby",
239 "ONboard-EI",
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800240 NULL,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241 "ONboard",
242 "ONboard-MC",
243 "ONboard-MC",
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800244 NULL,
245 NULL,
246 NULL,
247 NULL,
248 NULL,
249 NULL,
250 NULL,
251 NULL,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252 "EasyIO",
253 "EC8/32-AT",
254 "EC8/32-MC",
255 "EC8/64-AT",
256 "EC8/64-EI",
257 "EC8/64-MC",
258 "EC8/32-PCI",
259 "EC8/64-PCI",
260 "EasyIO-PCI",
261 "EC/RA-PCI",
262};
263
264/*****************************************************************************/
265
Linus Torvalds1da177e2005-04-16 15:20:36 -0700266/*
267 * Define some string labels for arguments passed from the module
268 * load line. These allow for easy board definitions, and easy
269 * modification of the io, memory and irq resoucres.
270 */
271
272static char *board0[8];
273static char *board1[8];
274static char *board2[8];
275static char *board3[8];
276
277static char **stli_brdsp[] = {
278 (char **) &board0,
279 (char **) &board1,
280 (char **) &board2,
281 (char **) &board3
282};
283
284/*
285 * Define a set of common board names, and types. This is used to
286 * parse any module arguments.
287 */
288
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800289static struct stlibrdtype {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290 char *name;
291 int type;
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800292} stli_brdstr[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293 { "stallion", BRD_STALLION },
294 { "1", BRD_STALLION },
295 { "brumby", BRD_BRUMBY },
296 { "brumby4", BRD_BRUMBY },
297 { "brumby/4", BRD_BRUMBY },
298 { "brumby-4", BRD_BRUMBY },
299 { "brumby8", BRD_BRUMBY },
300 { "brumby/8", BRD_BRUMBY },
301 { "brumby-8", BRD_BRUMBY },
302 { "brumby16", BRD_BRUMBY },
303 { "brumby/16", BRD_BRUMBY },
304 { "brumby-16", BRD_BRUMBY },
305 { "2", BRD_BRUMBY },
306 { "onboard2", BRD_ONBOARD2 },
307 { "onboard-2", BRD_ONBOARD2 },
308 { "onboard/2", BRD_ONBOARD2 },
309 { "onboard-mc", BRD_ONBOARD2 },
310 { "onboard/mc", BRD_ONBOARD2 },
311 { "onboard-mca", BRD_ONBOARD2 },
312 { "onboard/mca", BRD_ONBOARD2 },
313 { "3", BRD_ONBOARD2 },
314 { "onboard", BRD_ONBOARD },
315 { "onboardat", BRD_ONBOARD },
316 { "4", BRD_ONBOARD },
317 { "onboarde", BRD_ONBOARDE },
318 { "onboard-e", BRD_ONBOARDE },
319 { "onboard/e", BRD_ONBOARDE },
320 { "onboard-ei", BRD_ONBOARDE },
321 { "onboard/ei", BRD_ONBOARDE },
322 { "7", BRD_ONBOARDE },
323 { "ecp", BRD_ECP },
324 { "ecpat", BRD_ECP },
325 { "ec8/64", BRD_ECP },
326 { "ec8/64-at", BRD_ECP },
327 { "ec8/64-isa", BRD_ECP },
328 { "23", BRD_ECP },
329 { "ecpe", BRD_ECPE },
330 { "ecpei", BRD_ECPE },
331 { "ec8/64-e", BRD_ECPE },
332 { "ec8/64-ei", BRD_ECPE },
333 { "24", BRD_ECPE },
334 { "ecpmc", BRD_ECPMC },
335 { "ec8/64-mc", BRD_ECPMC },
336 { "ec8/64-mca", BRD_ECPMC },
337 { "25", BRD_ECPMC },
338 { "ecppci", BRD_ECPPCI },
339 { "ec/ra", BRD_ECPPCI },
340 { "ec/ra-pc", BRD_ECPPCI },
341 { "ec/ra-pci", BRD_ECPPCI },
342 { "29", BRD_ECPPCI },
343};
344
345/*
346 * Define the module agruments.
347 */
348MODULE_AUTHOR("Greg Ungerer");
349MODULE_DESCRIPTION("Stallion Intelligent Multiport Serial Driver");
350MODULE_LICENSE("GPL");
351
352
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800353module_param_array(board0, charp, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354MODULE_PARM_DESC(board0, "Board 0 config -> name[,ioaddr[,memaddr]");
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800355module_param_array(board1, charp, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356MODULE_PARM_DESC(board1, "Board 1 config -> name[,ioaddr[,memaddr]");
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800357module_param_array(board2, charp, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358MODULE_PARM_DESC(board2, "Board 2 config -> name[,ioaddr[,memaddr]");
Rusty Russell8d3b33f2006-03-25 03:07:05 -0800359module_param_array(board3, charp, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360MODULE_PARM_DESC(board3, "Board 3 config -> name[,ioaddr[,memaddr]");
361
Jiri Slabya00f33f2006-12-08 02:39:20 -0800362#if STLI_EISAPROBE != 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363/*
364 * Set up a default memory address table for EISA board probing.
365 * The default addresses are all bellow 1Mbyte, which has to be the
366 * case anyway. They should be safe, since we only read values from
367 * them, and interrupts are disabled while we do it. If the higher
368 * memory support is compiled in then we also try probing around
369 * the 1Gb, 2Gb and 3Gb areas as well...
370 */
371static unsigned long stli_eisamemprobeaddrs[] = {
372 0xc0000, 0xd0000, 0xe0000, 0xf0000,
373 0x80000000, 0x80010000, 0x80020000, 0x80030000,
374 0x40000000, 0x40010000, 0x40020000, 0x40030000,
375 0xc0000000, 0xc0010000, 0xc0020000, 0xc0030000,
376 0xff000000, 0xff010000, 0xff020000, 0xff030000,
377};
378
Tobias Klauserfe971072006-01-09 20:54:02 -0800379static int stli_eisamempsize = ARRAY_SIZE(stli_eisamemprobeaddrs);
Jiri Slabya00f33f2006-12-08 02:39:20 -0800380#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381
382/*
383 * Define the Stallion PCI vendor and device IDs.
384 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385#ifndef PCI_DEVICE_ID_ECRA
386#define PCI_DEVICE_ID_ECRA 0x0004
387#endif
388
389static struct pci_device_id istallion_pci_tbl[] = {
Alan Cox4ac43602006-06-28 04:26:52 -0700390 { PCI_DEVICE(PCI_VENDOR_ID_STALLION, PCI_DEVICE_ID_ECRA), },
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391 { 0 }
392};
393MODULE_DEVICE_TABLE(pci, istallion_pci_tbl);
394
Jiri Slaby845bead2006-12-08 02:39:17 -0800395static struct pci_driver stli_pcidriver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
397/*****************************************************************************/
398
399/*
400 * Hardware configuration info for ECP boards. These defines apply
401 * to the directly accessible io ports of the ECP. There is a set of
402 * defines for each ECP board type, ISA, EISA, MCA and PCI.
403 */
404#define ECP_IOSIZE 4
405
406#define ECP_MEMSIZE (128 * 1024)
407#define ECP_PCIMEMSIZE (256 * 1024)
408
409#define ECP_ATPAGESIZE (4 * 1024)
410#define ECP_MCPAGESIZE (4 * 1024)
411#define ECP_EIPAGESIZE (64 * 1024)
412#define ECP_PCIPAGESIZE (64 * 1024)
413
414#define STL_EISAID 0x8c4e
415
416/*
417 * Important defines for the ISA class of ECP board.
418 */
419#define ECP_ATIREG 0
420#define ECP_ATCONFR 1
421#define ECP_ATMEMAR 2
422#define ECP_ATMEMPR 3
423#define ECP_ATSTOP 0x1
424#define ECP_ATINTENAB 0x10
425#define ECP_ATENABLE 0x20
426#define ECP_ATDISABLE 0x00
427#define ECP_ATADDRMASK 0x3f000
428#define ECP_ATADDRSHFT 12
429
430/*
431 * Important defines for the EISA class of ECP board.
432 */
433#define ECP_EIIREG 0
434#define ECP_EIMEMARL 1
435#define ECP_EICONFR 2
436#define ECP_EIMEMARH 3
437#define ECP_EIENABLE 0x1
438#define ECP_EIDISABLE 0x0
439#define ECP_EISTOP 0x4
440#define ECP_EIEDGE 0x00
441#define ECP_EILEVEL 0x80
442#define ECP_EIADDRMASKL 0x00ff0000
443#define ECP_EIADDRSHFTL 16
444#define ECP_EIADDRMASKH 0xff000000
445#define ECP_EIADDRSHFTH 24
446#define ECP_EIBRDENAB 0xc84
447
448#define ECP_EISAID 0x4
449
450/*
451 * Important defines for the Micro-channel class of ECP board.
452 * (It has a lot in common with the ISA boards.)
453 */
454#define ECP_MCIREG 0
455#define ECP_MCCONFR 1
456#define ECP_MCSTOP 0x20
457#define ECP_MCENABLE 0x80
458#define ECP_MCDISABLE 0x00
459
460/*
461 * Important defines for the PCI class of ECP board.
462 * (It has a lot in common with the other ECP boards.)
463 */
464#define ECP_PCIIREG 0
465#define ECP_PCICONFR 1
466#define ECP_PCISTOP 0x01
467
468/*
469 * Hardware configuration info for ONboard and Brumby boards. These
470 * defines apply to the directly accessible io ports of these boards.
471 */
472#define ONB_IOSIZE 16
473#define ONB_MEMSIZE (64 * 1024)
474#define ONB_ATPAGESIZE (64 * 1024)
475#define ONB_MCPAGESIZE (64 * 1024)
476#define ONB_EIMEMSIZE (128 * 1024)
477#define ONB_EIPAGESIZE (64 * 1024)
478
479/*
480 * Important defines for the ISA class of ONboard board.
481 */
482#define ONB_ATIREG 0
483#define ONB_ATMEMAR 1
484#define ONB_ATCONFR 2
485#define ONB_ATSTOP 0x4
486#define ONB_ATENABLE 0x01
487#define ONB_ATDISABLE 0x00
488#define ONB_ATADDRMASK 0xff0000
489#define ONB_ATADDRSHFT 16
490
491#define ONB_MEMENABLO 0
492#define ONB_MEMENABHI 0x02
493
494/*
495 * Important defines for the EISA class of ONboard board.
496 */
497#define ONB_EIIREG 0
498#define ONB_EIMEMARL 1
499#define ONB_EICONFR 2
500#define ONB_EIMEMARH 3
501#define ONB_EIENABLE 0x1
502#define ONB_EIDISABLE 0x0
503#define ONB_EISTOP 0x4
504#define ONB_EIEDGE 0x00
505#define ONB_EILEVEL 0x80
506#define ONB_EIADDRMASKL 0x00ff0000
507#define ONB_EIADDRSHFTL 16
508#define ONB_EIADDRMASKH 0xff000000
509#define ONB_EIADDRSHFTH 24
510#define ONB_EIBRDENAB 0xc84
511
512#define ONB_EISAID 0x1
513
514/*
515 * Important defines for the Brumby boards. They are pretty simple,
516 * there is not much that is programmably configurable.
517 */
518#define BBY_IOSIZE 16
519#define BBY_MEMSIZE (64 * 1024)
520#define BBY_PAGESIZE (16 * 1024)
521
522#define BBY_ATIREG 0
523#define BBY_ATCONFR 1
524#define BBY_ATSTOP 0x4
525
526/*
527 * Important defines for the Stallion boards. They are pretty simple,
528 * there is not much that is programmably configurable.
529 */
530#define STAL_IOSIZE 16
531#define STAL_MEMSIZE (64 * 1024)
532#define STAL_PAGESIZE (64 * 1024)
533
534/*
535 * Define the set of status register values for EasyConnection panels.
536 * The signature will return with the status value for each panel. From
537 * this we can determine what is attached to the board - before we have
538 * actually down loaded any code to it.
539 */
540#define ECH_PNLSTATUS 2
541#define ECH_PNL16PORT 0x20
542#define ECH_PNLIDMASK 0x07
543#define ECH_PNLXPID 0x40
544#define ECH_PNLINTRPEND 0x80
545
546/*
547 * Define some macros to do things to the board. Even those these boards
548 * are somewhat related there is often significantly different ways of
549 * doing some operation on it (like enable, paging, reset, etc). So each
550 * board class has a set of functions which do the commonly required
551 * operations. The macros below basically just call these functions,
552 * generally checking for a NULL function - which means that the board
553 * needs nothing done to it to achieve this operation!
554 */
555#define EBRDINIT(brdp) \
556 if (brdp->init != NULL) \
557 (* brdp->init)(brdp)
558
559#define EBRDENABLE(brdp) \
560 if (brdp->enable != NULL) \
561 (* brdp->enable)(brdp);
562
563#define EBRDDISABLE(brdp) \
564 if (brdp->disable != NULL) \
565 (* brdp->disable)(brdp);
566
567#define EBRDINTR(brdp) \
568 if (brdp->intr != NULL) \
569 (* brdp->intr)(brdp);
570
571#define EBRDRESET(brdp) \
572 if (brdp->reset != NULL) \
573 (* brdp->reset)(brdp);
574
575#define EBRDGETMEMPTR(brdp,offset) \
576 (* brdp->getmemptr)(brdp, offset, __LINE__)
577
578/*
579 * Define the maximal baud rate, and the default baud base for ports.
580 */
581#define STL_MAXBAUD 460800
582#define STL_BAUDBASE 115200
583#define STL_CLOSEDELAY (5 * HZ / 10)
584
585/*****************************************************************************/
586
587/*
588 * Define macros to extract a brd or port number from a minor number.
589 */
590#define MINOR2BRD(min) (((min) & 0xc0) >> 6)
591#define MINOR2PORT(min) ((min) & 0x3f)
592
Linus Torvalds1da177e2005-04-16 15:20:36 -0700593/*****************************************************************************/
594
595/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596 * Prototype all functions in this driver!
597 */
598
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800599static int stli_parsebrd(struct stlconf *confp, char **argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700600static int stli_open(struct tty_struct *tty, struct file *filp);
601static void stli_close(struct tty_struct *tty, struct file *filp);
602static int stli_write(struct tty_struct *tty, const unsigned char *buf, int count);
Wang Chen42a77a12008-07-21 17:48:59 +0800603static int stli_putchar(struct tty_struct *tty, unsigned char ch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604static void stli_flushchars(struct tty_struct *tty);
605static int stli_writeroom(struct tty_struct *tty);
606static int stli_charsinbuffer(struct tty_struct *tty);
607static int stli_ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg);
Alan Cox606d0992006-12-08 02:38:45 -0800608static void stli_settermios(struct tty_struct *tty, struct ktermios *old);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609static void stli_throttle(struct tty_struct *tty);
610static void stli_unthrottle(struct tty_struct *tty);
611static void stli_stop(struct tty_struct *tty);
612static void stli_start(struct tty_struct *tty);
613static void stli_flushbuffer(struct tty_struct *tty);
Alan Cox9e989662008-07-22 11:18:03 +0100614static int stli_breakctl(struct tty_struct *tty, int state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615static void stli_waituntilsent(struct tty_struct *tty, int timeout);
616static void stli_sendxchar(struct tty_struct *tty, char ch);
617static void stli_hangup(struct tty_struct *tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800619static int stli_brdinit(struct stlibrd *brdp);
620static int stli_startbrd(struct stlibrd *brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621static ssize_t stli_memread(struct file *fp, char __user *buf, size_t count, loff_t *offp);
622static ssize_t stli_memwrite(struct file *fp, const char __user *buf, size_t count, loff_t *offp);
Alan Cox62687532009-10-13 16:34:06 +0100623static long stli_memioctl(struct file *fp, unsigned int cmd, unsigned long arg);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800624static void stli_brdpoll(struct stlibrd *brdp, cdkhdr_t __iomem *hdrp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625static void stli_poll(unsigned long arg);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800626static int stli_hostcmd(struct stlibrd *brdp, struct stliport *portp);
Alan Coxd18a7502008-10-13 10:40:07 +0100627static int stli_initopen(struct tty_struct *tty, struct stlibrd *brdp, struct stliport *portp);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800628static int stli_rawopen(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait);
629static int stli_rawclose(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait);
Alan Coxd18a7502008-10-13 10:40:07 +0100630static int stli_setport(struct tty_struct *tty);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800631static int stli_cmdwait(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_sendcmd(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback);
634static void stli_dodelaycmd(struct stliport *portp, cdkctrl_t __iomem *cp);
Alan Coxd18a7502008-10-13 10:40:07 +0100635static void stli_mkasyport(struct tty_struct *tty, struct stliport *portp, asyport_t *pp, struct ktermios *tiosp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700636static void stli_mkasysigs(asysigs_t *sp, int dtr, int rts);
637static long stli_mktiocm(unsigned long sigvalue);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800638static void stli_read(struct stlibrd *brdp, struct stliport *portp);
639static int stli_getserial(struct stliport *portp, struct serial_struct __user *sp);
Alan Coxd18a7502008-10-13 10:40:07 +0100640static int stli_setserial(struct tty_struct *tty, struct serial_struct __user *sp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700641static int stli_getbrdstats(combrd_t __user *bp);
Alan Coxd18a7502008-10-13 10:40:07 +0100642static int stli_getportstats(struct tty_struct *tty, struct stliport *portp, comstats_t __user *cp);
643static int stli_portcmdstats(struct tty_struct *tty, struct stliport *portp);
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800644static int stli_clrportstats(struct stliport *portp, comstats_t __user *cp);
645static int stli_getportstruct(struct stliport __user *arg);
646static int stli_getbrdstruct(struct stlibrd __user *arg);
647static struct stlibrd *stli_allocbrd(void);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800649static void stli_ecpinit(struct stlibrd *brdp);
650static void stli_ecpenable(struct stlibrd *brdp);
651static void stli_ecpdisable(struct stlibrd *brdp);
652static void __iomem *stli_ecpgetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
653static void stli_ecpreset(struct stlibrd *brdp);
654static void stli_ecpintr(struct stlibrd *brdp);
655static void stli_ecpeiinit(struct stlibrd *brdp);
656static void stli_ecpeienable(struct stlibrd *brdp);
657static void stli_ecpeidisable(struct stlibrd *brdp);
658static void __iomem *stli_ecpeigetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
659static void stli_ecpeireset(struct stlibrd *brdp);
660static void stli_ecpmcenable(struct stlibrd *brdp);
661static void stli_ecpmcdisable(struct stlibrd *brdp);
662static void __iomem *stli_ecpmcgetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
663static void stli_ecpmcreset(struct stlibrd *brdp);
664static void stli_ecppciinit(struct stlibrd *brdp);
665static void __iomem *stli_ecppcigetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
666static void stli_ecppcireset(struct stlibrd *brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800668static void stli_onbinit(struct stlibrd *brdp);
669static void stli_onbenable(struct stlibrd *brdp);
670static void stli_onbdisable(struct stlibrd *brdp);
671static void __iomem *stli_onbgetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
672static void stli_onbreset(struct stlibrd *brdp);
673static void stli_onbeinit(struct stlibrd *brdp);
674static void stli_onbeenable(struct stlibrd *brdp);
675static void stli_onbedisable(struct stlibrd *brdp);
676static void __iomem *stli_onbegetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
677static void stli_onbereset(struct stlibrd *brdp);
678static void stli_bbyinit(struct stlibrd *brdp);
679static void __iomem *stli_bbygetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
680static void stli_bbyreset(struct stlibrd *brdp);
681static void stli_stalinit(struct stlibrd *brdp);
682static void __iomem *stli_stalgetmemptr(struct stlibrd *brdp, unsigned long offset, int line);
683static void stli_stalreset(struct stlibrd *brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684
Jiri Slaby1328d732006-12-08 02:39:19 -0800685static struct stliport *stli_getport(unsigned int brdnr, unsigned int panelnr, unsigned int portnr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700686
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800687static int stli_initecp(struct stlibrd *brdp);
688static int stli_initonb(struct stlibrd *brdp);
Jiri Slabya00f33f2006-12-08 02:39:20 -0800689#if STLI_EISAPROBE != 0
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800690static int stli_eisamemprobe(struct stlibrd *brdp);
Jiri Slabya00f33f2006-12-08 02:39:20 -0800691#endif
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800692static int stli_initports(struct stlibrd *brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693
Linus Torvalds1da177e2005-04-16 15:20:36 -0700694/*****************************************************************************/
695
696/*
697 * Define the driver info for a user level shared memory device. This
698 * device will work sort of like the /dev/kmem device - except that it
699 * will give access to the shared memory on the Stallion intelligent
700 * board. This is also a very useful debugging tool.
701 */
Arjan van de Ven62322d22006-07-03 00:24:21 -0700702static const struct file_operations stli_fsiomem = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700703 .owner = THIS_MODULE,
704 .read = stli_memread,
705 .write = stli_memwrite,
Alan Cox62687532009-10-13 16:34:06 +0100706 .unlocked_ioctl = stli_memioctl,
Arnd Bergmann6038f372010-08-15 18:52:59 +0200707 .llseek = default_llseek,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700708};
709
710/*****************************************************************************/
711
712/*
713 * Define a timer_list entry for our poll routine. The slave board
714 * is polled every so often to see if anything needs doing. This is
715 * much cheaper on host cpu than using interrupts. It turns out to
716 * not increase character latency by much either...
717 */
Ingo Molnar8d06afa2005-09-09 13:10:40 -0700718static DEFINE_TIMER(stli_timerlist, stli_poll, 0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719
720static int stli_timeron;
721
722/*
723 * Define the calculation for the timeout routine.
724 */
725#define STLI_TIMEOUT (jiffies + 1)
726
727/*****************************************************************************/
728
gregkh@suse.deca8eca62005-03-23 09:53:09 -0800729static struct class *istallion_class;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700730
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800731static void stli_cleanup_ports(struct stlibrd *brdp)
Jiri Slaby845bead2006-12-08 02:39:17 -0800732{
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800733 struct stliport *portp;
Jiri Slaby845bead2006-12-08 02:39:17 -0800734 unsigned int j;
Alan Coxd18a7502008-10-13 10:40:07 +0100735 struct tty_struct *tty;
Jiri Slaby845bead2006-12-08 02:39:17 -0800736
737 for (j = 0; j < STL_MAXPORTS; j++) {
738 portp = brdp->ports[j];
739 if (portp != NULL) {
Alan Coxd18a7502008-10-13 10:40:07 +0100740 tty = tty_port_tty_get(&portp->port);
741 if (tty != NULL) {
742 tty_hangup(tty);
743 tty_kref_put(tty);
744 }
Jiri Slaby845bead2006-12-08 02:39:17 -0800745 kfree(portp);
746 }
747 }
748}
749
Linus Torvalds1da177e2005-04-16 15:20:36 -0700750/*****************************************************************************/
751
752/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700753 * Parse the supplied argument string, into the board conf struct.
754 */
755
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800756static int stli_parsebrd(struct stlconf *confp, char **argp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700757{
Jiri Slaby1328d732006-12-08 02:39:19 -0800758 unsigned int i;
Alan Cox4ac43602006-06-28 04:26:52 -0700759 char *sp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700760
Alan Cox4ac43602006-06-28 04:26:52 -0700761 if (argp[0] == NULL || *argp[0] == 0)
762 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700763
764 for (sp = argp[0], i = 0; ((*sp != 0) && (i < 25)); sp++, i++)
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800765 *sp = tolower(*sp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700766
Tobias Klauserfe971072006-01-09 20:54:02 -0800767 for (i = 0; i < ARRAY_SIZE(stli_brdstr); i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700768 if (strcmp(stli_brdstr[i].name, argp[0]) == 0)
769 break;
770 }
Tobias Klauserfe971072006-01-09 20:54:02 -0800771 if (i == ARRAY_SIZE(stli_brdstr)) {
Alan Coxa6614992009-01-02 13:46:50 +0000772 printk(KERN_WARNING "istallion: unknown board name, %s?\n", argp[0]);
Tobias Klauserfe971072006-01-09 20:54:02 -0800773 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774 }
775
776 confp->brdtype = stli_brdstr[i].type;
Alan Cox4ac43602006-06-28 04:26:52 -0700777 if (argp[1] != NULL && *argp[1] != 0)
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800778 confp->ioaddr1 = simple_strtoul(argp[1], NULL, 0);
Alan Cox4ac43602006-06-28 04:26:52 -0700779 if (argp[2] != NULL && *argp[2] != 0)
Jiri Slabya3f8d9d2006-12-08 02:39:18 -0800780 confp->memaddr = simple_strtoul(argp[2], NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781 return(1);
782}
783
Linus Torvalds1da177e2005-04-16 15:20:36 -0700784/*****************************************************************************/
785
Alan Cox338818f2009-11-30 13:17:08 +0000786/*
787 * On the first open of the device setup the port hardware, and
788 * initialize the per port data structure. Since initializing the port
789 * requires several commands to the board we will need to wait for any
790 * other open that is already initializing the port.
791 *
792 * Locking: protected by the port mutex.
793 */
794
795static int stli_activate(struct tty_port *port, struct tty_struct *tty)
796{
797 struct stliport *portp = container_of(port, struct stliport, port);
798 struct stlibrd *brdp = stli_brds[portp->brdnr];
799 int rc;
800
801 if ((rc = stli_initopen(tty, brdp, portp)) >= 0)
802 clear_bit(TTY_IO_ERROR, &tty->flags);
803 wake_up_interruptible(&portp->raw_wait);
804 return rc;
805}
806
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807static int stli_open(struct tty_struct *tty, struct file *filp)
808{
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800809 struct stlibrd *brdp;
810 struct stliport *portp;
Jiri Slaby1328d732006-12-08 02:39:19 -0800811 unsigned int minordev, brdnr, portnr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700812
813 minordev = tty->index;
814 brdnr = MINOR2BRD(minordev);
815 if (brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -0700816 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700817 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -0700818 if (brdp == NULL)
819 return -ENODEV;
Alan Cox8a1e8032010-06-01 22:52:42 +0200820 if (!test_bit(BST_STARTED, &brdp->state))
Alan Cox4ac43602006-06-28 04:26:52 -0700821 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700822 portnr = MINOR2PORT(minordev);
Jiri Slaby1328d732006-12-08 02:39:19 -0800823 if (portnr > brdp->nrports)
Alan Cox4ac43602006-06-28 04:26:52 -0700824 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825
826 portp = brdp->ports[portnr];
Alan Cox4ac43602006-06-28 04:26:52 -0700827 if (portp == NULL)
828 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700829 if (portp->devnr < 1)
Alan Cox4ac43602006-06-28 04:26:52 -0700830 return -ENODEV;
Alan Coxa2d1e352010-04-23 16:01:18 +0100831
832 tty->driver_data = portp;
Alan Cox338818f2009-11-30 13:17:08 +0000833 return tty_port_open(&portp->port, tty, filp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700834}
835
Alan Cox338818f2009-11-30 13:17:08 +0000836
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837/*****************************************************************************/
838
Alan Cox338818f2009-11-30 13:17:08 +0000839static void stli_shutdown(struct tty_port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700840{
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800841 struct stlibrd *brdp;
Alan Cox338818f2009-11-30 13:17:08 +0000842 unsigned long ftype;
Alan Cox4ac43602006-06-28 04:26:52 -0700843 unsigned long flags;
Alan Cox338818f2009-11-30 13:17:08 +0000844 struct stliport *portp = container_of(port, struct stliport, port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700845
Alan Cox338818f2009-11-30 13:17:08 +0000846 if (portp->brdnr >= stli_nrbrds)
847 return;
848 brdp = stli_brds[portp->brdnr];
849 if (brdp == NULL)
850 return;
851
852 /*
853 * May want to wait for data to drain before closing. The BUSY
854 * flag keeps track of whether we are still transmitting or not.
855 * It is updated by messages from the slave - indicating when all
856 * chars really have drained.
857 */
858
859 if (!test_bit(ST_CLOSING, &portp->state))
860 stli_rawclose(brdp, portp, 0, 0);
861
862 spin_lock_irqsave(&stli_lock, flags);
863 clear_bit(ST_TXBUSY, &portp->state);
864 clear_bit(ST_RXSTOP, &portp->state);
865 spin_unlock_irqrestore(&stli_lock, flags);
866
867 ftype = FLUSHTX | FLUSHRX;
868 stli_cmdwait(brdp, portp, A_FLUSH, &ftype, sizeof(u32), 0);
869}
870
871static void stli_close(struct tty_struct *tty, struct file *filp)
872{
873 struct stliport *portp = tty->driver_data;
874 unsigned long flags;
Alan Cox4ac43602006-06-28 04:26:52 -0700875 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700876 return;
Alan Cox2a6eadb2009-01-02 13:46:18 +0000877 spin_lock_irqsave(&stli_lock, flags);
Alan Cox338818f2009-11-30 13:17:08 +0000878 /* Flush any internal buffering out first */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700879 if (tty == stli_txcooktty)
880 stli_flushchars(tty);
Alan Cox4ac43602006-06-28 04:26:52 -0700881 spin_unlock_irqrestore(&stli_lock, flags);
Alan Cox338818f2009-11-30 13:17:08 +0000882 tty_port_close(&portp->port, tty, filp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700883}
884
885/*****************************************************************************/
886
887/*
888 * Carry out first open operations on a port. This involves a number of
889 * commands to be sent to the slave. We need to open the port, set the
890 * notification events, set the initial port settings, get and set the
891 * initial signal values. We sleep and wait in between each one. But
892 * this still all happens pretty quickly.
893 */
894
Alan Coxd18a7502008-10-13 10:40:07 +0100895static int stli_initopen(struct tty_struct *tty,
896 struct stlibrd *brdp, struct stliport *portp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700897{
Alan Cox4ac43602006-06-28 04:26:52 -0700898 asynotify_t nt;
899 asyport_t aport;
900 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700901
902 if ((rc = stli_rawopen(brdp, portp, 0, 1)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700903 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700904
905 memset(&nt, 0, sizeof(asynotify_t));
906 nt.data = (DT_TXLOW | DT_TXEMPTY | DT_RXBUSY | DT_RXBREAK);
907 nt.signal = SG_DCD;
908 if ((rc = stli_cmdwait(brdp, portp, A_SETNOTIFY, &nt,
909 sizeof(asynotify_t), 0)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700910 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911
Alan Coxd18a7502008-10-13 10:40:07 +0100912 stli_mkasyport(tty, portp, &aport, tty->termios);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700913 if ((rc = stli_cmdwait(brdp, portp, A_SETPORT, &aport,
914 sizeof(asyport_t), 0)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700915 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700916
917 set_bit(ST_GETSIGS, &portp->state);
918 if ((rc = stli_cmdwait(brdp, portp, A_GETSIGNALS, &portp->asig,
919 sizeof(asysigs_t), 1)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700920 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700921 if (test_and_clear_bit(ST_GETSIGS, &portp->state))
922 portp->sigs = stli_mktiocm(portp->asig.sigvalue);
923 stli_mkasysigs(&portp->asig, 1, 1);
924 if ((rc = stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
925 sizeof(asysigs_t), 0)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -0700926 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700927
Alan Cox4ac43602006-06-28 04:26:52 -0700928 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700929}
930
931/*****************************************************************************/
932
933/*
934 * Send an open message to the slave. This will sleep waiting for the
935 * acknowledgement, so must have user context. We need to co-ordinate
936 * with close events here, since we don't want open and close events
937 * to overlap.
938 */
939
Jiri Slaby1f8ec432006-12-08 02:39:18 -0800940static int stli_rawopen(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700941{
Alan Cox4ac43602006-06-28 04:26:52 -0700942 cdkhdr_t __iomem *hdrp;
943 cdkctrl_t __iomem *cp;
944 unsigned char __iomem *bits;
945 unsigned long flags;
946 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700947
948/*
949 * Send a message to the slave to open this port.
950 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700951
952/*
953 * Slave is already closing this port. This can happen if a hangup
954 * occurs on this port. So we must wait until it is complete. The
955 * order of opens and closes may not be preserved across shared
956 * memory, so we must wait until it is complete.
957 */
Arnd Bergmannbe1bc282010-06-01 22:53:05 +0200958 wait_event_interruptible_tty(portp->raw_wait,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700959 !test_bit(ST_CLOSING, &portp->state));
960 if (signal_pending(current)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961 return -ERESTARTSYS;
962 }
963
964/*
965 * Everything is ready now, so write the open message into shared
966 * memory. Once the message is in set the service bits to say that
967 * this port wants service.
968 */
Alan Cox4ac43602006-06-28 04:26:52 -0700969 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700970 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -0700971 cp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl;
972 writel(arg, &cp->openarg);
973 writeb(1, &cp->open);
974 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
975 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -0700976 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -0700977 writeb(readb(bits) | portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700978 EBRDDISABLE(brdp);
979
980 if (wait == 0) {
Alan Cox4ac43602006-06-28 04:26:52 -0700981 spin_unlock_irqrestore(&brd_lock, flags);
982 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983 }
984
985/*
986 * Slave is in action, so now we must wait for the open acknowledgment
987 * to come back.
988 */
989 rc = 0;
990 set_bit(ST_OPENING, &portp->state);
Alan Cox4ac43602006-06-28 04:26:52 -0700991 spin_unlock_irqrestore(&brd_lock, flags);
992
Arnd Bergmannbe1bc282010-06-01 22:53:05 +0200993 wait_event_interruptible_tty(portp->raw_wait,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994 !test_bit(ST_OPENING, &portp->state));
995 if (signal_pending(current))
996 rc = -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700997
998 if ((rc == 0) && (portp->rc != 0))
999 rc = -EIO;
Alan Cox4ac43602006-06-28 04:26:52 -07001000 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001001}
1002
1003/*****************************************************************************/
1004
1005/*
1006 * Send a close message to the slave. Normally this will sleep waiting
1007 * for the acknowledgement, but if wait parameter is 0 it will not. If
1008 * wait is true then must have user context (to sleep).
1009 */
1010
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001011static int stli_rawclose(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012{
Alan Cox4ac43602006-06-28 04:26:52 -07001013 cdkhdr_t __iomem *hdrp;
1014 cdkctrl_t __iomem *cp;
1015 unsigned char __iomem *bits;
1016 unsigned long flags;
1017 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018
1019/*
1020 * Slave is already closing this port. This can happen if a hangup
1021 * occurs on this port.
1022 */
1023 if (wait) {
Arnd Bergmannbe1bc282010-06-01 22:53:05 +02001024 wait_event_interruptible_tty(portp->raw_wait,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001025 !test_bit(ST_CLOSING, &portp->state));
1026 if (signal_pending(current)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001027 return -ERESTARTSYS;
1028 }
1029 }
1030
1031/*
1032 * Write the close command into shared memory.
1033 */
Alan Cox4ac43602006-06-28 04:26:52 -07001034 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001035 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001036 cp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl;
1037 writel(arg, &cp->closearg);
1038 writeb(1, &cp->close);
1039 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1040 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -07001041 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -07001042 writeb(readb(bits) |portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043 EBRDDISABLE(brdp);
1044
1045 set_bit(ST_CLOSING, &portp->state);
Alan Cox4ac43602006-06-28 04:26:52 -07001046 spin_unlock_irqrestore(&brd_lock, flags);
1047
1048 if (wait == 0)
1049 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001050
1051/*
1052 * Slave is in action, so now we must wait for the open acknowledgment
1053 * to come back.
1054 */
1055 rc = 0;
Arnd Bergmannbe1bc282010-06-01 22:53:05 +02001056 wait_event_interruptible_tty(portp->raw_wait,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001057 !test_bit(ST_CLOSING, &portp->state));
1058 if (signal_pending(current))
1059 rc = -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001060
1061 if ((rc == 0) && (portp->rc != 0))
1062 rc = -EIO;
Alan Cox4ac43602006-06-28 04:26:52 -07001063 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064}
1065
1066/*****************************************************************************/
1067
1068/*
1069 * Send a command to the slave and wait for the response. This must
1070 * have user context (it sleeps). This routine is generic in that it
1071 * can send any type of command. Its purpose is to wait for that command
1072 * to complete (as opposed to initiating the command then returning).
1073 */
1074
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001075static 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 -07001076{
Arnd Bergmannbe1bc282010-06-01 22:53:05 +02001077 /*
1078 * no need for wait_event_tty because clearing ST_CMDING cannot block
1079 * on BTM
1080 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001081 wait_event_interruptible(portp->raw_wait,
1082 !test_bit(ST_CMDING, &portp->state));
Alan Cox4ac43602006-06-28 04:26:52 -07001083 if (signal_pending(current))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001084 return -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001085
1086 stli_sendcmd(brdp, portp, cmd, arg, size, copyback);
1087
1088 wait_event_interruptible(portp->raw_wait,
1089 !test_bit(ST_CMDING, &portp->state));
Alan Cox4ac43602006-06-28 04:26:52 -07001090 if (signal_pending(current))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001091 return -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001092
1093 if (portp->rc != 0)
Alan Cox4ac43602006-06-28 04:26:52 -07001094 return -EIO;
1095 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001096}
1097
1098/*****************************************************************************/
1099
1100/*
1101 * Send the termios settings for this port to the slave. This sleeps
1102 * waiting for the command to complete - so must have user context.
1103 */
1104
Alan Coxd18a7502008-10-13 10:40:07 +01001105static int stli_setport(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001106{
Alan Coxd18a7502008-10-13 10:40:07 +01001107 struct stliport *portp = tty->driver_data;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001108 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001109 asyport_t aport;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001110
Alan Cox4ac43602006-06-28 04:26:52 -07001111 if (portp == NULL)
1112 return -ENODEV;
Jiri Slaby1328d732006-12-08 02:39:19 -08001113 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001114 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001115 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001116 if (brdp == NULL)
1117 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001118
Alan Coxd18a7502008-10-13 10:40:07 +01001119 stli_mkasyport(tty, portp, &aport, tty->termios);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001120 return(stli_cmdwait(brdp, portp, A_SETPORT, &aport, sizeof(asyport_t), 0));
1121}
1122
1123/*****************************************************************************/
1124
Alan Cox31f35932009-01-02 13:45:05 +00001125static int stli_carrier_raised(struct tty_port *port)
1126{
1127 struct stliport *portp = container_of(port, struct stliport, port);
1128 return (portp->sigs & TIOCM_CD) ? 1 : 0;
1129}
1130
Alan Coxfcc8ac12009-06-11 12:24:17 +01001131static void stli_dtr_rts(struct tty_port *port, int on)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001132{
Alan Cox2a6eadb2009-01-02 13:46:18 +00001133 struct stliport *portp = container_of(port, struct stliport, port);
1134 struct stlibrd *brdp = stli_brds[portp->brdnr];
Alan Coxfcc8ac12009-06-11 12:24:17 +01001135 stli_mkasysigs(&portp->asig, on, on);
Alan Cox2a6eadb2009-01-02 13:46:18 +00001136 if (stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
1137 sizeof(asysigs_t), 0) < 0)
Alan Coxfcc8ac12009-06-11 12:24:17 +01001138 printk(KERN_WARNING "istallion: dtr set failed.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001139}
1140
Alan Cox2a6eadb2009-01-02 13:46:18 +00001141
Linus Torvalds1da177e2005-04-16 15:20:36 -07001142/*****************************************************************************/
1143
1144/*
1145 * Write routine. Take the data and put it in the shared memory ring
1146 * queue. If port is not already sending chars then need to mark the
1147 * service bits for this port.
1148 */
1149
1150static int stli_write(struct tty_struct *tty, const unsigned char *buf, int count)
1151{
Alan Cox4ac43602006-06-28 04:26:52 -07001152 cdkasy_t __iomem *ap;
1153 cdkhdr_t __iomem *hdrp;
1154 unsigned char __iomem *bits;
1155 unsigned char __iomem *shbuf;
1156 unsigned char *chbuf;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001157 struct stliport *portp;
1158 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001159 unsigned int len, stlen, head, tail, size;
1160 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001161
Linus Torvalds1da177e2005-04-16 15:20:36 -07001162 if (tty == stli_txcooktty)
1163 stli_flushchars(tty);
1164 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001165 if (portp == NULL)
1166 return 0;
Jiri Slaby1328d732006-12-08 02:39:19 -08001167 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001168 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001169 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001170 if (brdp == NULL)
1171 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001172 chbuf = (unsigned char *) buf;
1173
1174/*
1175 * All data is now local, shove as much as possible into shared memory.
1176 */
Alan Cox4ac43602006-06-28 04:26:52 -07001177 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001178 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001179 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
1180 head = (unsigned int) readw(&ap->txq.head);
1181 tail = (unsigned int) readw(&ap->txq.tail);
1182 if (tail != ((unsigned int) readw(&ap->txq.tail)))
1183 tail = (unsigned int) readw(&ap->txq.tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001184 size = portp->txsize;
1185 if (head >= tail) {
1186 len = size - (head - tail) - 1;
1187 stlen = size - head;
1188 } else {
1189 len = tail - head - 1;
1190 stlen = len;
1191 }
1192
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08001193 len = min(len, (unsigned int)count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001194 count = 0;
Alan Cox4ac43602006-06-28 04:26:52 -07001195 shbuf = (char __iomem *) EBRDGETMEMPTR(brdp, portp->txoffset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001196
1197 while (len > 0) {
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08001198 stlen = min(len, stlen);
Alan Cox4ac43602006-06-28 04:26:52 -07001199 memcpy_toio(shbuf + head, chbuf, stlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200 chbuf += stlen;
1201 len -= stlen;
1202 count += stlen;
1203 head += stlen;
1204 if (head >= size) {
1205 head = 0;
1206 stlen = tail;
1207 }
1208 }
1209
Alan Cox4ac43602006-06-28 04:26:52 -07001210 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
1211 writew(head, &ap->txq.head);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001212 if (test_bit(ST_TXBUSY, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07001213 if (readl(&ap->changed.data) & DT_TXEMPTY)
1214 writel(readl(&ap->changed.data) & ~DT_TXEMPTY, &ap->changed.data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001215 }
Alan Cox4ac43602006-06-28 04:26:52 -07001216 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1217 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -07001218 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -07001219 writeb(readb(bits) | portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001220 set_bit(ST_TXBUSY, &portp->state);
1221 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001222 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001223
1224 return(count);
1225}
1226
1227/*****************************************************************************/
1228
1229/*
1230 * Output a single character. We put it into a temporary local buffer
1231 * (for speed) then write out that buffer when the flushchars routine
1232 * is called. There is a safety catch here so that if some other port
1233 * writes chars before the current buffer has been, then we write them
1234 * first them do the new ports.
1235 */
1236
Wang Chen42a77a12008-07-21 17:48:59 +08001237static int stli_putchar(struct tty_struct *tty, unsigned char ch)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001238{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001239 if (tty != stli_txcooktty) {
Alan Cox4ac43602006-06-28 04:26:52 -07001240 if (stli_txcooktty != NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241 stli_flushchars(stli_txcooktty);
1242 stli_txcooktty = tty;
1243 }
1244
1245 stli_txcookbuf[stli_txcooksize++] = ch;
Wang Chen42a77a12008-07-21 17:48:59 +08001246 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001247}
1248
1249/*****************************************************************************/
1250
1251/*
1252 * Transfer characters from the local TX cooking buffer to the board.
1253 * We sort of ignore the tty that gets passed in here. We rely on the
1254 * info stored with the TX cook buffer to tell us which port to flush
1255 * the data on. In any case we clean out the TX cook buffer, for re-use
1256 * by someone else.
1257 */
1258
1259static void stli_flushchars(struct tty_struct *tty)
1260{
Alan Cox4ac43602006-06-28 04:26:52 -07001261 cdkhdr_t __iomem *hdrp;
1262 unsigned char __iomem *bits;
1263 cdkasy_t __iomem *ap;
1264 struct tty_struct *cooktty;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001265 struct stliport *portp;
1266 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001267 unsigned int len, stlen, head, tail, size, count, cooksize;
1268 unsigned char *buf;
1269 unsigned char __iomem *shbuf;
1270 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001271
1272 cooksize = stli_txcooksize;
1273 cooktty = stli_txcooktty;
1274 stli_txcooksize = 0;
1275 stli_txcookrealsize = 0;
Alan Cox4ac43602006-06-28 04:26:52 -07001276 stli_txcooktty = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001277
Alan Cox4ac43602006-06-28 04:26:52 -07001278 if (cooktty == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001279 return;
1280 if (tty != cooktty)
1281 tty = cooktty;
1282 if (cooksize == 0)
1283 return;
1284
1285 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001286 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001287 return;
Jiri Slaby1328d732006-12-08 02:39:19 -08001288 if (portp->brdnr >= stli_nrbrds)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001289 return;
1290 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001291 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001292 return;
1293
Alan Cox4ac43602006-06-28 04:26:52 -07001294 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001295 EBRDENABLE(brdp);
1296
Alan Cox4ac43602006-06-28 04:26:52 -07001297 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
1298 head = (unsigned int) readw(&ap->txq.head);
1299 tail = (unsigned int) readw(&ap->txq.tail);
1300 if (tail != ((unsigned int) readw(&ap->txq.tail)))
1301 tail = (unsigned int) readw(&ap->txq.tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001302 size = portp->txsize;
1303 if (head >= tail) {
1304 len = size - (head - tail) - 1;
1305 stlen = size - head;
1306 } else {
1307 len = tail - head - 1;
1308 stlen = len;
1309 }
1310
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08001311 len = min(len, cooksize);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001312 count = 0;
Al Viro29756fa2006-10-10 22:47:27 +01001313 shbuf = EBRDGETMEMPTR(brdp, portp->txoffset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001314 buf = stli_txcookbuf;
1315
1316 while (len > 0) {
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08001317 stlen = min(len, stlen);
Alan Cox4ac43602006-06-28 04:26:52 -07001318 memcpy_toio(shbuf + head, buf, stlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001319 buf += stlen;
1320 len -= stlen;
1321 count += stlen;
1322 head += stlen;
1323 if (head >= size) {
1324 head = 0;
1325 stlen = tail;
1326 }
1327 }
1328
Alan Cox4ac43602006-06-28 04:26:52 -07001329 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
1330 writew(head, &ap->txq.head);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001331
1332 if (test_bit(ST_TXBUSY, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07001333 if (readl(&ap->changed.data) & DT_TXEMPTY)
1334 writel(readl(&ap->changed.data) & ~DT_TXEMPTY, &ap->changed.data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001335 }
Alan Cox4ac43602006-06-28 04:26:52 -07001336 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1337 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -07001339 writeb(readb(bits) | portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001340 set_bit(ST_TXBUSY, &portp->state);
1341
1342 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001343 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001344}
1345
1346/*****************************************************************************/
1347
1348static int stli_writeroom(struct tty_struct *tty)
1349{
Alan Cox4ac43602006-06-28 04:26:52 -07001350 cdkasyrq_t __iomem *rp;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001351 struct stliport *portp;
1352 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001353 unsigned int head, tail, len;
1354 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001355
Linus Torvalds1da177e2005-04-16 15:20:36 -07001356 if (tty == stli_txcooktty) {
1357 if (stli_txcookrealsize != 0) {
1358 len = stli_txcookrealsize - stli_txcooksize;
Alan Cox4ac43602006-06-28 04:26:52 -07001359 return len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360 }
1361 }
1362
1363 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001364 if (portp == NULL)
1365 return 0;
Jiri Slaby1328d732006-12-08 02:39:19 -08001366 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001367 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001368 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001369 if (brdp == NULL)
1370 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001371
Alan Cox4ac43602006-06-28 04:26:52 -07001372 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001373 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001374 rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->txq;
1375 head = (unsigned int) readw(&rp->head);
1376 tail = (unsigned int) readw(&rp->tail);
1377 if (tail != ((unsigned int) readw(&rp->tail)))
1378 tail = (unsigned int) readw(&rp->tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001379 len = (head >= tail) ? (portp->txsize - (head - tail)) : (tail - head);
1380 len--;
1381 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001382 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001383
1384 if (tty == stli_txcooktty) {
1385 stli_txcookrealsize = len;
1386 len -= stli_txcooksize;
1387 }
Alan Cox4ac43602006-06-28 04:26:52 -07001388 return len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001389}
1390
1391/*****************************************************************************/
1392
1393/*
1394 * Return the number of characters in the transmit buffer. Normally we
1395 * will return the number of chars in the shared memory ring queue.
1396 * We need to kludge around the case where the shared memory buffer is
1397 * empty but not all characters have drained yet, for this case just
1398 * return that there is 1 character in the buffer!
1399 */
1400
1401static int stli_charsinbuffer(struct tty_struct *tty)
1402{
Alan Cox4ac43602006-06-28 04:26:52 -07001403 cdkasyrq_t __iomem *rp;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001404 struct stliport *portp;
1405 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001406 unsigned int head, tail, len;
1407 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001408
Linus Torvalds1da177e2005-04-16 15:20:36 -07001409 if (tty == stli_txcooktty)
1410 stli_flushchars(tty);
1411 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001412 if (portp == NULL)
1413 return 0;
Jiri Slaby1328d732006-12-08 02:39:19 -08001414 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001415 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001416 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001417 if (brdp == NULL)
1418 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001419
Alan Cox4ac43602006-06-28 04:26:52 -07001420 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001421 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001422 rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->txq;
1423 head = (unsigned int) readw(&rp->head);
1424 tail = (unsigned int) readw(&rp->tail);
1425 if (tail != ((unsigned int) readw(&rp->tail)))
1426 tail = (unsigned int) readw(&rp->tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001427 len = (head >= tail) ? (head - tail) : (portp->txsize - (tail - head));
1428 if ((len == 0) && test_bit(ST_TXBUSY, &portp->state))
1429 len = 1;
1430 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001431 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001432
Alan Cox4ac43602006-06-28 04:26:52 -07001433 return len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001434}
1435
1436/*****************************************************************************/
1437
1438/*
1439 * Generate the serial struct info.
1440 */
1441
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001442static int stli_getserial(struct stliport *portp, struct serial_struct __user *sp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001443{
Alan Cox4ac43602006-06-28 04:26:52 -07001444 struct serial_struct sio;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001445 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001446
1447 memset(&sio, 0, sizeof(struct serial_struct));
1448 sio.type = PORT_UNKNOWN;
1449 sio.line = portp->portnr;
1450 sio.irq = 0;
Alan Coxb02f5ad62008-07-16 21:55:53 +01001451 sio.flags = portp->port.flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001452 sio.baud_base = portp->baud_base;
Alan Coxa6614992009-01-02 13:46:50 +00001453 sio.close_delay = portp->port.close_delay;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001454 sio.closing_wait = portp->closing_wait;
1455 sio.custom_divisor = portp->custom_divisor;
1456 sio.xmit_fifo_size = 0;
1457 sio.hub6 = 0;
1458
1459 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001460 if (brdp != NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461 sio.port = brdp->iobase;
1462
1463 return copy_to_user(sp, &sio, sizeof(struct serial_struct)) ?
1464 -EFAULT : 0;
1465}
1466
1467/*****************************************************************************/
1468
1469/*
1470 * Set port according to the serial struct info.
1471 * At this point we do not do any auto-configure stuff, so we will
1472 * just quietly ignore any requests to change irq, etc.
1473 */
1474
Alan Coxd18a7502008-10-13 10:40:07 +01001475static int stli_setserial(struct tty_struct *tty, struct serial_struct __user *sp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001476{
Alan Cox4ac43602006-06-28 04:26:52 -07001477 struct serial_struct sio;
1478 int rc;
Alan Coxd18a7502008-10-13 10:40:07 +01001479 struct stliport *portp = tty->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001480
1481 if (copy_from_user(&sio, sp, sizeof(struct serial_struct)))
1482 return -EFAULT;
1483 if (!capable(CAP_SYS_ADMIN)) {
1484 if ((sio.baud_base != portp->baud_base) ||
Alan Coxa6614992009-01-02 13:46:50 +00001485 (sio.close_delay != portp->port.close_delay) ||
Linus Torvalds1da177e2005-04-16 15:20:36 -07001486 ((sio.flags & ~ASYNC_USR_MASK) !=
Alan Coxb02f5ad62008-07-16 21:55:53 +01001487 (portp->port.flags & ~ASYNC_USR_MASK)))
Alan Cox4ac43602006-06-28 04:26:52 -07001488 return -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001489 }
1490
Alan Coxb02f5ad62008-07-16 21:55:53 +01001491 portp->port.flags = (portp->port.flags & ~ASYNC_USR_MASK) |
Linus Torvalds1da177e2005-04-16 15:20:36 -07001492 (sio.flags & ASYNC_USR_MASK);
1493 portp->baud_base = sio.baud_base;
Alan Coxa6614992009-01-02 13:46:50 +00001494 portp->port.close_delay = sio.close_delay;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001495 portp->closing_wait = sio.closing_wait;
1496 portp->custom_divisor = sio.custom_divisor;
1497
Alan Coxd18a7502008-10-13 10:40:07 +01001498 if ((rc = stli_setport(tty)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -07001499 return rc;
1500 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001501}
1502
1503/*****************************************************************************/
1504
1505static int stli_tiocmget(struct tty_struct *tty, struct file *file)
1506{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001507 struct stliport *portp = tty->driver_data;
1508 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001509 int rc;
1510
Alan Cox4ac43602006-06-28 04:26:52 -07001511 if (portp == NULL)
1512 return -ENODEV;
Jiri Slaby1328d732006-12-08 02:39:19 -08001513 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001514 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001515 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001516 if (brdp == NULL)
1517 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001518 if (tty->flags & (1 << TTY_IO_ERROR))
Alan Cox4ac43602006-06-28 04:26:52 -07001519 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001520
1521 if ((rc = stli_cmdwait(brdp, portp, A_GETSIGNALS,
1522 &portp->asig, sizeof(asysigs_t), 1)) < 0)
Alan Cox4ac43602006-06-28 04:26:52 -07001523 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001524
1525 return stli_mktiocm(portp->asig.sigvalue);
1526}
1527
1528static int stli_tiocmset(struct tty_struct *tty, struct file *file,
1529 unsigned int set, unsigned int clear)
1530{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001531 struct stliport *portp = tty->driver_data;
1532 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001533 int rts = -1, dtr = -1;
1534
Alan Cox4ac43602006-06-28 04:26:52 -07001535 if (portp == NULL)
1536 return -ENODEV;
Jiri Slaby1328d732006-12-08 02:39:19 -08001537 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001538 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001539 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001540 if (brdp == NULL)
1541 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001542 if (tty->flags & (1 << TTY_IO_ERROR))
Alan Cox4ac43602006-06-28 04:26:52 -07001543 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001544
1545 if (set & TIOCM_RTS)
1546 rts = 1;
1547 if (set & TIOCM_DTR)
1548 dtr = 1;
1549 if (clear & TIOCM_RTS)
1550 rts = 0;
1551 if (clear & TIOCM_DTR)
1552 dtr = 0;
1553
1554 stli_mkasysigs(&portp->asig, dtr, rts);
1555
1556 return stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
1557 sizeof(asysigs_t), 0);
1558}
1559
1560static int stli_ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg)
1561{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001562 struct stliport *portp;
1563 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001564 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001565 void __user *argp = (void __user *)arg;
1566
Linus Torvalds1da177e2005-04-16 15:20:36 -07001567 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001568 if (portp == NULL)
1569 return -ENODEV;
Jiri Slaby1328d732006-12-08 02:39:19 -08001570 if (portp->brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07001571 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001572 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001573 if (brdp == NULL)
1574 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001575
1576 if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
1577 (cmd != COM_GETPORTSTATS) && (cmd != COM_CLRPORTSTATS)) {
1578 if (tty->flags & (1 << TTY_IO_ERROR))
Alan Cox4ac43602006-06-28 04:26:52 -07001579 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001580 }
1581
1582 rc = 0;
1583
1584 switch (cmd) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001585 case TIOCGSERIAL:
1586 rc = stli_getserial(portp, argp);
1587 break;
1588 case TIOCSSERIAL:
Alan Coxd18a7502008-10-13 10:40:07 +01001589 rc = stli_setserial(tty, argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590 break;
1591 case STL_GETPFLAG:
1592 rc = put_user(portp->pflag, (unsigned __user *)argp);
1593 break;
1594 case STL_SETPFLAG:
1595 if ((rc = get_user(portp->pflag, (unsigned __user *)argp)) == 0)
Alan Coxd18a7502008-10-13 10:40:07 +01001596 stli_setport(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001597 break;
1598 case COM_GETPORTSTATS:
Alan Coxd18a7502008-10-13 10:40:07 +01001599 rc = stli_getportstats(tty, portp, argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001600 break;
1601 case COM_CLRPORTSTATS:
1602 rc = stli_clrportstats(portp, argp);
1603 break;
1604 case TIOCSERCONFIG:
1605 case TIOCSERGWILD:
1606 case TIOCSERSWILD:
1607 case TIOCSERGETLSR:
1608 case TIOCSERGSTRUCT:
1609 case TIOCSERGETMULTI:
1610 case TIOCSERSETMULTI:
1611 default:
1612 rc = -ENOIOCTLCMD;
1613 break;
1614 }
1615
Alan Cox4ac43602006-06-28 04:26:52 -07001616 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001617}
1618
1619/*****************************************************************************/
1620
1621/*
1622 * This routine assumes that we have user context and can sleep.
1623 * Looks like it is true for the current ttys implementation..!!
1624 */
1625
Alan Cox606d0992006-12-08 02:38:45 -08001626static void stli_settermios(struct tty_struct *tty, struct ktermios *old)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001627{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001628 struct stliport *portp;
1629 struct stlibrd *brdp;
Alan Cox606d0992006-12-08 02:38:45 -08001630 struct ktermios *tiosp;
Alan Cox4ac43602006-06-28 04:26:52 -07001631 asyport_t aport;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001632
Linus Torvalds1da177e2005-04-16 15:20:36 -07001633 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001634 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001635 return;
Jiri Slaby1328d732006-12-08 02:39:19 -08001636 if (portp->brdnr >= stli_nrbrds)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001637 return;
1638 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001639 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001640 return;
1641
1642 tiosp = tty->termios;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001643
Alan Coxd18a7502008-10-13 10:40:07 +01001644 stli_mkasyport(tty, portp, &aport, tiosp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001645 stli_cmdwait(brdp, portp, A_SETPORT, &aport, sizeof(asyport_t), 0);
1646 stli_mkasysigs(&portp->asig, ((tiosp->c_cflag & CBAUD) ? 1 : 0), -1);
1647 stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig,
1648 sizeof(asysigs_t), 0);
1649 if ((old->c_cflag & CRTSCTS) && ((tiosp->c_cflag & CRTSCTS) == 0))
1650 tty->hw_stopped = 0;
1651 if (((old->c_cflag & CLOCAL) == 0) && (tiosp->c_cflag & CLOCAL))
Alan Coxb02f5ad62008-07-16 21:55:53 +01001652 wake_up_interruptible(&portp->port.open_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001653}
1654
1655/*****************************************************************************/
1656
1657/*
1658 * Attempt to flow control who ever is sending us data. We won't really
1659 * do any flow control action here. We can't directly, and even if we
1660 * wanted to we would have to send a command to the slave. The slave
1661 * knows how to flow control, and will do so when its buffers reach its
1662 * internal high water marks. So what we will do is set a local state
1663 * bit that will stop us sending any RX data up from the poll routine
1664 * (which is the place where RX data from the slave is handled).
1665 */
1666
1667static void stli_throttle(struct tty_struct *tty)
1668{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001669 struct stliport *portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001670 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001671 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001672 set_bit(ST_RXSTOP, &portp->state);
1673}
1674
1675/*****************************************************************************/
1676
1677/*
1678 * Unflow control the device sending us data... That means that all
1679 * we have to do is clear the RXSTOP state bit. The next poll call
1680 * will then be able to pass the RX data back up.
1681 */
1682
1683static void stli_unthrottle(struct tty_struct *tty)
1684{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001685 struct stliport *portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001686 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001687 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001688 clear_bit(ST_RXSTOP, &portp->state);
1689}
1690
1691/*****************************************************************************/
1692
1693/*
Alan Cox4ac43602006-06-28 04:26:52 -07001694 * Stop the transmitter.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001695 */
1696
1697static void stli_stop(struct tty_struct *tty)
1698{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001699}
1700
1701/*****************************************************************************/
1702
1703/*
Alan Cox4ac43602006-06-28 04:26:52 -07001704 * Start the transmitter again.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001705 */
1706
1707static void stli_start(struct tty_struct *tty)
1708{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001709}
1710
1711/*****************************************************************************/
1712
Alan Cox338818f2009-11-30 13:17:08 +00001713
Linus Torvalds1da177e2005-04-16 15:20:36 -07001714/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001715 * Hangup this port. This is pretty much like closing the port, only
1716 * a little more brutal. No waiting for data to drain. Shutdown the
1717 * port and maybe drop signals. This is rather tricky really. We want
1718 * to close the port as well.
1719 */
1720
1721static void stli_hangup(struct tty_struct *tty)
1722{
Alan Cox338818f2009-11-30 13:17:08 +00001723 struct stliport *portp = tty->driver_data;
1724 tty_port_hangup(&portp->port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001725}
1726
1727/*****************************************************************************/
1728
1729/*
1730 * Flush characters from the lower buffer. We may not have user context
1731 * so we cannot sleep waiting for it to complete. Also we need to check
1732 * if there is chars for this port in the TX cook buffer, and flush them
1733 * as well.
1734 */
1735
1736static void stli_flushbuffer(struct tty_struct *tty)
1737{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001738 struct stliport *portp;
1739 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07001740 unsigned long ftype, flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001741
Linus Torvalds1da177e2005-04-16 15:20:36 -07001742 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001743 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001744 return;
Jiri Slaby1328d732006-12-08 02:39:19 -08001745 if (portp->brdnr >= stli_nrbrds)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001746 return;
1747 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001748 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001749 return;
1750
Alan Cox4ac43602006-06-28 04:26:52 -07001751 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001752 if (tty == stli_txcooktty) {
Alan Cox4ac43602006-06-28 04:26:52 -07001753 stli_txcooktty = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001754 stli_txcooksize = 0;
1755 stli_txcookrealsize = 0;
1756 }
1757 if (test_bit(ST_CMDING, &portp->state)) {
1758 set_bit(ST_DOFLUSHTX, &portp->state);
1759 } else {
1760 ftype = FLUSHTX;
1761 if (test_bit(ST_DOFLUSHRX, &portp->state)) {
1762 ftype |= FLUSHRX;
1763 clear_bit(ST_DOFLUSHRX, &portp->state);
1764 }
Alan Cox4ac43602006-06-28 04:26:52 -07001765 __stli_sendcmd(brdp, portp, A_FLUSH, &ftype, sizeof(u32), 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001766 }
Alan Cox4ac43602006-06-28 04:26:52 -07001767 spin_unlock_irqrestore(&brd_lock, flags);
1768 tty_wakeup(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001769}
1770
1771/*****************************************************************************/
1772
Alan Cox9e989662008-07-22 11:18:03 +01001773static int stli_breakctl(struct tty_struct *tty, int state)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001774{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001775 struct stlibrd *brdp;
1776 struct stliport *portp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001777 long arg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001778
Linus Torvalds1da177e2005-04-16 15:20:36 -07001779 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001780 if (portp == NULL)
Alan Cox9e989662008-07-22 11:18:03 +01001781 return -EINVAL;
Jiri Slaby1328d732006-12-08 02:39:19 -08001782 if (portp->brdnr >= stli_nrbrds)
Alan Cox9e989662008-07-22 11:18:03 +01001783 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001784 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001785 if (brdp == NULL)
Alan Cox9e989662008-07-22 11:18:03 +01001786 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001787
Linus Torvalds1da177e2005-04-16 15:20:36 -07001788 arg = (state == -1) ? BREAKON : BREAKOFF;
1789 stli_cmdwait(brdp, portp, A_BREAK, &arg, sizeof(long), 0);
Alan Cox9e989662008-07-22 11:18:03 +01001790 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001791}
1792
1793/*****************************************************************************/
1794
1795static void stli_waituntilsent(struct tty_struct *tty, int timeout)
1796{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001797 struct stliport *portp;
Alan Cox4ac43602006-06-28 04:26:52 -07001798 unsigned long tend;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001799
Linus Torvalds1da177e2005-04-16 15:20:36 -07001800 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001801 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001802 return;
1803
1804 if (timeout == 0)
1805 timeout = HZ;
1806 tend = jiffies + timeout;
1807
1808 while (test_bit(ST_TXBUSY, &portp->state)) {
1809 if (signal_pending(current))
1810 break;
1811 msleep_interruptible(20);
1812 if (time_after_eq(jiffies, tend))
1813 break;
1814 }
1815}
1816
1817/*****************************************************************************/
1818
1819static void stli_sendxchar(struct tty_struct *tty, char ch)
1820{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001821 struct stlibrd *brdp;
1822 struct stliport *portp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001823 asyctrl_t actrl;
1824
Linus Torvalds1da177e2005-04-16 15:20:36 -07001825 portp = tty->driver_data;
Alan Cox4ac43602006-06-28 04:26:52 -07001826 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001827 return;
Jiri Slaby1328d732006-12-08 02:39:19 -08001828 if (portp->brdnr >= stli_nrbrds)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001829 return;
1830 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001831 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001832 return;
1833
1834 memset(&actrl, 0, sizeof(asyctrl_t));
1835 if (ch == STOP_CHAR(tty)) {
1836 actrl.rxctrl = CT_STOPFLOW;
1837 } else if (ch == START_CHAR(tty)) {
1838 actrl.rxctrl = CT_STARTFLOW;
1839 } else {
1840 actrl.txctrl = CT_SENDCHR;
1841 actrl.tximdch = ch;
1842 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001843 stli_cmdwait(brdp, portp, A_PORTCTRL, &actrl, sizeof(asyctrl_t), 0);
1844}
1845
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001846static void stli_portinfo(struct seq_file *m, struct stlibrd *brdp, struct stliport *portp, int portnr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001847{
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001848 char *uart;
1849 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001850
Alan Coxd18a7502008-10-13 10:40:07 +01001851 rc = stli_portcmdstats(NULL, portp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001852
1853 uart = "UNKNOWN";
Alan Cox8a1e8032010-06-01 22:52:42 +02001854 if (test_bit(BST_STARTED, &brdp->state)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001855 switch (stli_comstats.hwid) {
Alan Cox4ac43602006-06-28 04:26:52 -07001856 case 0: uart = "2681"; break;
1857 case 1: uart = "SC26198"; break;
1858 default:uart = "CD1400"; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001859 }
1860 }
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001861 seq_printf(m, "%d: uart:%s ", portnr, uart);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001862
Alan Cox8a1e8032010-06-01 22:52:42 +02001863 if (test_bit(BST_STARTED, &brdp->state) && rc >= 0) {
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001864 char sep;
1865
1866 seq_printf(m, "tx:%d rx:%d", (int) stli_comstats.txtotal,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001867 (int) stli_comstats.rxtotal);
1868
1869 if (stli_comstats.rxframing)
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001870 seq_printf(m, " fe:%d",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001871 (int) stli_comstats.rxframing);
1872 if (stli_comstats.rxparity)
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001873 seq_printf(m, " pe:%d",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001874 (int) stli_comstats.rxparity);
1875 if (stli_comstats.rxbreaks)
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001876 seq_printf(m, " brk:%d",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001877 (int) stli_comstats.rxbreaks);
1878 if (stli_comstats.rxoverrun)
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001879 seq_printf(m, " oe:%d",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001880 (int) stli_comstats.rxoverrun);
1881
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001882 sep = ' ';
1883 if (stli_comstats.signals & TIOCM_RTS) {
1884 seq_printf(m, "%c%s", sep, "RTS");
1885 sep = '|';
1886 }
1887 if (stli_comstats.signals & TIOCM_CTS) {
1888 seq_printf(m, "%c%s", sep, "CTS");
1889 sep = '|';
1890 }
1891 if (stli_comstats.signals & TIOCM_DTR) {
1892 seq_printf(m, "%c%s", sep, "DTR");
1893 sep = '|';
1894 }
1895 if (stli_comstats.signals & TIOCM_CD) {
1896 seq_printf(m, "%c%s", sep, "DCD");
1897 sep = '|';
1898 }
1899 if (stli_comstats.signals & TIOCM_DSR) {
1900 seq_printf(m, "%c%s", sep, "DSR");
1901 sep = '|';
1902 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001903 }
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001904 seq_putc(m, '\n');
Linus Torvalds1da177e2005-04-16 15:20:36 -07001905}
1906
1907/*****************************************************************************/
1908
1909/*
1910 * Port info, read from the /proc file system.
1911 */
1912
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001913static int stli_proc_show(struct seq_file *m, void *v)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001914{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001915 struct stlibrd *brdp;
1916 struct stliport *portp;
Jiri Slaby1328d732006-12-08 02:39:19 -08001917 unsigned int brdnr, portnr, totalport;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001918
Linus Torvalds1da177e2005-04-16 15:20:36 -07001919 totalport = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001920
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001921 seq_printf(m, "%s: version %s\n", stli_drvtitle, stli_drvversion);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001922
1923/*
1924 * We scan through for each board, panel and port. The offset is
1925 * calculated on the fly, and irrelevant ports are skipped.
1926 */
1927 for (brdnr = 0; (brdnr < stli_nrbrds); brdnr++) {
1928 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001929 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001930 continue;
1931 if (brdp->state == 0)
1932 continue;
1933
Linus Torvalds1da177e2005-04-16 15:20:36 -07001934 totalport = brdnr * STL_MAXPORTS;
1935 for (portnr = 0; (portnr < brdp->nrports); portnr++,
1936 totalport++) {
1937 portp = brdp->ports[portnr];
Alan Cox4ac43602006-06-28 04:26:52 -07001938 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001939 continue;
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001940 stli_portinfo(m, brdp, portp, totalport);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001941 }
1942 }
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001943 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001944}
1945
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07001946static int stli_proc_open(struct inode *inode, struct file *file)
1947{
1948 return single_open(file, stli_proc_show, NULL);
1949}
1950
1951static const struct file_operations stli_proc_fops = {
1952 .owner = THIS_MODULE,
1953 .open = stli_proc_open,
1954 .read = seq_read,
1955 .llseek = seq_lseek,
1956 .release = single_release,
1957};
1958
Linus Torvalds1da177e2005-04-16 15:20:36 -07001959/*****************************************************************************/
1960
1961/*
1962 * Generic send command routine. This will send a message to the slave,
1963 * of the specified type with the specified argument. Must be very
1964 * careful of data that will be copied out from shared memory -
1965 * containing command results. The command completion is all done from
1966 * a poll routine that does not have user context. Therefore you cannot
1967 * copy back directly into user space, or to the kernel stack of a
1968 * process. This routine does not sleep, so can be called from anywhere.
Alan Cox4ac43602006-06-28 04:26:52 -07001969 *
1970 * The caller must hold the brd_lock (see also stli_sendcmd the usual
1971 * entry point)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001972 */
1973
Jiri Slaby1f8ec432006-12-08 02:39:18 -08001974static 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 -07001975{
Alan Cox4ac43602006-06-28 04:26:52 -07001976 cdkhdr_t __iomem *hdrp;
1977 cdkctrl_t __iomem *cp;
1978 unsigned char __iomem *bits;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001979
1980 if (test_bit(ST_CMDING, &portp->state)) {
Alan Coxa6614992009-01-02 13:46:50 +00001981 printk(KERN_ERR "istallion: command already busy, cmd=%x!\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001982 (int) cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001983 return;
1984 }
1985
1986 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07001987 cp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001988 if (size > 0) {
Alan Cox4ac43602006-06-28 04:26:52 -07001989 memcpy_toio((void __iomem *) &(cp->args[0]), arg, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001990 if (copyback) {
1991 portp->argp = arg;
1992 portp->argsize = size;
1993 }
1994 }
Alan Cox4ac43602006-06-28 04:26:52 -07001995 writel(0, &cp->status);
1996 writel(cmd, &cp->cmd);
1997 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
1998 bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset +
Linus Torvalds1da177e2005-04-16 15:20:36 -07001999 portp->portidx;
Alan Cox4ac43602006-06-28 04:26:52 -07002000 writeb(readb(bits) | portp->portbit, bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002001 set_bit(ST_CMDING, &portp->state);
2002 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07002003}
2004
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002005static 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 -07002006{
2007 unsigned long flags;
2008
2009 spin_lock_irqsave(&brd_lock, flags);
2010 __stli_sendcmd(brdp, portp, cmd, arg, size, copyback);
2011 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002012}
2013
2014/*****************************************************************************/
2015
2016/*
2017 * Read data from shared memory. This assumes that the shared memory
2018 * is enabled and that interrupts are off. Basically we just empty out
2019 * the shared memory buffer into the tty buffer. Must be careful to
2020 * handle the case where we fill up the tty buffer, but still have
2021 * more chars to unload.
2022 */
2023
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002024static void stli_read(struct stlibrd *brdp, struct stliport *portp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002025{
Alan Cox4ac43602006-06-28 04:26:52 -07002026 cdkasyrq_t __iomem *rp;
2027 char __iomem *shbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002028 struct tty_struct *tty;
Alan Cox4ac43602006-06-28 04:26:52 -07002029 unsigned int head, tail, size;
2030 unsigned int len, stlen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002031
2032 if (test_bit(ST_RXSTOP, &portp->state))
2033 return;
Alan Coxd18a7502008-10-13 10:40:07 +01002034 tty = tty_port_tty_get(&portp->port);
Alan Cox4ac43602006-06-28 04:26:52 -07002035 if (tty == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002036 return;
2037
Alan Cox4ac43602006-06-28 04:26:52 -07002038 rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->rxq;
2039 head = (unsigned int) readw(&rp->head);
2040 if (head != ((unsigned int) readw(&rp->head)))
2041 head = (unsigned int) readw(&rp->head);
2042 tail = (unsigned int) readw(&rp->tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002043 size = portp->rxsize;
2044 if (head >= tail) {
2045 len = head - tail;
2046 stlen = len;
2047 } else {
2048 len = size - (tail - head);
2049 stlen = size - tail;
2050 }
2051
Alan Cox33f0f882006-01-09 20:54:13 -08002052 len = tty_buffer_request_room(tty, len);
Alan Cox4ac43602006-06-28 04:26:52 -07002053
2054 shbuf = (char __iomem *) EBRDGETMEMPTR(brdp, portp->rxoffset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002055
2056 while (len > 0) {
Alan Cox4ac43602006-06-28 04:26:52 -07002057 unsigned char *cptr;
2058
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08002059 stlen = min(len, stlen);
Alan Cox4ac43602006-06-28 04:26:52 -07002060 tty_prepare_flip_string(tty, &cptr, stlen);
2061 memcpy_fromio(cptr, shbuf + tail, stlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002062 len -= stlen;
2063 tail += stlen;
2064 if (tail >= size) {
2065 tail = 0;
2066 stlen = head;
2067 }
2068 }
Alan Cox4ac43602006-06-28 04:26:52 -07002069 rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->rxq;
2070 writew(tail, &rp->tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002071
2072 if (head != tail)
2073 set_bit(ST_RXING, &portp->state);
2074
2075 tty_schedule_flip(tty);
Alan Coxd18a7502008-10-13 10:40:07 +01002076 tty_kref_put(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002077}
2078
2079/*****************************************************************************/
2080
2081/*
2082 * Set up and carry out any delayed commands. There is only a small set
2083 * of slave commands that can be done "off-level". So it is not too
2084 * difficult to deal with them here.
2085 */
2086
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002087static void stli_dodelaycmd(struct stliport *portp, cdkctrl_t __iomem *cp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002088{
Alan Cox4ac43602006-06-28 04:26:52 -07002089 int cmd;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002090
2091 if (test_bit(ST_DOSIGS, &portp->state)) {
2092 if (test_bit(ST_DOFLUSHTX, &portp->state) &&
2093 test_bit(ST_DOFLUSHRX, &portp->state))
2094 cmd = A_SETSIGNALSF;
2095 else if (test_bit(ST_DOFLUSHTX, &portp->state))
2096 cmd = A_SETSIGNALSFTX;
2097 else if (test_bit(ST_DOFLUSHRX, &portp->state))
2098 cmd = A_SETSIGNALSFRX;
2099 else
2100 cmd = A_SETSIGNALS;
2101 clear_bit(ST_DOFLUSHTX, &portp->state);
2102 clear_bit(ST_DOFLUSHRX, &portp->state);
2103 clear_bit(ST_DOSIGS, &portp->state);
Alan Cox4ac43602006-06-28 04:26:52 -07002104 memcpy_toio((void __iomem *) &(cp->args[0]), (void *) &portp->asig,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002105 sizeof(asysigs_t));
Alan Cox4ac43602006-06-28 04:26:52 -07002106 writel(0, &cp->status);
2107 writel(cmd, &cp->cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002108 set_bit(ST_CMDING, &portp->state);
2109 } else if (test_bit(ST_DOFLUSHTX, &portp->state) ||
2110 test_bit(ST_DOFLUSHRX, &portp->state)) {
2111 cmd = ((test_bit(ST_DOFLUSHTX, &portp->state)) ? FLUSHTX : 0);
2112 cmd |= ((test_bit(ST_DOFLUSHRX, &portp->state)) ? FLUSHRX : 0);
2113 clear_bit(ST_DOFLUSHTX, &portp->state);
2114 clear_bit(ST_DOFLUSHRX, &portp->state);
Alan Cox4ac43602006-06-28 04:26:52 -07002115 memcpy_toio((void __iomem *) &(cp->args[0]), (void *) &cmd, sizeof(int));
2116 writel(0, &cp->status);
2117 writel(A_FLUSH, &cp->cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002118 set_bit(ST_CMDING, &portp->state);
2119 }
2120}
2121
2122/*****************************************************************************/
2123
2124/*
2125 * Host command service checking. This handles commands or messages
2126 * coming from the slave to the host. Must have board shared memory
2127 * enabled and interrupts off when called. Notice that by servicing the
2128 * read data last we don't need to change the shared memory pointer
2129 * during processing (which is a slow IO operation).
2130 * Return value indicates if this port is still awaiting actions from
2131 * the slave (like open, command, or even TX data being sent). If 0
2132 * then port is still busy, otherwise no longer busy.
2133 */
2134
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002135static int stli_hostcmd(struct stlibrd *brdp, struct stliport *portp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002136{
Alan Cox4ac43602006-06-28 04:26:52 -07002137 cdkasy_t __iomem *ap;
2138 cdkctrl_t __iomem *cp;
2139 struct tty_struct *tty;
2140 asynotify_t nt;
2141 unsigned long oldsigs;
2142 int rc, donerx;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002143
Alan Cox4ac43602006-06-28 04:26:52 -07002144 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002145 cp = &ap->ctrl;
2146
2147/*
2148 * Check if we are waiting for an open completion message.
2149 */
2150 if (test_bit(ST_OPENING, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002151 rc = readl(&cp->openarg);
2152 if (readb(&cp->open) == 0 && rc != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002153 if (rc > 0)
2154 rc--;
Alan Cox4ac43602006-06-28 04:26:52 -07002155 writel(0, &cp->openarg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002156 portp->rc = rc;
2157 clear_bit(ST_OPENING, &portp->state);
2158 wake_up_interruptible(&portp->raw_wait);
2159 }
2160 }
2161
2162/*
2163 * Check if we are waiting for a close completion message.
2164 */
2165 if (test_bit(ST_CLOSING, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002166 rc = (int) readl(&cp->closearg);
2167 if (readb(&cp->close) == 0 && rc != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002168 if (rc > 0)
2169 rc--;
Alan Cox4ac43602006-06-28 04:26:52 -07002170 writel(0, &cp->closearg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002171 portp->rc = rc;
2172 clear_bit(ST_CLOSING, &portp->state);
2173 wake_up_interruptible(&portp->raw_wait);
2174 }
2175 }
2176
2177/*
2178 * Check if we are waiting for a command completion message. We may
2179 * need to copy out the command results associated with this command.
2180 */
2181 if (test_bit(ST_CMDING, &portp->state)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002182 rc = readl(&cp->status);
2183 if (readl(&cp->cmd) == 0 && rc != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002184 if (rc > 0)
2185 rc--;
Alan Cox4ac43602006-06-28 04:26:52 -07002186 if (portp->argp != NULL) {
2187 memcpy_fromio(portp->argp, (void __iomem *) &(cp->args[0]),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002188 portp->argsize);
Alan Cox4ac43602006-06-28 04:26:52 -07002189 portp->argp = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002190 }
Alan Cox4ac43602006-06-28 04:26:52 -07002191 writel(0, &cp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002192 portp->rc = rc;
2193 clear_bit(ST_CMDING, &portp->state);
2194 stli_dodelaycmd(portp, cp);
2195 wake_up_interruptible(&portp->raw_wait);
2196 }
2197 }
2198
2199/*
2200 * Check for any notification messages ready. This includes lots of
2201 * different types of events - RX chars ready, RX break received,
2202 * TX data low or empty in the slave, modem signals changed state.
2203 */
2204 donerx = 0;
2205
2206 if (ap->notify) {
2207 nt = ap->changed;
2208 ap->notify = 0;
Alan Coxd18a7502008-10-13 10:40:07 +01002209 tty = tty_port_tty_get(&portp->port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002210
2211 if (nt.signal & SG_DCD) {
2212 oldsigs = portp->sigs;
2213 portp->sigs = stli_mktiocm(nt.sigvalue);
2214 clear_bit(ST_GETSIGS, &portp->state);
2215 if ((portp->sigs & TIOCM_CD) &&
2216 ((oldsigs & TIOCM_CD) == 0))
Alan Coxb02f5ad62008-07-16 21:55:53 +01002217 wake_up_interruptible(&portp->port.open_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002218 if ((oldsigs & TIOCM_CD) &&
2219 ((portp->sigs & TIOCM_CD) == 0)) {
Alan Coxb02f5ad62008-07-16 21:55:53 +01002220 if (portp->port.flags & ASYNC_CHECK_CD) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002221 if (tty)
Jiri Slabycfccaee2008-02-07 00:16:38 -08002222 tty_hangup(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002223 }
2224 }
2225 }
2226
2227 if (nt.data & DT_TXEMPTY)
2228 clear_bit(ST_TXBUSY, &portp->state);
2229 if (nt.data & (DT_TXEMPTY | DT_TXLOW)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002230 if (tty != NULL) {
2231 tty_wakeup(tty);
2232 EBRDENABLE(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002233 }
2234 }
2235
2236 if ((nt.data & DT_RXBREAK) && (portp->rxmarkmsk & BRKINT)) {
Alan Cox4ac43602006-06-28 04:26:52 -07002237 if (tty != NULL) {
Alan Cox33f0f882006-01-09 20:54:13 -08002238 tty_insert_flip_char(tty, 0, TTY_BREAK);
Alan Coxb02f5ad62008-07-16 21:55:53 +01002239 if (portp->port.flags & ASYNC_SAK) {
Alan Cox33f0f882006-01-09 20:54:13 -08002240 do_SAK(tty);
2241 EBRDENABLE(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002242 }
Alan Cox33f0f882006-01-09 20:54:13 -08002243 tty_schedule_flip(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002244 }
2245 }
Alan Coxd18a7502008-10-13 10:40:07 +01002246 tty_kref_put(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002247
2248 if (nt.data & DT_RXBUSY) {
2249 donerx++;
2250 stli_read(brdp, portp);
2251 }
2252 }
2253
2254/*
2255 * It might seem odd that we are checking for more RX chars here.
2256 * But, we need to handle the case where the tty buffer was previously
2257 * filled, but we had more characters to pass up. The slave will not
2258 * send any more RX notify messages until the RX buffer has been emptied.
2259 * But it will leave the service bits on (since the buffer is not empty).
2260 * So from here we can try to process more RX chars.
2261 */
2262 if ((!donerx) && test_bit(ST_RXING, &portp->state)) {
2263 clear_bit(ST_RXING, &portp->state);
2264 stli_read(brdp, portp);
2265 }
2266
2267 return((test_bit(ST_OPENING, &portp->state) ||
2268 test_bit(ST_CLOSING, &portp->state) ||
2269 test_bit(ST_CMDING, &portp->state) ||
2270 test_bit(ST_TXBUSY, &portp->state) ||
2271 test_bit(ST_RXING, &portp->state)) ? 0 : 1);
2272}
2273
2274/*****************************************************************************/
2275
2276/*
2277 * Service all ports on a particular board. Assumes that the boards
2278 * shared memory is enabled, and that the page pointer is pointed
2279 * at the cdk header structure.
2280 */
2281
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002282static void stli_brdpoll(struct stlibrd *brdp, cdkhdr_t __iomem *hdrp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002283{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002284 struct stliport *portp;
Alan Cox4ac43602006-06-28 04:26:52 -07002285 unsigned char hostbits[(STL_MAXCHANS / 8) + 1];
2286 unsigned char slavebits[(STL_MAXCHANS / 8) + 1];
2287 unsigned char __iomem *slavep;
2288 int bitpos, bitat, bitsize;
2289 int channr, nrdevs, slavebitchange;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002290
2291 bitsize = brdp->bitsize;
2292 nrdevs = brdp->nrdevs;
2293
2294/*
2295 * Check if slave wants any service. Basically we try to do as
2296 * little work as possible here. There are 2 levels of service
2297 * bits. So if there is nothing to do we bail early. We check
2298 * 8 service bits at a time in the inner loop, so we can bypass
2299 * the lot if none of them want service.
2300 */
Alan Cox4ac43602006-06-28 04:26:52 -07002301 memcpy_fromio(&hostbits[0], (((unsigned char __iomem *) hdrp) + brdp->hostoffset),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002302 bitsize);
2303
2304 memset(&slavebits[0], 0, bitsize);
2305 slavebitchange = 0;
2306
2307 for (bitpos = 0; (bitpos < bitsize); bitpos++) {
2308 if (hostbits[bitpos] == 0)
2309 continue;
2310 channr = bitpos * 8;
2311 for (bitat = 0x1; (channr < nrdevs); channr++, bitat <<= 1) {
2312 if (hostbits[bitpos] & bitat) {
2313 portp = brdp->ports[(channr - 1)];
2314 if (stli_hostcmd(brdp, portp)) {
2315 slavebitchange++;
2316 slavebits[bitpos] |= bitat;
2317 }
2318 }
2319 }
2320 }
2321
2322/*
2323 * If any of the ports are no longer busy then update them in the
2324 * slave request bits. We need to do this after, since a host port
2325 * service may initiate more slave requests.
2326 */
2327 if (slavebitchange) {
Alan Cox4ac43602006-06-28 04:26:52 -07002328 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
2329 slavep = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002330 for (bitpos = 0; (bitpos < bitsize); bitpos++) {
Alan Cox4ac43602006-06-28 04:26:52 -07002331 if (readb(slavebits + bitpos))
2332 writeb(readb(slavep + bitpos) & ~slavebits[bitpos], slavebits + bitpos);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002333 }
2334 }
2335}
2336
2337/*****************************************************************************/
2338
2339/*
2340 * Driver poll routine. This routine polls the boards in use and passes
2341 * messages back up to host when necessary. This is actually very
2342 * CPU efficient, since we will always have the kernel poll clock, it
2343 * adds only a few cycles when idle (since board service can be
2344 * determined very easily), but when loaded generates no interrupts
2345 * (with their expensive associated context change).
2346 */
2347
2348static void stli_poll(unsigned long arg)
2349{
Alan Cox4ac43602006-06-28 04:26:52 -07002350 cdkhdr_t __iomem *hdrp;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002351 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08002352 unsigned int brdnr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002353
Jiri Slabyff8efe92006-12-08 02:39:27 -08002354 mod_timer(&stli_timerlist, STLI_TIMEOUT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002355
2356/*
2357 * Check each board and do any servicing required.
2358 */
2359 for (brdnr = 0; (brdnr < stli_nrbrds); brdnr++) {
2360 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07002361 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002362 continue;
Alan Cox8a1e8032010-06-01 22:52:42 +02002363 if (!test_bit(BST_STARTED, &brdp->state))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002364 continue;
2365
Alan Cox4ac43602006-06-28 04:26:52 -07002366 spin_lock(&brd_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002367 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07002368 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
2369 if (readb(&hdrp->hostreq))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002370 stli_brdpoll(brdp, hdrp);
2371 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07002372 spin_unlock(&brd_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002373 }
2374}
2375
2376/*****************************************************************************/
2377
2378/*
2379 * Translate the termios settings into the port setting structure of
2380 * the slave.
2381 */
2382
Alan Coxd18a7502008-10-13 10:40:07 +01002383static void stli_mkasyport(struct tty_struct *tty, struct stliport *portp,
2384 asyport_t *pp, struct ktermios *tiosp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002385{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002386 memset(pp, 0, sizeof(asyport_t));
2387
2388/*
2389 * Start of by setting the baud, char size, parity and stop bit info.
2390 */
Alan Coxd18a7502008-10-13 10:40:07 +01002391 pp->baudout = tty_get_baud_rate(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002392 if ((tiosp->c_cflag & CBAUD) == B38400) {
Alan Coxb02f5ad62008-07-16 21:55:53 +01002393 if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002394 pp->baudout = 57600;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002395 else if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002396 pp->baudout = 115200;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002397 else if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002398 pp->baudout = 230400;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002399 else if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002400 pp->baudout = 460800;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002401 else if ((portp->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002402 pp->baudout = (portp->baud_base / portp->custom_divisor);
2403 }
2404 if (pp->baudout > STL_MAXBAUD)
2405 pp->baudout = STL_MAXBAUD;
2406 pp->baudin = pp->baudout;
2407
2408 switch (tiosp->c_cflag & CSIZE) {
2409 case CS5:
2410 pp->csize = 5;
2411 break;
2412 case CS6:
2413 pp->csize = 6;
2414 break;
2415 case CS7:
2416 pp->csize = 7;
2417 break;
2418 default:
2419 pp->csize = 8;
2420 break;
2421 }
2422
2423 if (tiosp->c_cflag & CSTOPB)
2424 pp->stopbs = PT_STOP2;
2425 else
2426 pp->stopbs = PT_STOP1;
2427
2428 if (tiosp->c_cflag & PARENB) {
2429 if (tiosp->c_cflag & PARODD)
2430 pp->parity = PT_ODDPARITY;
2431 else
2432 pp->parity = PT_EVENPARITY;
2433 } else {
2434 pp->parity = PT_NOPARITY;
2435 }
2436
2437/*
2438 * Set up any flow control options enabled.
2439 */
2440 if (tiosp->c_iflag & IXON) {
2441 pp->flow |= F_IXON;
2442 if (tiosp->c_iflag & IXANY)
2443 pp->flow |= F_IXANY;
2444 }
2445 if (tiosp->c_cflag & CRTSCTS)
2446 pp->flow |= (F_RTSFLOW | F_CTSFLOW);
2447
2448 pp->startin = tiosp->c_cc[VSTART];
2449 pp->stopin = tiosp->c_cc[VSTOP];
2450 pp->startout = tiosp->c_cc[VSTART];
2451 pp->stopout = tiosp->c_cc[VSTOP];
2452
2453/*
2454 * Set up the RX char marking mask with those RX error types we must
2455 * catch. We can get the slave to help us out a little here, it will
2456 * ignore parity errors and breaks for us, and mark parity errors in
2457 * the data stream.
2458 */
2459 if (tiosp->c_iflag & IGNPAR)
2460 pp->iflag |= FI_IGNRXERRS;
2461 if (tiosp->c_iflag & IGNBRK)
2462 pp->iflag |= FI_IGNBREAK;
2463
2464 portp->rxmarkmsk = 0;
2465 if (tiosp->c_iflag & (INPCK | PARMRK))
2466 pp->iflag |= FI_1MARKRXERRS;
2467 if (tiosp->c_iflag & BRKINT)
2468 portp->rxmarkmsk |= BRKINT;
2469
2470/*
2471 * Set up clocal processing as required.
2472 */
2473 if (tiosp->c_cflag & CLOCAL)
Alan Coxb02f5ad62008-07-16 21:55:53 +01002474 portp->port.flags &= ~ASYNC_CHECK_CD;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002475 else
Alan Coxb02f5ad62008-07-16 21:55:53 +01002476 portp->port.flags |= ASYNC_CHECK_CD;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002477
2478/*
2479 * Transfer any persistent flags into the asyport structure.
2480 */
2481 pp->pflag = (portp->pflag & 0xffff);
2482 pp->vmin = (portp->pflag & P_RXIMIN) ? 1 : 0;
2483 pp->vtime = (portp->pflag & P_RXITIME) ? 1 : 0;
2484 pp->cc[1] = (portp->pflag & P_RXTHOLD) ? 1 : 0;
2485}
2486
2487/*****************************************************************************/
2488
2489/*
2490 * Construct a slave signals structure for setting the DTR and RTS
2491 * signals as specified.
2492 */
2493
2494static void stli_mkasysigs(asysigs_t *sp, int dtr, int rts)
2495{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002496 memset(sp, 0, sizeof(asysigs_t));
2497 if (dtr >= 0) {
2498 sp->signal |= SG_DTR;
2499 sp->sigvalue |= ((dtr > 0) ? SG_DTR : 0);
2500 }
2501 if (rts >= 0) {
2502 sp->signal |= SG_RTS;
2503 sp->sigvalue |= ((rts > 0) ? SG_RTS : 0);
2504 }
2505}
2506
2507/*****************************************************************************/
2508
2509/*
2510 * Convert the signals returned from the slave into a local TIOCM type
2511 * signals value. We keep them locally in TIOCM format.
2512 */
2513
2514static long stli_mktiocm(unsigned long sigvalue)
2515{
Alan Cox4ac43602006-06-28 04:26:52 -07002516 long tiocm = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002517 tiocm |= ((sigvalue & SG_DCD) ? TIOCM_CD : 0);
2518 tiocm |= ((sigvalue & SG_CTS) ? TIOCM_CTS : 0);
2519 tiocm |= ((sigvalue & SG_RI) ? TIOCM_RI : 0);
2520 tiocm |= ((sigvalue & SG_DSR) ? TIOCM_DSR : 0);
2521 tiocm |= ((sigvalue & SG_DTR) ? TIOCM_DTR : 0);
2522 tiocm |= ((sigvalue & SG_RTS) ? TIOCM_RTS : 0);
2523 return(tiocm);
2524}
2525
2526/*****************************************************************************/
2527
2528/*
2529 * All panels and ports actually attached have been worked out. All
2530 * we need to do here is set up the appropriate per port data structures.
2531 */
2532
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002533static int stli_initports(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002534{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002535 struct stliport *portp;
Jiri Slaby1328d732006-12-08 02:39:19 -08002536 unsigned int i, panelnr, panelport;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002537
Linus Torvalds1da177e2005-04-16 15:20:36 -07002538 for (i = 0, panelnr = 0, panelport = 0; (i < brdp->nrports); i++) {
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002539 portp = kzalloc(sizeof(struct stliport), GFP_KERNEL);
Tobias Klauserb0b4ed72006-03-31 02:30:56 -08002540 if (!portp) {
Alan Coxa6614992009-01-02 13:46:50 +00002541 printk(KERN_WARNING "istallion: failed to allocate port structure\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002542 continue;
2543 }
Alan Coxd18a7502008-10-13 10:40:07 +01002544 tty_port_init(&portp->port);
Alan Cox31f35932009-01-02 13:45:05 +00002545 portp->port.ops = &stli_port_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002546 portp->magic = STLI_PORTMAGIC;
2547 portp->portnr = i;
2548 portp->brdnr = brdp->brdnr;
2549 portp->panelnr = panelnr;
2550 portp->baud_base = STL_BAUDBASE;
Alan Coxa6614992009-01-02 13:46:50 +00002551 portp->port.close_delay = STL_CLOSEDELAY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002552 portp->closing_wait = 30 * HZ;
Alan Coxb02f5ad62008-07-16 21:55:53 +01002553 init_waitqueue_head(&portp->port.open_wait);
2554 init_waitqueue_head(&portp->port.close_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002555 init_waitqueue_head(&portp->raw_wait);
2556 panelport++;
2557 if (panelport >= brdp->panels[panelnr]) {
2558 panelport = 0;
2559 panelnr++;
2560 }
2561 brdp->ports[i] = portp;
2562 }
2563
Alan Cox4ac43602006-06-28 04:26:52 -07002564 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002565}
2566
2567/*****************************************************************************/
2568
2569/*
2570 * All the following routines are board specific hardware operations.
2571 */
2572
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002573static void stli_ecpinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002574{
2575 unsigned long memconf;
2576
Linus Torvalds1da177e2005-04-16 15:20:36 -07002577 outb(ECP_ATSTOP, (brdp->iobase + ECP_ATCONFR));
2578 udelay(10);
2579 outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR));
2580 udelay(100);
2581
2582 memconf = (brdp->memaddr & ECP_ATADDRMASK) >> ECP_ATADDRSHFT;
2583 outb(memconf, (brdp->iobase + ECP_ATMEMAR));
2584}
2585
2586/*****************************************************************************/
2587
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002588static void stli_ecpenable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002589{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002590 outb(ECP_ATENABLE, (brdp->iobase + ECP_ATCONFR));
2591}
2592
2593/*****************************************************************************/
2594
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002595static void stli_ecpdisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002596{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002597 outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR));
2598}
2599
2600/*****************************************************************************/
2601
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002602static void __iomem *stli_ecpgetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002603{
Al Viro29756fa2006-10-10 22:47:27 +01002604 void __iomem *ptr;
Alan Cox4ac43602006-06-28 04:26:52 -07002605 unsigned char val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002606
2607 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002608 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002609 "range at line=%d(%d), brd=%d\n",
2610 (int) offset, line, __LINE__, brdp->brdnr);
2611 ptr = NULL;
2612 val = 0;
2613 } else {
2614 ptr = brdp->membase + (offset % ECP_ATPAGESIZE);
2615 val = (unsigned char) (offset / ECP_ATPAGESIZE);
2616 }
2617 outb(val, (brdp->iobase + ECP_ATMEMPR));
2618 return(ptr);
2619}
2620
2621/*****************************************************************************/
2622
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002623static void stli_ecpreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002624{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002625 outb(ECP_ATSTOP, (brdp->iobase + ECP_ATCONFR));
2626 udelay(10);
2627 outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR));
2628 udelay(500);
2629}
2630
2631/*****************************************************************************/
2632
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002633static void stli_ecpintr(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002634{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002635 outb(0x1, brdp->iobase);
2636}
2637
2638/*****************************************************************************/
2639
2640/*
2641 * The following set of functions act on ECP EISA boards.
2642 */
2643
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002644static void stli_ecpeiinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002645{
2646 unsigned long memconf;
2647
Linus Torvalds1da177e2005-04-16 15:20:36 -07002648 outb(0x1, (brdp->iobase + ECP_EIBRDENAB));
2649 outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR));
2650 udelay(10);
2651 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
2652 udelay(500);
2653
2654 memconf = (brdp->memaddr & ECP_EIADDRMASKL) >> ECP_EIADDRSHFTL;
2655 outb(memconf, (brdp->iobase + ECP_EIMEMARL));
2656 memconf = (brdp->memaddr & ECP_EIADDRMASKH) >> ECP_EIADDRSHFTH;
2657 outb(memconf, (brdp->iobase + ECP_EIMEMARH));
2658}
2659
2660/*****************************************************************************/
2661
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002662static void stli_ecpeienable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002663{
2664 outb(ECP_EIENABLE, (brdp->iobase + ECP_EICONFR));
2665}
2666
2667/*****************************************************************************/
2668
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002669static void stli_ecpeidisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002670{
2671 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
2672}
2673
2674/*****************************************************************************/
2675
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002676static void __iomem *stli_ecpeigetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002677{
Al Viro29756fa2006-10-10 22:47:27 +01002678 void __iomem *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002679 unsigned char val;
2680
Linus Torvalds1da177e2005-04-16 15:20:36 -07002681 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002682 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002683 "range at line=%d(%d), brd=%d\n",
2684 (int) offset, line, __LINE__, brdp->brdnr);
2685 ptr = NULL;
2686 val = 0;
2687 } else {
2688 ptr = brdp->membase + (offset % ECP_EIPAGESIZE);
2689 if (offset < ECP_EIPAGESIZE)
2690 val = ECP_EIENABLE;
2691 else
2692 val = ECP_EIENABLE | 0x40;
2693 }
2694 outb(val, (brdp->iobase + ECP_EICONFR));
2695 return(ptr);
2696}
2697
2698/*****************************************************************************/
2699
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002700static void stli_ecpeireset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002701{
2702 outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR));
2703 udelay(10);
2704 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
2705 udelay(500);
2706}
2707
2708/*****************************************************************************/
2709
2710/*
2711 * The following set of functions act on ECP MCA boards.
2712 */
2713
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002714static void stli_ecpmcenable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002715{
2716 outb(ECP_MCENABLE, (brdp->iobase + ECP_MCCONFR));
2717}
2718
2719/*****************************************************************************/
2720
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002721static void stli_ecpmcdisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002722{
2723 outb(ECP_MCDISABLE, (brdp->iobase + ECP_MCCONFR));
2724}
2725
2726/*****************************************************************************/
2727
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002728static void __iomem *stli_ecpmcgetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002729{
Al Viro29756fa2006-10-10 22:47:27 +01002730 void __iomem *ptr;
Alan Cox4ac43602006-06-28 04:26:52 -07002731 unsigned char val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002732
2733 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002734 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002735 "range at line=%d(%d), brd=%d\n",
2736 (int) offset, line, __LINE__, brdp->brdnr);
2737 ptr = NULL;
2738 val = 0;
2739 } else {
2740 ptr = brdp->membase + (offset % ECP_MCPAGESIZE);
2741 val = ((unsigned char) (offset / ECP_MCPAGESIZE)) | ECP_MCENABLE;
2742 }
2743 outb(val, (brdp->iobase + ECP_MCCONFR));
2744 return(ptr);
2745}
2746
2747/*****************************************************************************/
2748
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002749static void stli_ecpmcreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002750{
2751 outb(ECP_MCSTOP, (brdp->iobase + ECP_MCCONFR));
2752 udelay(10);
2753 outb(ECP_MCDISABLE, (brdp->iobase + ECP_MCCONFR));
2754 udelay(500);
2755}
2756
2757/*****************************************************************************/
2758
2759/*
2760 * The following set of functions act on ECP PCI boards.
2761 */
2762
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002763static void stli_ecppciinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002764{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002765 outb(ECP_PCISTOP, (brdp->iobase + ECP_PCICONFR));
2766 udelay(10);
2767 outb(0, (brdp->iobase + ECP_PCICONFR));
2768 udelay(500);
2769}
2770
2771/*****************************************************************************/
2772
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002773static void __iomem *stli_ecppcigetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002774{
Al Viro29756fa2006-10-10 22:47:27 +01002775 void __iomem *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002776 unsigned char val;
2777
Linus Torvalds1da177e2005-04-16 15:20:36 -07002778 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002779 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002780 "range at line=%d(%d), board=%d\n",
2781 (int) offset, line, __LINE__, brdp->brdnr);
2782 ptr = NULL;
2783 val = 0;
2784 } else {
2785 ptr = brdp->membase + (offset % ECP_PCIPAGESIZE);
2786 val = (offset / ECP_PCIPAGESIZE) << 1;
2787 }
2788 outb(val, (brdp->iobase + ECP_PCICONFR));
2789 return(ptr);
2790}
2791
2792/*****************************************************************************/
2793
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002794static void stli_ecppcireset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002795{
2796 outb(ECP_PCISTOP, (brdp->iobase + ECP_PCICONFR));
2797 udelay(10);
2798 outb(0, (brdp->iobase + ECP_PCICONFR));
2799 udelay(500);
2800}
2801
2802/*****************************************************************************/
2803
2804/*
2805 * The following routines act on ONboards.
2806 */
2807
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002808static void stli_onbinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002809{
2810 unsigned long memconf;
2811
Linus Torvalds1da177e2005-04-16 15:20:36 -07002812 outb(ONB_ATSTOP, (brdp->iobase + ONB_ATCONFR));
2813 udelay(10);
2814 outb(ONB_ATDISABLE, (brdp->iobase + ONB_ATCONFR));
2815 mdelay(1000);
2816
2817 memconf = (brdp->memaddr & ONB_ATADDRMASK) >> ONB_ATADDRSHFT;
2818 outb(memconf, (brdp->iobase + ONB_ATMEMAR));
2819 outb(0x1, brdp->iobase);
2820 mdelay(1);
2821}
2822
2823/*****************************************************************************/
2824
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002825static void stli_onbenable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002826{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002827 outb((brdp->enabval | ONB_ATENABLE), (brdp->iobase + ONB_ATCONFR));
2828}
2829
2830/*****************************************************************************/
2831
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002832static void stli_onbdisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002833{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002834 outb((brdp->enabval | ONB_ATDISABLE), (brdp->iobase + ONB_ATCONFR));
2835}
2836
2837/*****************************************************************************/
2838
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002839static void __iomem *stli_onbgetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002840{
Al Viro29756fa2006-10-10 22:47:27 +01002841 void __iomem *ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002842
Linus Torvalds1da177e2005-04-16 15:20:36 -07002843 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002844 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002845 "range at line=%d(%d), brd=%d\n",
2846 (int) offset, line, __LINE__, brdp->brdnr);
2847 ptr = NULL;
2848 } else {
2849 ptr = brdp->membase + (offset % ONB_ATPAGESIZE);
2850 }
2851 return(ptr);
2852}
2853
2854/*****************************************************************************/
2855
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002856static void stli_onbreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002857{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002858 outb(ONB_ATSTOP, (brdp->iobase + ONB_ATCONFR));
2859 udelay(10);
2860 outb(ONB_ATDISABLE, (brdp->iobase + ONB_ATCONFR));
2861 mdelay(1000);
2862}
2863
2864/*****************************************************************************/
2865
2866/*
2867 * The following routines act on ONboard EISA.
2868 */
2869
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002870static void stli_onbeinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002871{
2872 unsigned long memconf;
2873
Linus Torvalds1da177e2005-04-16 15:20:36 -07002874 outb(0x1, (brdp->iobase + ONB_EIBRDENAB));
2875 outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR));
2876 udelay(10);
2877 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
2878 mdelay(1000);
2879
2880 memconf = (brdp->memaddr & ONB_EIADDRMASKL) >> ONB_EIADDRSHFTL;
2881 outb(memconf, (brdp->iobase + ONB_EIMEMARL));
2882 memconf = (brdp->memaddr & ONB_EIADDRMASKH) >> ONB_EIADDRSHFTH;
2883 outb(memconf, (brdp->iobase + ONB_EIMEMARH));
2884 outb(0x1, brdp->iobase);
2885 mdelay(1);
2886}
2887
2888/*****************************************************************************/
2889
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002890static void stli_onbeenable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002891{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002892 outb(ONB_EIENABLE, (brdp->iobase + ONB_EICONFR));
2893}
2894
2895/*****************************************************************************/
2896
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002897static void stli_onbedisable(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002898{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002899 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
2900}
2901
2902/*****************************************************************************/
2903
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002904static void __iomem *stli_onbegetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002905{
Al Viro29756fa2006-10-10 22:47:27 +01002906 void __iomem *ptr;
Alan Cox4ac43602006-06-28 04:26:52 -07002907 unsigned char val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002908
2909 if (offset > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00002910 printk(KERN_ERR "istallion: shared memory pointer=%x out of "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002911 "range at line=%d(%d), brd=%d\n",
2912 (int) offset, line, __LINE__, brdp->brdnr);
2913 ptr = NULL;
2914 val = 0;
2915 } else {
2916 ptr = brdp->membase + (offset % ONB_EIPAGESIZE);
2917 if (offset < ONB_EIPAGESIZE)
2918 val = ONB_EIENABLE;
2919 else
2920 val = ONB_EIENABLE | 0x40;
2921 }
2922 outb(val, (brdp->iobase + ONB_EICONFR));
2923 return(ptr);
2924}
2925
2926/*****************************************************************************/
2927
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002928static void stli_onbereset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002929{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002930 outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR));
2931 udelay(10);
2932 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
2933 mdelay(1000);
2934}
2935
2936/*****************************************************************************/
2937
2938/*
2939 * The following routines act on Brumby boards.
2940 */
2941
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002942static void stli_bbyinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002943{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002944 outb(BBY_ATSTOP, (brdp->iobase + BBY_ATCONFR));
2945 udelay(10);
2946 outb(0, (brdp->iobase + BBY_ATCONFR));
2947 mdelay(1000);
2948 outb(0x1, brdp->iobase);
2949 mdelay(1);
2950}
2951
2952/*****************************************************************************/
2953
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002954static void __iomem *stli_bbygetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002955{
Al Viro29756fa2006-10-10 22:47:27 +01002956 void __iomem *ptr;
Alan Cox4ac43602006-06-28 04:26:52 -07002957 unsigned char val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002958
Alan Cox4ac43602006-06-28 04:26:52 -07002959 BUG_ON(offset > brdp->memsize);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002960
Alan Cox4ac43602006-06-28 04:26:52 -07002961 ptr = brdp->membase + (offset % BBY_PAGESIZE);
2962 val = (unsigned char) (offset / BBY_PAGESIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002963 outb(val, (brdp->iobase + BBY_ATCONFR));
2964 return(ptr);
2965}
2966
2967/*****************************************************************************/
2968
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002969static void stli_bbyreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002970{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002971 outb(BBY_ATSTOP, (brdp->iobase + BBY_ATCONFR));
2972 udelay(10);
2973 outb(0, (brdp->iobase + BBY_ATCONFR));
2974 mdelay(1000);
2975}
2976
2977/*****************************************************************************/
2978
2979/*
2980 * The following routines act on original old Stallion boards.
2981 */
2982
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002983static void stli_stalinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002984{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002985 outb(0x1, brdp->iobase);
2986 mdelay(1000);
2987}
2988
2989/*****************************************************************************/
2990
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002991static void __iomem *stli_stalgetmemptr(struct stlibrd *brdp, unsigned long offset, int line)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002992{
Alan Cox4ac43602006-06-28 04:26:52 -07002993 BUG_ON(offset > brdp->memsize);
2994 return brdp->membase + (offset % STAL_PAGESIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002995}
2996
2997/*****************************************************************************/
2998
Jiri Slaby1f8ec432006-12-08 02:39:18 -08002999static void stli_stalreset(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003000{
Alan Cox4ac43602006-06-28 04:26:52 -07003001 u32 __iomem *vecp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003002
Alan Cox4ac43602006-06-28 04:26:52 -07003003 vecp = (u32 __iomem *) (brdp->membase + 0x30);
3004 writel(0xffff0000, vecp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003005 outb(0, brdp->iobase);
3006 mdelay(1000);
3007}
3008
3009/*****************************************************************************/
3010
3011/*
3012 * Try to find an ECP board and initialize it. This handles only ECP
3013 * board types.
3014 */
3015
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003016static int stli_initecp(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003017{
Alan Cox4ac43602006-06-28 04:26:52 -07003018 cdkecpsig_t sig;
3019 cdkecpsig_t __iomem *sigsp;
3020 unsigned int status, nxtid;
3021 char *name;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003022 int retval, panelnr, nrports;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003023
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003024 if ((brdp->iobase == 0) || (brdp->memaddr == 0)) {
3025 retval = -ENODEV;
3026 goto err;
3027 }
3028
Ingo Korbb3061222007-07-17 04:05:23 -07003029 brdp->iosize = ECP_IOSIZE;
3030
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003031 if (!request_region(brdp->iobase, brdp->iosize, "istallion")) {
3032 retval = -EIO;
3033 goto err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003034 }
3035
Linus Torvalds1da177e2005-04-16 15:20:36 -07003036/*
3037 * Based on the specific board type setup the common vars to access
3038 * and enable shared memory. Set all board specific information now
3039 * as well.
3040 */
3041 switch (brdp->brdtype) {
3042 case BRD_ECP:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003043 brdp->memsize = ECP_MEMSIZE;
3044 brdp->pagesize = ECP_ATPAGESIZE;
3045 brdp->init = stli_ecpinit;
3046 brdp->enable = stli_ecpenable;
3047 brdp->reenable = stli_ecpenable;
3048 brdp->disable = stli_ecpdisable;
3049 brdp->getmemptr = stli_ecpgetmemptr;
3050 brdp->intr = stli_ecpintr;
3051 brdp->reset = stli_ecpreset;
3052 name = "serial(EC8/64)";
3053 break;
3054
3055 case BRD_ECPE:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003056 brdp->memsize = ECP_MEMSIZE;
3057 brdp->pagesize = ECP_EIPAGESIZE;
3058 brdp->init = stli_ecpeiinit;
3059 brdp->enable = stli_ecpeienable;
3060 brdp->reenable = stli_ecpeienable;
3061 brdp->disable = stli_ecpeidisable;
3062 brdp->getmemptr = stli_ecpeigetmemptr;
3063 brdp->intr = stli_ecpintr;
3064 brdp->reset = stli_ecpeireset;
3065 name = "serial(EC8/64-EI)";
3066 break;
3067
3068 case BRD_ECPMC:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003069 brdp->memsize = ECP_MEMSIZE;
3070 brdp->pagesize = ECP_MCPAGESIZE;
3071 brdp->init = NULL;
3072 brdp->enable = stli_ecpmcenable;
3073 brdp->reenable = stli_ecpmcenable;
3074 brdp->disable = stli_ecpmcdisable;
3075 brdp->getmemptr = stli_ecpmcgetmemptr;
3076 brdp->intr = stli_ecpintr;
3077 brdp->reset = stli_ecpmcreset;
3078 name = "serial(EC8/64-MCA)";
3079 break;
3080
3081 case BRD_ECPPCI:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003082 brdp->memsize = ECP_PCIMEMSIZE;
3083 brdp->pagesize = ECP_PCIPAGESIZE;
3084 brdp->init = stli_ecppciinit;
3085 brdp->enable = NULL;
3086 brdp->reenable = NULL;
3087 brdp->disable = NULL;
3088 brdp->getmemptr = stli_ecppcigetmemptr;
3089 brdp->intr = stli_ecpintr;
3090 brdp->reset = stli_ecppcireset;
3091 name = "serial(EC/RA-PCI)";
3092 break;
3093
3094 default:
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003095 retval = -EINVAL;
3096 goto err_reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003097 }
3098
3099/*
3100 * The per-board operations structure is all set up, so now let's go
3101 * and get the board operational. Firstly initialize board configuration
3102 * registers. Set the memory mapping info so we can get at the boards
3103 * shared memory.
3104 */
3105 EBRDINIT(brdp);
3106
Alan Cox24cb2332008-04-30 00:54:19 -07003107 brdp->membase = ioremap_nocache(brdp->memaddr, brdp->memsize);
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003108 if (brdp->membase == NULL) {
3109 retval = -ENOMEM;
3110 goto err_reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003111 }
3112
3113/*
3114 * Now that all specific code is set up, enable the shared memory and
3115 * look for the a signature area that will tell us exactly what board
3116 * this is, and what it is connected to it.
3117 */
3118 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07003119 sigsp = (cdkecpsig_t __iomem *) EBRDGETMEMPTR(brdp, CDK_SIGADDR);
Al Viro634965f2006-09-23 01:20:31 +01003120 memcpy_fromio(&sig, sigsp, sizeof(cdkecpsig_t));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003121 EBRDDISABLE(brdp);
3122
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003123 if (sig.magic != cpu_to_le32(ECP_MAGIC)) {
3124 retval = -ENODEV;
3125 goto err_unmap;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003126 }
3127
3128/*
3129 * Scan through the signature looking at the panels connected to the
3130 * board. Calculate the total number of ports as we go.
3131 */
3132 for (panelnr = 0, nxtid = 0; (panelnr < STL_MAXPANELS); panelnr++) {
3133 status = sig.panelid[nxtid];
3134 if ((status & ECH_PNLIDMASK) != nxtid)
3135 break;
3136
3137 brdp->panelids[panelnr] = status;
3138 nrports = (status & ECH_PNL16PORT) ? 16 : 8;
3139 if ((nrports == 16) && ((status & ECH_PNLXPID) == 0))
3140 nxtid++;
3141 brdp->panels[panelnr] = nrports;
3142 brdp->nrports += nrports;
3143 nxtid++;
3144 brdp->nrpanels++;
3145 }
3146
3147
Alan Cox8a1e8032010-06-01 22:52:42 +02003148 set_bit(BST_FOUND, &brdp->state);
Alan Cox4ac43602006-06-28 04:26:52 -07003149 return 0;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003150err_unmap:
3151 iounmap(brdp->membase);
3152 brdp->membase = NULL;
3153err_reg:
3154 release_region(brdp->iobase, brdp->iosize);
3155err:
3156 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003157}
3158
3159/*****************************************************************************/
3160
3161/*
3162 * Try to find an ONboard, Brumby or Stallion board and initialize it.
3163 * This handles only these board types.
3164 */
3165
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003166static int stli_initonb(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003167{
Alan Cox4ac43602006-06-28 04:26:52 -07003168 cdkonbsig_t sig;
3169 cdkonbsig_t __iomem *sigsp;
3170 char *name;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003171 int i, retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003172
3173/*
3174 * Do a basic sanity check on the IO and memory addresses.
3175 */
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003176 if (brdp->iobase == 0 || brdp->memaddr == 0) {
3177 retval = -ENODEV;
3178 goto err;
3179 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003180
3181 brdp->iosize = ONB_IOSIZE;
3182
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003183 if (!request_region(brdp->iobase, brdp->iosize, "istallion")) {
3184 retval = -EIO;
3185 goto err;
3186 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003187
3188/*
3189 * Based on the specific board type setup the common vars to access
3190 * and enable shared memory. Set all board specific information now
3191 * as well.
3192 */
3193 switch (brdp->brdtype) {
3194 case BRD_ONBOARD:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003195 case BRD_ONBOARD2:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003196 brdp->memsize = ONB_MEMSIZE;
3197 brdp->pagesize = ONB_ATPAGESIZE;
3198 brdp->init = stli_onbinit;
3199 brdp->enable = stli_onbenable;
3200 brdp->reenable = stli_onbenable;
3201 brdp->disable = stli_onbdisable;
3202 brdp->getmemptr = stli_onbgetmemptr;
3203 brdp->intr = stli_ecpintr;
3204 brdp->reset = stli_onbreset;
3205 if (brdp->memaddr > 0x100000)
3206 brdp->enabval = ONB_MEMENABHI;
3207 else
3208 brdp->enabval = ONB_MEMENABLO;
3209 name = "serial(ONBoard)";
3210 break;
3211
3212 case BRD_ONBOARDE:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003213 brdp->memsize = ONB_EIMEMSIZE;
3214 brdp->pagesize = ONB_EIPAGESIZE;
3215 brdp->init = stli_onbeinit;
3216 brdp->enable = stli_onbeenable;
3217 brdp->reenable = stli_onbeenable;
3218 brdp->disable = stli_onbedisable;
3219 brdp->getmemptr = stli_onbegetmemptr;
3220 brdp->intr = stli_ecpintr;
3221 brdp->reset = stli_onbereset;
3222 name = "serial(ONBoard/E)";
3223 break;
3224
3225 case BRD_BRUMBY4:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003226 brdp->memsize = BBY_MEMSIZE;
3227 brdp->pagesize = BBY_PAGESIZE;
3228 brdp->init = stli_bbyinit;
3229 brdp->enable = NULL;
3230 brdp->reenable = NULL;
3231 brdp->disable = NULL;
3232 brdp->getmemptr = stli_bbygetmemptr;
3233 brdp->intr = stli_ecpintr;
3234 brdp->reset = stli_bbyreset;
3235 name = "serial(Brumby)";
3236 break;
3237
3238 case BRD_STALLION:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003239 brdp->memsize = STAL_MEMSIZE;
3240 brdp->pagesize = STAL_PAGESIZE;
3241 brdp->init = stli_stalinit;
3242 brdp->enable = NULL;
3243 brdp->reenable = NULL;
3244 brdp->disable = NULL;
3245 brdp->getmemptr = stli_stalgetmemptr;
3246 brdp->intr = stli_ecpintr;
3247 brdp->reset = stli_stalreset;
3248 name = "serial(Stallion)";
3249 break;
3250
3251 default:
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003252 retval = -EINVAL;
3253 goto err_reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003254 }
3255
3256/*
3257 * The per-board operations structure is all set up, so now let's go
3258 * and get the board operational. Firstly initialize board configuration
3259 * registers. Set the memory mapping info so we can get at the boards
3260 * shared memory.
3261 */
3262 EBRDINIT(brdp);
3263
Alan Cox24cb2332008-04-30 00:54:19 -07003264 brdp->membase = ioremap_nocache(brdp->memaddr, brdp->memsize);
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003265 if (brdp->membase == NULL) {
3266 retval = -ENOMEM;
3267 goto err_reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003268 }
3269
3270/*
3271 * Now that all specific code is set up, enable the shared memory and
3272 * look for the a signature area that will tell us exactly what board
3273 * this is, and how many ports.
3274 */
3275 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07003276 sigsp = (cdkonbsig_t __iomem *) EBRDGETMEMPTR(brdp, CDK_SIGADDR);
3277 memcpy_fromio(&sig, sigsp, sizeof(cdkonbsig_t));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003278 EBRDDISABLE(brdp);
3279
Alan Cox4ac43602006-06-28 04:26:52 -07003280 if (sig.magic0 != cpu_to_le16(ONB_MAGIC0) ||
3281 sig.magic1 != cpu_to_le16(ONB_MAGIC1) ||
3282 sig.magic2 != cpu_to_le16(ONB_MAGIC2) ||
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003283 sig.magic3 != cpu_to_le16(ONB_MAGIC3)) {
3284 retval = -ENODEV;
3285 goto err_unmap;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003286 }
3287
3288/*
3289 * Scan through the signature alive mask and calculate how many ports
3290 * there are on this board.
3291 */
3292 brdp->nrpanels = 1;
3293 if (sig.amask1) {
3294 brdp->nrports = 32;
3295 } else {
3296 for (i = 0; (i < 16); i++) {
3297 if (((sig.amask0 << i) & 0x8000) == 0)
3298 break;
3299 }
3300 brdp->nrports = i;
3301 }
3302 brdp->panels[0] = brdp->nrports;
3303
3304
Alan Cox8a1e8032010-06-01 22:52:42 +02003305 set_bit(BST_FOUND, &brdp->state);
Alan Cox4ac43602006-06-28 04:26:52 -07003306 return 0;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003307err_unmap:
3308 iounmap(brdp->membase);
3309 brdp->membase = NULL;
3310err_reg:
3311 release_region(brdp->iobase, brdp->iosize);
3312err:
3313 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003314}
3315
3316/*****************************************************************************/
3317
3318/*
3319 * Start up a running board. This routine is only called after the
3320 * code has been down loaded to the board and is operational. It will
3321 * read in the memory map, and get the show on the road...
3322 */
3323
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003324static int stli_startbrd(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003325{
Alan Cox4ac43602006-06-28 04:26:52 -07003326 cdkhdr_t __iomem *hdrp;
3327 cdkmem_t __iomem *memp;
3328 cdkasy_t __iomem *ap;
3329 unsigned long flags;
Jiri Slaby1328d732006-12-08 02:39:19 -08003330 unsigned int portnr, nrdevs, i;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003331 struct stliport *portp;
Jiri Slaby1328d732006-12-08 02:39:19 -08003332 int rc = 0;
Alan Cox4ac43602006-06-28 04:26:52 -07003333 u32 memoff;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003334
Alan Cox4ac43602006-06-28 04:26:52 -07003335 spin_lock_irqsave(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003336 EBRDENABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07003337 hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003338 nrdevs = hdrp->nrdevs;
3339
3340#if 0
3341 printk("%s(%d): CDK version %d.%d.%d --> "
3342 "nrdevs=%d memp=%x hostp=%x slavep=%x\n",
Alan Cox4ac43602006-06-28 04:26:52 -07003343 __FILE__, __LINE__, readb(&hdrp->ver_release), readb(&hdrp->ver_modification),
3344 readb(&hdrp->ver_fix), nrdevs, (int) readl(&hdrp->memp), readl(&hdrp->hostp),
3345 readl(&hdrp->slavep));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003346#endif
3347
3348 if (nrdevs < (brdp->nrports + 1)) {
Alan Coxa6614992009-01-02 13:46:50 +00003349 printk(KERN_ERR "istallion: slave failed to allocate memory for "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003350 "all devices, devices=%d\n", nrdevs);
3351 brdp->nrports = nrdevs - 1;
3352 }
3353 brdp->nrdevs = nrdevs;
3354 brdp->hostoffset = hdrp->hostp - CDK_CDKADDR;
3355 brdp->slaveoffset = hdrp->slavep - CDK_CDKADDR;
3356 brdp->bitsize = (nrdevs + 7) / 8;
Alan Cox4ac43602006-06-28 04:26:52 -07003357 memoff = readl(&hdrp->memp);
3358 if (memoff > brdp->memsize) {
Alan Coxa6614992009-01-02 13:46:50 +00003359 printk(KERN_ERR "istallion: corrupted shared memory region?\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003360 rc = -EIO;
3361 goto stli_donestartup;
3362 }
Alan Cox4ac43602006-06-28 04:26:52 -07003363 memp = (cdkmem_t __iomem *) EBRDGETMEMPTR(brdp, memoff);
3364 if (readw(&memp->dtype) != TYP_ASYNCTRL) {
Alan Coxa6614992009-01-02 13:46:50 +00003365 printk(KERN_ERR "istallion: no slave control device found\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003366 goto stli_donestartup;
3367 }
3368 memp++;
3369
3370/*
3371 * Cycle through memory allocation of each port. We are guaranteed to
3372 * have all ports inside the first page of slave window, so no need to
3373 * change pages while reading memory map.
3374 */
3375 for (i = 1, portnr = 0; (i < nrdevs); i++, portnr++, memp++) {
Alan Cox4ac43602006-06-28 04:26:52 -07003376 if (readw(&memp->dtype) != TYP_ASYNC)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003377 break;
3378 portp = brdp->ports[portnr];
Alan Cox4ac43602006-06-28 04:26:52 -07003379 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003380 break;
3381 portp->devnr = i;
Alan Cox4ac43602006-06-28 04:26:52 -07003382 portp->addr = readl(&memp->offset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003383 portp->reqbit = (unsigned char) (0x1 << (i * 8 / nrdevs));
3384 portp->portidx = (unsigned char) (i / 8);
3385 portp->portbit = (unsigned char) (0x1 << (i % 8));
3386 }
3387
Alan Cox4ac43602006-06-28 04:26:52 -07003388 writeb(0xff, &hdrp->slavereq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003389
3390/*
3391 * For each port setup a local copy of the RX and TX buffer offsets
3392 * and sizes. We do this separate from the above, because we need to
3393 * move the shared memory page...
3394 */
3395 for (i = 1, portnr = 0; (i < nrdevs); i++, portnr++) {
3396 portp = brdp->ports[portnr];
Alan Cox4ac43602006-06-28 04:26:52 -07003397 if (portp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003398 break;
3399 if (portp->addr == 0)
3400 break;
Alan Cox4ac43602006-06-28 04:26:52 -07003401 ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr);
3402 if (ap != NULL) {
3403 portp->rxsize = readw(&ap->rxq.size);
3404 portp->txsize = readw(&ap->txq.size);
3405 portp->rxoffset = readl(&ap->rxq.offset);
3406 portp->txoffset = readl(&ap->txq.offset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003407 }
3408 }
3409
3410stli_donestartup:
3411 EBRDDISABLE(brdp);
Alan Cox4ac43602006-06-28 04:26:52 -07003412 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003413
3414 if (rc == 0)
Alan Cox8a1e8032010-06-01 22:52:42 +02003415 set_bit(BST_STARTED, &brdp->state);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003416
3417 if (! stli_timeron) {
3418 stli_timeron++;
Jiri Slabyff8efe92006-12-08 02:39:27 -08003419 mod_timer(&stli_timerlist, STLI_TIMEOUT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003420 }
3421
Alan Cox4ac43602006-06-28 04:26:52 -07003422 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003423}
3424
3425/*****************************************************************************/
3426
3427/*
3428 * Probe and initialize the specified board.
3429 */
3430
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003431static int __devinit stli_brdinit(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003432{
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003433 int retval;
3434
Linus Torvalds1da177e2005-04-16 15:20:36 -07003435 switch (brdp->brdtype) {
3436 case BRD_ECP:
3437 case BRD_ECPE:
3438 case BRD_ECPMC:
3439 case BRD_ECPPCI:
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003440 retval = stli_initecp(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003441 break;
3442 case BRD_ONBOARD:
3443 case BRD_ONBOARDE:
3444 case BRD_ONBOARD2:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003445 case BRD_BRUMBY4:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003446 case BRD_STALLION:
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003447 retval = stli_initonb(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003448 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003449 default:
Alan Coxa6614992009-01-02 13:46:50 +00003450 printk(KERN_ERR "istallion: board=%d is unknown board "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003451 "type=%d\n", brdp->brdnr, brdp->brdtype);
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003452 retval = -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003453 }
3454
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003455 if (retval)
3456 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003457
3458 stli_initports(brdp);
Alan Coxa6614992009-01-02 13:46:50 +00003459 printk(KERN_INFO "istallion: %s found, board=%d io=%x mem=%x "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003460 "nrpanels=%d nrports=%d\n", stli_brdnames[brdp->brdtype],
3461 brdp->brdnr, brdp->iobase, (int) brdp->memaddr,
3462 brdp->nrpanels, brdp->nrports);
Alan Cox4ac43602006-06-28 04:26:52 -07003463 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003464}
3465
Jiri Slabya00f33f2006-12-08 02:39:20 -08003466#if STLI_EISAPROBE != 0
Linus Torvalds1da177e2005-04-16 15:20:36 -07003467/*****************************************************************************/
3468
3469/*
3470 * Probe around trying to find where the EISA boards shared memory
3471 * might be. This is a bit if hack, but it is the best we can do.
3472 */
3473
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003474static int stli_eisamemprobe(struct stlibrd *brdp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003475{
Alan Cox4ac43602006-06-28 04:26:52 -07003476 cdkecpsig_t ecpsig, __iomem *ecpsigp;
3477 cdkonbsig_t onbsig, __iomem *onbsigp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003478 int i, foundit;
3479
Linus Torvalds1da177e2005-04-16 15:20:36 -07003480/*
3481 * First up we reset the board, to get it into a known state. There
3482 * is only 2 board types here we need to worry about. Don;t use the
3483 * standard board init routine here, it programs up the shared
3484 * memory address, and we don't know it yet...
3485 */
3486 if (brdp->brdtype == BRD_ECPE) {
3487 outb(0x1, (brdp->iobase + ECP_EIBRDENAB));
3488 outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR));
3489 udelay(10);
3490 outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR));
3491 udelay(500);
3492 stli_ecpeienable(brdp);
3493 } else if (brdp->brdtype == BRD_ONBOARDE) {
3494 outb(0x1, (brdp->iobase + ONB_EIBRDENAB));
3495 outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR));
3496 udelay(10);
3497 outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR));
3498 mdelay(100);
3499 outb(0x1, brdp->iobase);
3500 mdelay(1);
3501 stli_onbeenable(brdp);
3502 } else {
Alan Cox4ac43602006-06-28 04:26:52 -07003503 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003504 }
3505
3506 foundit = 0;
3507 brdp->memsize = ECP_MEMSIZE;
3508
3509/*
3510 * Board shared memory is enabled, so now we have a poke around and
3511 * see if we can find it.
3512 */
3513 for (i = 0; (i < stli_eisamempsize); i++) {
3514 brdp->memaddr = stli_eisamemprobeaddrs[i];
Alan Cox24cb2332008-04-30 00:54:19 -07003515 brdp->membase = ioremap_nocache(brdp->memaddr, brdp->memsize);
Alan Cox4ac43602006-06-28 04:26:52 -07003516 if (brdp->membase == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003517 continue;
3518
3519 if (brdp->brdtype == BRD_ECPE) {
Al Viro29756fa2006-10-10 22:47:27 +01003520 ecpsigp = stli_ecpeigetmemptr(brdp,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003521 CDK_SIGADDR, __LINE__);
Alan Cox4ac43602006-06-28 04:26:52 -07003522 memcpy_fromio(&ecpsig, ecpsigp, sizeof(cdkecpsig_t));
3523 if (ecpsig.magic == cpu_to_le32(ECP_MAGIC))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003524 foundit = 1;
3525 } else {
Alan Cox4ac43602006-06-28 04:26:52 -07003526 onbsigp = (cdkonbsig_t __iomem *) stli_onbegetmemptr(brdp,
Linus Torvalds1da177e2005-04-16 15:20:36 -07003527 CDK_SIGADDR, __LINE__);
Alan Cox4ac43602006-06-28 04:26:52 -07003528 memcpy_fromio(&onbsig, onbsigp, sizeof(cdkonbsig_t));
3529 if ((onbsig.magic0 == cpu_to_le16(ONB_MAGIC0)) &&
3530 (onbsig.magic1 == cpu_to_le16(ONB_MAGIC1)) &&
3531 (onbsig.magic2 == cpu_to_le16(ONB_MAGIC2)) &&
3532 (onbsig.magic3 == cpu_to_le16(ONB_MAGIC3)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003533 foundit = 1;
3534 }
3535
3536 iounmap(brdp->membase);
3537 if (foundit)
3538 break;
3539 }
3540
3541/*
3542 * Regardless of whether we found the shared memory or not we must
3543 * disable the region. After that return success or failure.
3544 */
3545 if (brdp->brdtype == BRD_ECPE)
3546 stli_ecpeidisable(brdp);
3547 else
3548 stli_onbedisable(brdp);
3549
3550 if (! foundit) {
3551 brdp->memaddr = 0;
3552 brdp->membase = NULL;
Alan Coxa6614992009-01-02 13:46:50 +00003553 printk(KERN_ERR "istallion: failed to probe shared memory "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003554 "region for %s in EISA slot=%d\n",
3555 stli_brdnames[brdp->brdtype], (brdp->iobase >> 12));
Alan Cox4ac43602006-06-28 04:26:52 -07003556 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003557 }
Alan Cox4ac43602006-06-28 04:26:52 -07003558 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003559}
Jiri Slabya00f33f2006-12-08 02:39:20 -08003560#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003561
3562static int stli_getbrdnr(void)
3563{
Jiri Slaby1328d732006-12-08 02:39:19 -08003564 unsigned int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003565
3566 for (i = 0; i < STL_MAXBRDS; i++) {
3567 if (!stli_brds[i]) {
3568 if (i >= stli_nrbrds)
3569 stli_nrbrds = i + 1;
3570 return i;
3571 }
3572 }
3573 return -1;
3574}
3575
Jiri Slabya00f33f2006-12-08 02:39:20 -08003576#if STLI_EISAPROBE != 0
Linus Torvalds1da177e2005-04-16 15:20:36 -07003577/*****************************************************************************/
3578
3579/*
3580 * Probe around and try to find any EISA boards in system. The biggest
3581 * problem here is finding out what memory address is associated with
3582 * an EISA board after it is found. The registers of the ECPE and
3583 * ONboardE are not readable - so we can't read them from there. We
3584 * don't have access to the EISA CMOS (or EISA BIOS) so we don't
3585 * actually have any way to find out the real value. The best we can
3586 * do is go probing around in the usual places hoping we can find it.
3587 */
3588
Al Viro6005e3e2008-11-22 17:34:14 +00003589static int __init stli_findeisabrds(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003590{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003591 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08003592 unsigned int iobase, eid, i;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003593 int brdnr, found = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003594
3595/*
Alan Cox4ac43602006-06-28 04:26:52 -07003596 * Firstly check if this is an EISA system. If this is not an EISA system then
Linus Torvalds1da177e2005-04-16 15:20:36 -07003597 * don't bother going any further!
3598 */
Alan Cox4ac43602006-06-28 04:26:52 -07003599 if (EISA_bus)
3600 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003601
3602/*
3603 * Looks like an EISA system, so go searching for EISA boards.
3604 */
3605 for (iobase = 0x1000; (iobase <= 0xc000); iobase += 0x1000) {
3606 outb(0xff, (iobase + 0xc80));
3607 eid = inb(iobase + 0xc80);
3608 eid |= inb(iobase + 0xc81) << 8;
3609 if (eid != STL_EISAID)
3610 continue;
3611
3612/*
3613 * We have found a board. Need to check if this board was
3614 * statically configured already (just in case!).
3615 */
3616 for (i = 0; (i < STL_MAXBRDS); i++) {
3617 brdp = stli_brds[i];
Alan Cox4ac43602006-06-28 04:26:52 -07003618 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003619 continue;
3620 if (brdp->iobase == iobase)
3621 break;
3622 }
3623 if (i < STL_MAXBRDS)
3624 continue;
3625
3626/*
3627 * We have found a Stallion board and it is not configured already.
3628 * Allocate a board structure and initialize it.
3629 */
Alan Cox4ac43602006-06-28 04:26:52 -07003630 if ((brdp = stli_allocbrd()) == NULL)
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003631 return found ? : -ENOMEM;
Jiri Slaby1328d732006-12-08 02:39:19 -08003632 brdnr = stli_getbrdnr();
3633 if (brdnr < 0)
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003634 return found ? : -ENOMEM;
Jiri Slaby1328d732006-12-08 02:39:19 -08003635 brdp->brdnr = (unsigned int)brdnr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003636 eid = inb(iobase + 0xc82);
3637 if (eid == ECP_EISAID)
3638 brdp->brdtype = BRD_ECPE;
3639 else if (eid == ONB_EISAID)
3640 brdp->brdtype = BRD_ONBOARDE;
3641 else
3642 brdp->brdtype = BRD_UNKNOWN;
3643 brdp->iobase = iobase;
3644 outb(0x1, (iobase + 0xc84));
3645 if (stli_eisamemprobe(brdp))
3646 outb(0, (iobase + 0xc84));
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003647 if (stli_brdinit(brdp) < 0) {
3648 kfree(brdp);
3649 continue;
3650 }
3651
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003652 stli_brds[brdp->brdnr] = brdp;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003653 found++;
Jiri Slabyec3dde52006-12-08 02:39:26 -08003654
3655 for (i = 0; i < brdp->nrports; i++)
3656 tty_register_device(stli_serial,
3657 brdp->brdnr * STL_MAXPORTS + i, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003658 }
3659
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003660 return found;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003661}
Jiri Slabya00f33f2006-12-08 02:39:20 -08003662#else
3663static inline int stli_findeisabrds(void) { return 0; }
3664#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003665
3666/*****************************************************************************/
3667
3668/*
3669 * Find the next available board number that is free.
3670 */
3671
3672/*****************************************************************************/
3673
Linus Torvalds1da177e2005-04-16 15:20:36 -07003674/*
3675 * We have a Stallion board. Allocate a board structure and
3676 * initialize it. Read its IO and MEMORY resources from PCI
3677 * configuration space.
3678 */
3679
Jiri Slaby845bead2006-12-08 02:39:17 -08003680static int __devinit stli_pciprobe(struct pci_dev *pdev,
3681 const struct pci_device_id *ent)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003682{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003683 struct stlibrd *brdp;
Jiri Slabyec3dde52006-12-08 02:39:26 -08003684 unsigned int i;
Jiri Slaby1328d732006-12-08 02:39:19 -08003685 int brdnr, retval = -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003686
Jiri Slaby845bead2006-12-08 02:39:17 -08003687 retval = pci_enable_device(pdev);
3688 if (retval)
3689 goto err;
3690 brdp = stli_allocbrd();
3691 if (brdp == NULL) {
3692 retval = -ENOMEM;
3693 goto err;
3694 }
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003695 mutex_lock(&stli_brdslock);
Jiri Slaby1328d732006-12-08 02:39:19 -08003696 brdnr = stli_getbrdnr();
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003697 if (brdnr < 0) {
Alan Coxa6614992009-01-02 13:46:50 +00003698 printk(KERN_INFO "istallion: too many boards found, "
Linus Torvalds1da177e2005-04-16 15:20:36 -07003699 "maximum supported %d\n", STL_MAXBRDS);
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003700 mutex_unlock(&stli_brdslock);
Jiri Slaby845bead2006-12-08 02:39:17 -08003701 retval = -EIO;
3702 goto err_fr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003703 }
Jiri Slaby1328d732006-12-08 02:39:19 -08003704 brdp->brdnr = (unsigned int)brdnr;
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003705 stli_brds[brdp->brdnr] = brdp;
3706 mutex_unlock(&stli_brdslock);
Jiri Slaby845bead2006-12-08 02:39:17 -08003707 brdp->brdtype = BRD_ECPPCI;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003708/*
3709 * We have all resources from the board, so lets setup the actual
3710 * board structure now.
3711 */
Jiri Slaby845bead2006-12-08 02:39:17 -08003712 brdp->iobase = pci_resource_start(pdev, 3);
3713 brdp->memaddr = pci_resource_start(pdev, 2);
3714 retval = stli_brdinit(brdp);
3715 if (retval)
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003716 goto err_null;
Jiri Slaby845bead2006-12-08 02:39:17 -08003717
Alan Cox8a1e8032010-06-01 22:52:42 +02003718 set_bit(BST_PROBED, &brdp->state);
Jiri Slaby845bead2006-12-08 02:39:17 -08003719 pci_set_drvdata(pdev, brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003720
Jiri Slaby140e92a2006-12-08 02:39:24 -08003721 EBRDENABLE(brdp);
3722 brdp->enable = NULL;
3723 brdp->disable = NULL;
3724
Jiri Slabyec3dde52006-12-08 02:39:26 -08003725 for (i = 0; i < brdp->nrports; i++)
3726 tty_register_device(stli_serial, brdp->brdnr * STL_MAXPORTS + i,
3727 &pdev->dev);
3728
Alan Cox4ac43602006-06-28 04:26:52 -07003729 return 0;
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003730err_null:
3731 stli_brds[brdp->brdnr] = NULL;
Jiri Slaby845bead2006-12-08 02:39:17 -08003732err_fr:
3733 kfree(brdp);
3734err:
3735 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003736}
3737
Mike Frysinger0b9ce5a2009-06-18 16:49:14 -07003738static void __devexit stli_pciremove(struct pci_dev *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003739{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003740 struct stlibrd *brdp = pci_get_drvdata(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003741
Jiri Slaby845bead2006-12-08 02:39:17 -08003742 stli_cleanup_ports(brdp);
3743
3744 iounmap(brdp->membase);
3745 if (brdp->iosize > 0)
3746 release_region(brdp->iobase, brdp->iosize);
3747
3748 stli_brds[brdp->brdnr] = NULL;
3749 kfree(brdp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003750}
3751
Jiri Slaby845bead2006-12-08 02:39:17 -08003752static struct pci_driver stli_pcidriver = {
3753 .name = "istallion",
3754 .id_table = istallion_pci_tbl,
3755 .probe = stli_pciprobe,
3756 .remove = __devexit_p(stli_pciremove)
3757};
Linus Torvalds1da177e2005-04-16 15:20:36 -07003758/*****************************************************************************/
3759
3760/*
3761 * Allocate a new board structure. Fill out the basic info in it.
3762 */
3763
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003764static struct stlibrd *stli_allocbrd(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003765{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003766 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003767
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003768 brdp = kzalloc(sizeof(struct stlibrd), GFP_KERNEL);
Tobias Klauserb0b4ed72006-03-31 02:30:56 -08003769 if (!brdp) {
Alan Coxa6614992009-01-02 13:46:50 +00003770 printk(KERN_ERR "istallion: failed to allocate memory "
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003771 "(size=%Zd)\n", sizeof(struct stlibrd));
Tobias Klauserb0b4ed72006-03-31 02:30:56 -08003772 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003773 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003774 brdp->magic = STLI_BOARDMAGIC;
Alan Cox4ac43602006-06-28 04:26:52 -07003775 return brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003776}
3777
3778/*****************************************************************************/
3779
3780/*
3781 * Scan through all the boards in the configuration and see what we
3782 * can find.
3783 */
3784
Al Viro6005e3e2008-11-22 17:34:14 +00003785static int __init stli_initbrds(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003786{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003787 struct stlibrd *brdp, *nxtbrdp;
3788 struct stlconf conf;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003789 unsigned int i, j, found = 0;
Jiri Slaby1328d732006-12-08 02:39:19 -08003790 int retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003791
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08003792 for (stli_nrbrds = 0; stli_nrbrds < ARRAY_SIZE(stli_brdsp);
3793 stli_nrbrds++) {
3794 memset(&conf, 0, sizeof(conf));
3795 if (stli_parsebrd(&conf, stli_brdsp[stli_nrbrds]) == 0)
3796 continue;
Alan Cox4ac43602006-06-28 04:26:52 -07003797 if ((brdp = stli_allocbrd()) == NULL)
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08003798 continue;
3799 brdp->brdnr = stli_nrbrds;
3800 brdp->brdtype = conf.brdtype;
3801 brdp->iobase = conf.ioaddr1;
3802 brdp->memaddr = conf.memaddr;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003803 if (stli_brdinit(brdp) < 0) {
3804 kfree(brdp);
3805 continue;
3806 }
Jiri Slabyb103b5c2006-12-08 02:39:21 -08003807 stli_brds[brdp->brdnr] = brdp;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003808 found++;
Jiri Slabyec3dde52006-12-08 02:39:26 -08003809
3810 for (i = 0; i < brdp->nrports; i++)
3811 tty_register_device(stli_serial,
3812 brdp->brdnr * STL_MAXPORTS + i, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003813 }
3814
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003815 retval = stli_findeisabrds();
3816 if (retval > 0)
3817 found += retval;
Jiri Slaby845bead2006-12-08 02:39:17 -08003818
Linus Torvalds1da177e2005-04-16 15:20:36 -07003819/*
3820 * All found boards are initialized. Now for a little optimization, if
3821 * no boards are sharing the "shared memory" regions then we can just
3822 * leave them all enabled. This is in fact the usual case.
3823 */
3824 stli_shared = 0;
3825 if (stli_nrbrds > 1) {
3826 for (i = 0; (i < stli_nrbrds); i++) {
3827 brdp = stli_brds[i];
Alan Cox4ac43602006-06-28 04:26:52 -07003828 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003829 continue;
3830 for (j = i + 1; (j < stli_nrbrds); j++) {
3831 nxtbrdp = stli_brds[j];
Alan Cox4ac43602006-06-28 04:26:52 -07003832 if (nxtbrdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003833 continue;
3834 if ((brdp->membase >= nxtbrdp->membase) &&
3835 (brdp->membase <= (nxtbrdp->membase +
3836 nxtbrdp->memsize - 1))) {
3837 stli_shared++;
3838 break;
3839 }
3840 }
3841 }
3842 }
3843
3844 if (stli_shared == 0) {
3845 for (i = 0; (i < stli_nrbrds); i++) {
3846 brdp = stli_brds[i];
Alan Cox4ac43602006-06-28 04:26:52 -07003847 if (brdp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003848 continue;
Alan Cox8a1e8032010-06-01 22:52:42 +02003849 if (test_bit(BST_FOUND, &brdp->state)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003850 EBRDENABLE(brdp);
3851 brdp->enable = NULL;
3852 brdp->disable = NULL;
3853 }
3854 }
3855 }
3856
Jiri Slaby140e92a2006-12-08 02:39:24 -08003857 retval = pci_register_driver(&stli_pcidriver);
3858 if (retval && found == 0) {
3859 printk(KERN_ERR "Neither isa nor eisa cards found nor pci "
3860 "driver can be registered!\n");
3861 goto err;
3862 }
3863
Alan Cox4ac43602006-06-28 04:26:52 -07003864 return 0;
Jiri Slaby8f8f5a52006-12-08 02:39:23 -08003865err:
3866 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003867}
3868
3869/*****************************************************************************/
3870
3871/*
3872 * Code to handle an "staliomem" read operation. This device is the
3873 * contents of the board shared memory. It is used for down loading
3874 * the slave image (and debugging :-)
3875 */
3876
3877static ssize_t stli_memread(struct file *fp, char __user *buf, size_t count, loff_t *offp)
3878{
Alan Cox4ac43602006-06-28 04:26:52 -07003879 unsigned long flags;
Al Viro29756fa2006-10-10 22:47:27 +01003880 void __iomem *memptr;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003881 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08003882 unsigned int brdnr;
3883 int size, n;
Alan Cox4ac43602006-06-28 04:26:52 -07003884 void *p;
3885 loff_t off = *offp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003886
Josef Sipeka7113a92006-12-08 02:36:55 -08003887 brdnr = iminor(fp->f_path.dentry->d_inode);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003888 if (brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07003889 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003890 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07003891 if (brdp == NULL)
3892 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003893 if (brdp->state == 0)
Alan Cox4ac43602006-06-28 04:26:52 -07003894 return -ENODEV;
3895 if (off >= brdp->memsize || off + count < off)
3896 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003897
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08003898 size = min(count, (size_t)(brdp->memsize - off));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003899
Alan Cox4ac43602006-06-28 04:26:52 -07003900 /*
3901 * Copy the data a page at a time
3902 */
3903
3904 p = (void *)__get_free_page(GFP_KERNEL);
3905 if(p == NULL)
3906 return -ENOMEM;
3907
Linus Torvalds1da177e2005-04-16 15:20:36 -07003908 while (size > 0) {
Alan Cox4ac43602006-06-28 04:26:52 -07003909 spin_lock_irqsave(&brd_lock, flags);
3910 EBRDENABLE(brdp);
Al Viro29756fa2006-10-10 22:47:27 +01003911 memptr = EBRDGETMEMPTR(brdp, off);
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08003912 n = min(size, (int)(brdp->pagesize - (((unsigned long) off) % brdp->pagesize)));
3913 n = min(n, (int)PAGE_SIZE);
Alan Cox4ac43602006-06-28 04:26:52 -07003914 memcpy_fromio(p, memptr, n);
3915 EBRDDISABLE(brdp);
3916 spin_unlock_irqrestore(&brd_lock, flags);
3917 if (copy_to_user(buf, p, n)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003918 count = -EFAULT;
3919 goto out;
3920 }
Alan Cox4ac43602006-06-28 04:26:52 -07003921 off += n;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003922 buf += n;
3923 size -= n;
3924 }
3925out:
Alan Cox4ac43602006-06-28 04:26:52 -07003926 *offp = off;
3927 free_page((unsigned long)p);
3928 return count;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003929}
3930
3931/*****************************************************************************/
3932
3933/*
3934 * Code to handle an "staliomem" write operation. This device is the
3935 * contents of the board shared memory. It is used for down loading
3936 * the slave image (and debugging :-)
Alan Cox4ac43602006-06-28 04:26:52 -07003937 *
3938 * FIXME: copy under lock
Linus Torvalds1da177e2005-04-16 15:20:36 -07003939 */
3940
3941static ssize_t stli_memwrite(struct file *fp, const char __user *buf, size_t count, loff_t *offp)
3942{
Alan Cox4ac43602006-06-28 04:26:52 -07003943 unsigned long flags;
Al Viro29756fa2006-10-10 22:47:27 +01003944 void __iomem *memptr;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08003945 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07003946 char __user *chbuf;
Jiri Slaby1328d732006-12-08 02:39:19 -08003947 unsigned int brdnr;
3948 int size, n;
Alan Cox4ac43602006-06-28 04:26:52 -07003949 void *p;
3950 loff_t off = *offp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003951
Josef Sipeka7113a92006-12-08 02:36:55 -08003952 brdnr = iminor(fp->f_path.dentry->d_inode);
Alan Cox4ac43602006-06-28 04:26:52 -07003953
Linus Torvalds1da177e2005-04-16 15:20:36 -07003954 if (brdnr >= stli_nrbrds)
Alan Cox4ac43602006-06-28 04:26:52 -07003955 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003956 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07003957 if (brdp == NULL)
3958 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003959 if (brdp->state == 0)
Alan Cox4ac43602006-06-28 04:26:52 -07003960 return -ENODEV;
3961 if (off >= brdp->memsize || off + count < off)
3962 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003963
3964 chbuf = (char __user *) buf;
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) {
Jiri Slabya3f8d9d2006-12-08 02:39:18 -08003976 n = min(size, (int)(brdp->pagesize - (((unsigned long) off) % brdp->pagesize)));
3977 n = min(n, (int)PAGE_SIZE);
Alan Cox4ac43602006-06-28 04:26:52 -07003978 if (copy_from_user(p, chbuf, n)) {
3979 if (count == 0)
3980 count = -EFAULT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003981 goto out;
3982 }
Alan Cox4ac43602006-06-28 04:26:52 -07003983 spin_lock_irqsave(&brd_lock, flags);
3984 EBRDENABLE(brdp);
Al Viro29756fa2006-10-10 22:47:27 +01003985 memptr = EBRDGETMEMPTR(brdp, off);
Alan Cox4ac43602006-06-28 04:26:52 -07003986 memcpy_toio(memptr, p, n);
3987 EBRDDISABLE(brdp);
3988 spin_unlock_irqrestore(&brd_lock, flags);
3989 off += n;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003990 chbuf += n;
3991 size -= n;
3992 }
3993out:
Alan Cox4ac43602006-06-28 04:26:52 -07003994 free_page((unsigned long) p);
3995 *offp = off;
3996 return count;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003997}
3998
3999/*****************************************************************************/
4000
4001/*
4002 * Return the board stats structure to user app.
4003 */
4004
4005static int stli_getbrdstats(combrd_t __user *bp)
4006{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004007 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08004008 unsigned int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004009
4010 if (copy_from_user(&stli_brdstats, bp, sizeof(combrd_t)))
4011 return -EFAULT;
4012 if (stli_brdstats.brd >= STL_MAXBRDS)
Alan Cox4ac43602006-06-28 04:26:52 -07004013 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004014 brdp = stli_brds[stli_brdstats.brd];
Alan Cox4ac43602006-06-28 04:26:52 -07004015 if (brdp == NULL)
4016 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004017
4018 memset(&stli_brdstats, 0, sizeof(combrd_t));
Alan Coxb4eda9c2010-06-01 22:52:41 +02004019
Linus Torvalds1da177e2005-04-16 15:20:36 -07004020 stli_brdstats.brd = brdp->brdnr;
4021 stli_brdstats.type = brdp->brdtype;
4022 stli_brdstats.hwid = 0;
4023 stli_brdstats.state = brdp->state;
4024 stli_brdstats.ioaddr = brdp->iobase;
4025 stli_brdstats.memaddr = brdp->memaddr;
4026 stli_brdstats.nrpanels = brdp->nrpanels;
4027 stli_brdstats.nrports = brdp->nrports;
4028 for (i = 0; (i < brdp->nrpanels); i++) {
4029 stli_brdstats.panels[i].panel = i;
4030 stli_brdstats.panels[i].hwid = brdp->panelids[i];
4031 stli_brdstats.panels[i].nrports = brdp->panels[i];
4032 }
4033
4034 if (copy_to_user(bp, &stli_brdstats, sizeof(combrd_t)))
4035 return -EFAULT;
Alan Cox4ac43602006-06-28 04:26:52 -07004036 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004037}
4038
4039/*****************************************************************************/
4040
4041/*
4042 * Resolve the referenced port number into a port struct pointer.
4043 */
4044
Jiri Slaby1328d732006-12-08 02:39:19 -08004045static struct stliport *stli_getport(unsigned int brdnr, unsigned int panelnr,
4046 unsigned int portnr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004047{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004048 struct stlibrd *brdp;
Jiri Slaby1328d732006-12-08 02:39:19 -08004049 unsigned int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004050
Jiri Slaby1328d732006-12-08 02:39:19 -08004051 if (brdnr >= STL_MAXBRDS)
Alan Cox4ac43602006-06-28 04:26:52 -07004052 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004053 brdp = stli_brds[brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07004054 if (brdp == NULL)
4055 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004056 for (i = 0; (i < panelnr); i++)
4057 portnr += brdp->panels[i];
Jiri Slaby1328d732006-12-08 02:39:19 -08004058 if (portnr >= brdp->nrports)
Alan Cox4ac43602006-06-28 04:26:52 -07004059 return NULL;
4060 return brdp->ports[portnr];
Linus Torvalds1da177e2005-04-16 15:20:36 -07004061}
4062
4063/*****************************************************************************/
4064
4065/*
4066 * Return the port stats structure to user app. A NULL port struct
4067 * pointer passed in means that we need to find out from the app
4068 * what port to get stats for (used through board control device).
4069 */
4070
Alan Coxd18a7502008-10-13 10:40:07 +01004071static int stli_portcmdstats(struct tty_struct *tty, struct stliport *portp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004072{
4073 unsigned long flags;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004074 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004075 int rc;
4076
4077 memset(&stli_comstats, 0, sizeof(comstats_t));
4078
Alan Cox4ac43602006-06-28 04:26:52 -07004079 if (portp == NULL)
4080 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004081 brdp = stli_brds[portp->brdnr];
Alan Cox4ac43602006-06-28 04:26:52 -07004082 if (brdp == NULL)
4083 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004084
Alan Coxb4eda9c2010-06-01 22:52:41 +02004085 mutex_lock(&portp->port.mutex);
Alan Cox8a1e8032010-06-01 22:52:42 +02004086 if (test_bit(BST_STARTED, &brdp->state)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004087 if ((rc = stli_cmdwait(brdp, portp, A_GETSTATS,
Alan Coxb4eda9c2010-06-01 22:52:41 +02004088 &stli_cdkstats, sizeof(asystats_t), 1)) < 0) {
4089 mutex_unlock(&portp->port.mutex);
Alan Cox4ac43602006-06-28 04:26:52 -07004090 return rc;
Alan Coxb4eda9c2010-06-01 22:52:41 +02004091 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004092 } else {
4093 memset(&stli_cdkstats, 0, sizeof(asystats_t));
4094 }
4095
4096 stli_comstats.brd = portp->brdnr;
4097 stli_comstats.panel = portp->panelnr;
4098 stli_comstats.port = portp->portnr;
4099 stli_comstats.state = portp->state;
Wang Chen42a77a12008-07-21 17:48:59 +08004100 stli_comstats.flags = portp->port.flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004101
Alan Cox4ac43602006-06-28 04:26:52 -07004102 spin_lock_irqsave(&brd_lock, flags);
Alan Coxd18a7502008-10-13 10:40:07 +01004103 if (tty != NULL) {
4104 if (portp->port.tty == tty) {
4105 stli_comstats.ttystate = tty->flags;
Alan Cox4ac43602006-06-28 04:26:52 -07004106 stli_comstats.rxbuffered = -1;
Alan Coxd18a7502008-10-13 10:40:07 +01004107 if (tty->termios != NULL) {
4108 stli_comstats.cflags = tty->termios->c_cflag;
4109 stli_comstats.iflags = tty->termios->c_iflag;
4110 stli_comstats.oflags = tty->termios->c_oflag;
4111 stli_comstats.lflags = tty->termios->c_lflag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004112 }
4113 }
4114 }
Alan Cox4ac43602006-06-28 04:26:52 -07004115 spin_unlock_irqrestore(&brd_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004116
4117 stli_comstats.txtotal = stli_cdkstats.txchars;
4118 stli_comstats.rxtotal = stli_cdkstats.rxchars + stli_cdkstats.ringover;
4119 stli_comstats.txbuffered = stli_cdkstats.txringq;
4120 stli_comstats.rxbuffered += stli_cdkstats.rxringq;
4121 stli_comstats.rxoverrun = stli_cdkstats.overruns;
4122 stli_comstats.rxparity = stli_cdkstats.parity;
4123 stli_comstats.rxframing = stli_cdkstats.framing;
4124 stli_comstats.rxlost = stli_cdkstats.ringover;
4125 stli_comstats.rxbreaks = stli_cdkstats.rxbreaks;
4126 stli_comstats.txbreaks = stli_cdkstats.txbreaks;
4127 stli_comstats.txxon = stli_cdkstats.txstart;
4128 stli_comstats.txxoff = stli_cdkstats.txstop;
4129 stli_comstats.rxxon = stli_cdkstats.rxstart;
4130 stli_comstats.rxxoff = stli_cdkstats.rxstop;
4131 stli_comstats.rxrtsoff = stli_cdkstats.rtscnt / 2;
4132 stli_comstats.rxrtson = stli_cdkstats.rtscnt - stli_comstats.rxrtsoff;
4133 stli_comstats.modem = stli_cdkstats.dcdcnt;
4134 stli_comstats.hwid = stli_cdkstats.hwid;
4135 stli_comstats.signals = stli_mktiocm(stli_cdkstats.signals);
Alan Coxb4eda9c2010-06-01 22:52:41 +02004136 mutex_unlock(&portp->port.mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004137
Alan Cox4ac43602006-06-28 04:26:52 -07004138 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004139}
4140
4141/*****************************************************************************/
4142
4143/*
4144 * Return the port stats structure to user app. A NULL port struct
4145 * pointer passed in means that we need to find out from the app
4146 * what port to get stats for (used through board control device).
4147 */
4148
Alan Coxd18a7502008-10-13 10:40:07 +01004149static int stli_getportstats(struct tty_struct *tty, struct stliport *portp,
4150 comstats_t __user *cp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004151{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004152 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07004153 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004154
4155 if (!portp) {
4156 if (copy_from_user(&stli_comstats, cp, sizeof(comstats_t)))
4157 return -EFAULT;
4158 portp = stli_getport(stli_comstats.brd, stli_comstats.panel,
4159 stli_comstats.port);
4160 if (!portp)
4161 return -ENODEV;
4162 }
4163
4164 brdp = stli_brds[portp->brdnr];
4165 if (!brdp)
4166 return -ENODEV;
4167
Alan Coxd18a7502008-10-13 10:40:07 +01004168 if ((rc = stli_portcmdstats(tty, portp)) < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004169 return rc;
4170
4171 return copy_to_user(cp, &stli_comstats, sizeof(comstats_t)) ?
4172 -EFAULT : 0;
4173}
4174
4175/*****************************************************************************/
4176
4177/*
4178 * Clear the port stats structure. We also return it zeroed out...
4179 */
4180
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004181static int stli_clrportstats(struct stliport *portp, comstats_t __user *cp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004182{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004183 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07004184 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004185
4186 if (!portp) {
4187 if (copy_from_user(&stli_comstats, cp, sizeof(comstats_t)))
4188 return -EFAULT;
4189 portp = stli_getport(stli_comstats.brd, stli_comstats.panel,
4190 stli_comstats.port);
4191 if (!portp)
4192 return -ENODEV;
4193 }
4194
4195 brdp = stli_brds[portp->brdnr];
4196 if (!brdp)
4197 return -ENODEV;
4198
Alan Coxb4eda9c2010-06-01 22:52:41 +02004199 mutex_lock(&portp->port.mutex);
4200
Alan Cox8a1e8032010-06-01 22:52:42 +02004201 if (test_bit(BST_STARTED, &brdp->state)) {
Alan Coxb4eda9c2010-06-01 22:52:41 +02004202 if ((rc = stli_cmdwait(brdp, portp, A_CLEARSTATS, NULL, 0, 0)) < 0) {
4203 mutex_unlock(&portp->port.mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004204 return rc;
Alan Coxb4eda9c2010-06-01 22:52:41 +02004205 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004206 }
4207
4208 memset(&stli_comstats, 0, sizeof(comstats_t));
4209 stli_comstats.brd = portp->brdnr;
4210 stli_comstats.panel = portp->panelnr;
4211 stli_comstats.port = portp->portnr;
Alan Coxb4eda9c2010-06-01 22:52:41 +02004212 mutex_unlock(&portp->port.mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004213
4214 if (copy_to_user(cp, &stli_comstats, sizeof(comstats_t)))
4215 return -EFAULT;
4216 return 0;
4217}
4218
4219/*****************************************************************************/
4220
4221/*
4222 * Return the entire driver ports structure to a user app.
4223 */
4224
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004225static int stli_getportstruct(struct stliport __user *arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004226{
Jiri Slaby1328d732006-12-08 02:39:19 -08004227 struct stliport stli_dummyport;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004228 struct stliport *portp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004229
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004230 if (copy_from_user(&stli_dummyport, arg, sizeof(struct stliport)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004231 return -EFAULT;
4232 portp = stli_getport(stli_dummyport.brdnr, stli_dummyport.panelnr,
4233 stli_dummyport.portnr);
4234 if (!portp)
4235 return -ENODEV;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004236 if (copy_to_user(arg, portp, sizeof(struct stliport)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004237 return -EFAULT;
4238 return 0;
4239}
4240
4241/*****************************************************************************/
4242
4243/*
4244 * Return the entire driver board structure to a user app.
4245 */
4246
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004247static int stli_getbrdstruct(struct stlibrd __user *arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004248{
Jiri Slaby1328d732006-12-08 02:39:19 -08004249 struct stlibrd stli_dummybrd;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004250 struct stlibrd *brdp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004251
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004252 if (copy_from_user(&stli_dummybrd, arg, sizeof(struct stlibrd)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004253 return -EFAULT;
Jiri Slaby1328d732006-12-08 02:39:19 -08004254 if (stli_dummybrd.brdnr >= STL_MAXBRDS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004255 return -ENODEV;
4256 brdp = stli_brds[stli_dummybrd.brdnr];
4257 if (!brdp)
4258 return -ENODEV;
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004259 if (copy_to_user(arg, brdp, sizeof(struct stlibrd)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004260 return -EFAULT;
4261 return 0;
4262}
4263
4264/*****************************************************************************/
4265
4266/*
4267 * The "staliomem" device is also required to do some special operations on
4268 * the board. We need to be able to send an interrupt to the board,
4269 * reset it, and start/stop it.
4270 */
4271
Alan Cox62687532009-10-13 16:34:06 +01004272static long stli_memioctl(struct file *fp, unsigned int cmd, unsigned long arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004273{
Jiri Slaby1f8ec432006-12-08 02:39:18 -08004274 struct stlibrd *brdp;
Alan Cox4ac43602006-06-28 04:26:52 -07004275 int brdnr, rc, done;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004276 void __user *argp = (void __user *)arg;
4277
Linus Torvalds1da177e2005-04-16 15:20:36 -07004278/*
4279 * First up handle the board independent ioctls.
4280 */
4281 done = 0;
4282 rc = 0;
4283
4284 switch (cmd) {
4285 case COM_GETPORTSTATS:
Alan Coxd18a7502008-10-13 10:40:07 +01004286 rc = stli_getportstats(NULL, NULL, argp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004287 done++;
4288 break;
4289 case COM_CLRPORTSTATS:
4290 rc = stli_clrportstats(NULL, argp);
4291 done++;
4292 break;
4293 case COM_GETBRDSTATS:
4294 rc = stli_getbrdstats(argp);
4295 done++;
4296 break;
4297 case COM_READPORT:
4298 rc = stli_getportstruct(argp);
4299 done++;
4300 break;
4301 case COM_READBOARD:
4302 rc = stli_getbrdstruct(argp);
4303 done++;
4304 break;
4305 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004306 if (done)
Alan Cox4ac43602006-06-28 04:26:52 -07004307 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004308
4309/*
4310 * Now handle the board specific ioctls. These all depend on the
4311 * minor number of the device they were called from.
4312 */
Alan Cox62687532009-10-13 16:34:06 +01004313 brdnr = iminor(fp->f_dentry->d_inode);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004314 if (brdnr >= STL_MAXBRDS)
Alan Cox4ac43602006-06-28 04:26:52 -07004315 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004316 brdp = stli_brds[brdnr];
4317 if (!brdp)
Alan Cox4ac43602006-06-28 04:26:52 -07004318 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004319 if (brdp->state == 0)
Alan Cox4ac43602006-06-28 04:26:52 -07004320 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004321
4322 switch (cmd) {
4323 case STL_BINTR:
4324 EBRDINTR(brdp);
4325 break;
4326 case STL_BSTART:
4327 rc = stli_startbrd(brdp);
4328 break;
4329 case STL_BSTOP:
Alan Cox8a1e8032010-06-01 22:52:42 +02004330 clear_bit(BST_STARTED, &brdp->state);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004331 break;
4332 case STL_BRESET:
Alan Cox8a1e8032010-06-01 22:52:42 +02004333 clear_bit(BST_STARTED, &brdp->state);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004334 EBRDRESET(brdp);
4335 if (stli_shared == 0) {
4336 if (brdp->reenable != NULL)
4337 (* brdp->reenable)(brdp);
4338 }
4339 break;
4340 default:
4341 rc = -ENOIOCTLCMD;
4342 break;
4343 }
Alan Cox4ac43602006-06-28 04:26:52 -07004344 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004345}
4346
Jeff Dikeb68e31d2006-10-02 02:17:18 -07004347static const struct tty_operations stli_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004348 .open = stli_open,
4349 .close = stli_close,
4350 .write = stli_write,
4351 .put_char = stli_putchar,
4352 .flush_chars = stli_flushchars,
4353 .write_room = stli_writeroom,
4354 .chars_in_buffer = stli_charsinbuffer,
4355 .ioctl = stli_ioctl,
4356 .set_termios = stli_settermios,
4357 .throttle = stli_throttle,
4358 .unthrottle = stli_unthrottle,
4359 .stop = stli_stop,
4360 .start = stli_start,
4361 .hangup = stli_hangup,
4362 .flush_buffer = stli_flushbuffer,
4363 .break_ctl = stli_breakctl,
4364 .wait_until_sent = stli_waituntilsent,
4365 .send_xchar = stli_sendxchar,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004366 .tiocmget = stli_tiocmget,
4367 .tiocmset = stli_tiocmset,
Alexey Dobriyan5bd6de72009-03-31 15:19:16 -07004368 .proc_fops = &stli_proc_fops,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004369};
4370
Alan Cox31f35932009-01-02 13:45:05 +00004371static const struct tty_port_operations stli_port_ops = {
4372 .carrier_raised = stli_carrier_raised,
Alan Coxfcc8ac12009-06-11 12:24:17 +01004373 .dtr_rts = stli_dtr_rts,
Alan Cox338818f2009-11-30 13:17:08 +00004374 .activate = stli_activate,
4375 .shutdown = stli_shutdown,
Alan Cox31f35932009-01-02 13:45:05 +00004376};
4377
Linus Torvalds1da177e2005-04-16 15:20:36 -07004378/*****************************************************************************/
Jiri Slabyf1cc54f2006-12-08 02:39:24 -08004379/*
4380 * Loadable module initialization stuff.
4381 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07004382
Jiri Slabyf2362c92006-12-08 02:39:25 -08004383static void istallion_cleanup_isa(void)
Jiri Slabyf1cc54f2006-12-08 02:39:24 -08004384{
4385 struct stlibrd *brdp;
4386 unsigned int j;
Jiri Slabyf1cc54f2006-12-08 02:39:24 -08004387
4388 for (j = 0; (j < stli_nrbrds); j++) {
Alan Cox8a1e8032010-06-01 22:52:42 +02004389 if ((brdp = stli_brds[j]) == NULL ||
4390 test_bit(BST_PROBED, &brdp->state))
Jiri Slabyf1cc54f2006-12-08 02:39:24 -08004391 continue;
4392
4393 stli_cleanup_ports(brdp);
4394
4395 iounmap(brdp->membase);
4396 if (brdp->iosize > 0)
4397 release_region(brdp->iobase, brdp->iosize);
4398 kfree(brdp);
4399 stli_brds[j] = NULL;
4400 }
4401}
4402
Jiri Slabyf2362c92006-12-08 02:39:25 -08004403static int __init istallion_module_init(void)
4404{
4405 unsigned int i;
4406 int retval;
4407
4408 printk(KERN_INFO "%s: version %s\n", stli_drvtitle, stli_drvversion);
4409
4410 spin_lock_init(&stli_lock);
4411 spin_lock_init(&brd_lock);
4412
4413 stli_txcookbuf = kmalloc(STLI_TXBUFSIZE, GFP_KERNEL);
4414 if (!stli_txcookbuf) {
Alan Coxa6614992009-01-02 13:46:50 +00004415 printk(KERN_ERR "istallion: failed to allocate memory "
Jiri Slabyf2362c92006-12-08 02:39:25 -08004416 "(size=%d)\n", STLI_TXBUFSIZE);
4417 retval = -ENOMEM;
4418 goto err;
4419 }
4420
4421 stli_serial = alloc_tty_driver(STL_MAXBRDS * STL_MAXPORTS);
4422 if (!stli_serial) {
4423 retval = -ENOMEM;
4424 goto err_free;
4425 }
4426
4427 stli_serial->owner = THIS_MODULE;
4428 stli_serial->driver_name = stli_drvname;
4429 stli_serial->name = stli_serialname;
4430 stli_serial->major = STL_SERIALMAJOR;
4431 stli_serial->minor_start = 0;
4432 stli_serial->type = TTY_DRIVER_TYPE_SERIAL;
4433 stli_serial->subtype = SERIAL_TYPE_NORMAL;
4434 stli_serial->init_termios = stli_deftermios;
Jiri Slabyec3dde52006-12-08 02:39:26 -08004435 stli_serial->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
Jiri Slabyf2362c92006-12-08 02:39:25 -08004436 tty_set_operations(stli_serial, &stli_ops);
4437
4438 retval = tty_register_driver(stli_serial);
4439 if (retval) {
Alan Coxa6614992009-01-02 13:46:50 +00004440 printk(KERN_ERR "istallion: failed to register serial driver\n");
Jiri Slabyf2362c92006-12-08 02:39:25 -08004441 goto err_ttyput;
4442 }
4443
4444 retval = stli_initbrds();
4445 if (retval)
4446 goto err_ttyunr;
4447
4448/*
4449 * Set up a character driver for the shared memory region. We need this
4450 * to down load the slave code image. Also it is a useful debugging tool.
4451 */
4452 retval = register_chrdev(STL_SIOMEMMAJOR, "staliomem", &stli_fsiomem);
4453 if (retval) {
Alan Coxa6614992009-01-02 13:46:50 +00004454 printk(KERN_ERR "istallion: failed to register serial memory "
Jiri Slabyf2362c92006-12-08 02:39:25 -08004455 "device\n");
4456 goto err_deinit;
4457 }
4458
4459 istallion_class = class_create(THIS_MODULE, "staliomem");
4460 for (i = 0; i < 4; i++)
Greg Kroah-Hartman03457cd2008-07-21 20:03:34 -07004461 device_create(istallion_class, NULL, MKDEV(STL_SIOMEMMAJOR, i),
4462 NULL, "staliomem%d", i);
Jiri Slabyf2362c92006-12-08 02:39:25 -08004463
4464 return 0;
4465err_deinit:
4466 pci_unregister_driver(&stli_pcidriver);
4467 istallion_cleanup_isa();
4468err_ttyunr:
4469 tty_unregister_driver(stli_serial);
4470err_ttyput:
4471 put_tty_driver(stli_serial);
4472err_free:
4473 kfree(stli_txcookbuf);
4474err:
4475 return retval;
4476}
4477
4478/*****************************************************************************/
4479
4480static void __exit istallion_module_exit(void)
4481{
4482 unsigned int j;
4483
4484 printk(KERN_INFO "Unloading %s: version %s\n", stli_drvtitle,
4485 stli_drvversion);
4486
4487 if (stli_timeron) {
4488 stli_timeron = 0;
4489 del_timer_sync(&stli_timerlist);
4490 }
4491
4492 unregister_chrdev(STL_SIOMEMMAJOR, "staliomem");
4493
4494 for (j = 0; j < 4; j++)
tonyj@suse.de07c015e2007-08-07 22:28:44 -07004495 device_destroy(istallion_class, MKDEV(STL_SIOMEMMAJOR, j));
Jiri Slabyf2362c92006-12-08 02:39:25 -08004496 class_destroy(istallion_class);
4497
4498 pci_unregister_driver(&stli_pcidriver);
4499 istallion_cleanup_isa();
4500
4501 tty_unregister_driver(stli_serial);
4502 put_tty_driver(stli_serial);
4503
4504 kfree(stli_txcookbuf);
4505}
4506
Jiri Slabyf1cc54f2006-12-08 02:39:24 -08004507module_init(istallion_module_init);
4508module_exit(istallion_module_exit);