KVM: nVMX: Fix returned value of MSR_IA32_VMX_VMCS_ENUM
[linux/fpc-iii.git] / drivers / staging / dgap / dgap.c
blob170d6f3e42218214bf869e15163d253aa4c98a82
1 /*
2 * Copyright 2003 Digi International (www.digi.com)
3 * Scott H Kilau <Scott_Kilau at digi dot com>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2, or (at your option)
8 * any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY, EXPRESS OR IMPLIED; without even the
12 * implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
13 * PURPOSE. See the GNU General Public License for more details.
18 * In the original out of kernel Digi dgap driver, firmware
19 * loading was done via user land to driver handshaking.
21 * For cards that support a concentrator (port expander),
22 * I believe the concentrator its self told the card which
23 * concentrator is actually attached and then that info
24 * was used to tell user land which concentrator firmware
25 * image was to be downloaded. I think even the BIOS or
26 * FEP images required could change with the connection
27 * of a particular concentrator.
29 * Since I have no access to any of these cards or
30 * concentrators, I cannot put the correct concentrator
31 * firmware file names into the firmware_info structure
32 * as is now done for the BIOS and FEP images.
34 * I think, but am not certain, that the cards supporting
35 * concentrators will function without them. So support
36 * of these cards has been left in this driver.
38 * In order to fully support those cards, they would
39 * either have to be acquired for dissection or maybe
40 * Digi International could provide some assistance.
42 #undef DIGI_CONCENTRATORS_SUPPORTED
44 #include <linux/kernel.h>
45 #include <linux/module.h>
46 #include <linux/pci.h>
47 #include <linux/delay.h> /* For udelay */
48 #include <linux/slab.h>
49 #include <linux/uaccess.h>
50 #include <linux/sched.h>
52 #include <linux/interrupt.h> /* For tasklet and interrupt structs/defines */
53 #include <linux/ctype.h>
54 #include <linux/tty.h>
55 #include <linux/tty_flip.h>
56 #include <linux/serial_reg.h>
57 #include <linux/io.h> /* For read[bwl]/write[bwl] */
59 #include <linux/string.h>
60 #include <linux/device.h>
61 #include <linux/kdev_t.h>
62 #include <linux/firmware.h>
64 #include "dgap.h"
66 MODULE_LICENSE("GPL");
67 MODULE_AUTHOR("Digi International, http://www.digi.com");
68 MODULE_DESCRIPTION("Driver for the Digi International EPCA PCI based product line");
69 MODULE_SUPPORTED_DEVICE("dgap");
71 static int dgap_start(void);
72 static void dgap_init_globals(void);
73 static int dgap_found_board(struct pci_dev *pdev, int id);
74 static void dgap_cleanup_board(struct board_t *brd);
75 static void dgap_poll_handler(ulong dummy);
76 static int dgap_init_pci(void);
77 static int dgap_init_one(struct pci_dev *pdev, const struct pci_device_id *ent);
78 static void dgap_remove_one(struct pci_dev *dev);
79 static int dgap_probe1(struct pci_dev *pdev, int card_type);
80 static int dgap_do_remap(struct board_t *brd);
81 static irqreturn_t dgap_intr(int irq, void *voidbrd);
83 static int dgap_tty_open(struct tty_struct *tty, struct file *file);
84 static void dgap_tty_close(struct tty_struct *tty, struct file *file);
85 static int dgap_block_til_ready(struct tty_struct *tty, struct file *file,
86 struct channel_t *ch);
87 static int dgap_tty_ioctl(struct tty_struct *tty, unsigned int cmd,
88 unsigned long arg);
89 static int dgap_tty_digigeta(struct tty_struct *tty,
90 struct digi_t __user *retinfo);
91 static int dgap_tty_digiseta(struct tty_struct *tty,
92 struct digi_t __user *new_info);
93 static int dgap_tty_digigetedelay(struct tty_struct *tty, int __user *retinfo);
94 static int dgap_tty_digisetedelay(struct tty_struct *tty, int __user *new_info);
95 static int dgap_tty_write_room(struct tty_struct *tty);
96 static int dgap_tty_chars_in_buffer(struct tty_struct *tty);
97 static void dgap_tty_start(struct tty_struct *tty);
98 static void dgap_tty_stop(struct tty_struct *tty);
99 static void dgap_tty_throttle(struct tty_struct *tty);
100 static void dgap_tty_unthrottle(struct tty_struct *tty);
101 static void dgap_tty_flush_chars(struct tty_struct *tty);
102 static void dgap_tty_flush_buffer(struct tty_struct *tty);
103 static void dgap_tty_hangup(struct tty_struct *tty);
104 static int dgap_wait_for_drain(struct tty_struct *tty);
105 static int dgap_set_modem_info(struct tty_struct *tty, unsigned int command,
106 unsigned int __user *value);
107 static int dgap_get_modem_info(struct channel_t *ch,
108 unsigned int __user *value);
109 static int dgap_tty_digisetcustombaud(struct tty_struct *tty,
110 int __user *new_info);
111 static int dgap_tty_digigetcustombaud(struct tty_struct *tty,
112 int __user *retinfo);
113 static int dgap_tty_tiocmget(struct tty_struct *tty);
114 static int dgap_tty_tiocmset(struct tty_struct *tty, unsigned int set,
115 unsigned int clear);
116 static int dgap_tty_send_break(struct tty_struct *tty, int msec);
117 static void dgap_tty_wait_until_sent(struct tty_struct *tty, int timeout);
118 static int dgap_tty_write(struct tty_struct *tty, const unsigned char *buf,
119 int count);
120 static void dgap_tty_set_termios(struct tty_struct *tty,
121 struct ktermios *old_termios);
122 static int dgap_tty_put_char(struct tty_struct *tty, unsigned char c);
123 static void dgap_tty_send_xchar(struct tty_struct *tty, char ch);
125 static int dgap_tty_register(struct board_t *brd);
126 static int dgap_tty_init(struct board_t *);
127 static void dgap_tty_uninit(struct board_t *);
128 static void dgap_carrier(struct channel_t *ch);
129 static void dgap_input(struct channel_t *ch);
132 * Our function prototypes from dgap_fep5
134 static void dgap_cmdw_ext(struct channel_t *ch, u16 cmd, u16 word, uint ncmds);
135 static int dgap_event(struct board_t *bd);
137 static void dgap_poll_tasklet(unsigned long data);
138 static void dgap_cmdb(struct channel_t *ch, u8 cmd, u8 byte1,
139 u8 byte2, uint ncmds);
140 static void dgap_cmdw(struct channel_t *ch, u8 cmd, u16 word, uint ncmds);
141 static void dgap_wmove(struct channel_t *ch, char *buf, uint cnt);
142 static int dgap_param(struct tty_struct *tty);
143 static void dgap_parity_scan(struct channel_t *ch, unsigned char *cbuf,
144 unsigned char *fbuf, int *len);
145 static uint dgap_get_custom_baud(struct channel_t *ch);
146 static void dgap_firmware_reset_port(struct channel_t *ch);
149 * Function prototypes from dgap_parse.c.
151 static int dgap_gettok(char **in, struct cnode *p);
152 static char *dgap_getword(char **in);
153 static struct cnode *dgap_newnode(int t);
154 static int dgap_checknode(struct cnode *p);
155 static void dgap_err(char *s);
158 * Function prototypes from dgap_sysfs.h
160 struct board_t;
161 struct channel_t;
162 struct un_t;
163 struct pci_driver;
164 struct class_device;
166 static void dgap_create_ports_sysfiles(struct board_t *bd);
167 static void dgap_remove_ports_sysfiles(struct board_t *bd);
169 static int dgap_create_driver_sysfiles(struct pci_driver *);
170 static void dgap_remove_driver_sysfiles(struct pci_driver *);
172 static void dgap_create_tty_sysfs(struct un_t *un, struct device *c);
173 static void dgap_remove_tty_sysfs(struct device *c);
176 * Function prototypes from dgap_parse.h
178 static int dgap_parsefile(char **in, int remove);
179 static struct cnode *dgap_find_config(int type, int bus, int slot);
180 static uint dgap_config_get_num_prts(struct board_t *bd);
181 static char *dgap_create_config_string(struct board_t *bd, char *string);
182 static uint dgap_config_get_useintr(struct board_t *bd);
183 static uint dgap_config_get_altpin(struct board_t *bd);
185 static int dgap_ms_sleep(ulong ms);
186 static void dgap_do_bios_load(struct board_t *brd, const u8 *ubios, int len);
187 static void dgap_do_fep_load(struct board_t *brd, const u8 *ufep, int len);
188 #ifdef DIGI_CONCENTRATORS_SUPPORTED
189 static void dgap_do_conc_load(struct board_t *brd, u8 *uaddr, int len);
190 #endif
191 static int dgap_after_config_loaded(int board);
192 static int dgap_finalize_board_init(struct board_t *brd);
194 static void dgap_get_vpd(struct board_t *brd);
195 static void dgap_do_reset_board(struct board_t *brd);
196 static int dgap_test_bios(struct board_t *brd);
197 static int dgap_test_fep(struct board_t *brd);
198 static int dgap_tty_register_ports(struct board_t *brd);
199 static int dgap_firmware_load(struct pci_dev *pdev, int card_type);
201 static void dgap_cleanup_module(void);
203 module_exit(dgap_cleanup_module);
206 * File operations permitted on Control/Management major.
208 static const struct file_operations dgap_board_fops = {
209 .owner = THIS_MODULE,
212 static uint dgap_numboards;
213 static struct board_t *dgap_board[MAXBOARDS];
214 static ulong dgap_poll_counter;
215 static char *dgap_config_buf;
216 static int dgap_driver_state = DRIVER_INITIALIZED;
217 static wait_queue_head_t dgap_dl_wait;
218 static int dgap_poll_tick = 20; /* Poll interval - 20 ms */
220 static struct class *dgap_class;
222 static struct board_t *dgap_boards_by_major[256];
223 static uint dgap_count = 500;
226 * Poller stuff
228 static DEFINE_SPINLOCK(dgap_poll_lock); /* Poll scheduling lock */
229 static ulong dgap_poll_time; /* Time of next poll */
230 static uint dgap_poll_stop; /* Used to tell poller to stop */
231 static struct timer_list dgap_poll_timer;
234 SUPPORTED PRODUCTS
236 Card Model Number of Ports Interface
237 ----------------------------------------------------------------
238 Acceleport Xem 4 - 64 (EIA232 & EIA422)
239 Acceleport Xr 4 & 8 (EIA232)
240 Acceleport Xr 920 4 & 8 (EIA232)
241 Acceleport C/X 8 - 128 (EIA232)
242 Acceleport EPC/X 8 - 224 (EIA232)
243 Acceleport Xr/422 4 & 8 (EIA422)
244 Acceleport 2r/920 2 (EIA232)
245 Acceleport 4r/920 4 (EIA232)
246 Acceleport 8r/920 8 (EIA232)
248 IBM 8-Port Asynchronous PCI Adapter (EIA232)
249 IBM 128-Port Asynchronous PCI Adapter (EIA232 & EIA422)
252 static struct pci_device_id dgap_pci_tbl[] = {
253 { DIGI_VID, PCI_DEV_XEM_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
254 { DIGI_VID, PCI_DEV_CX_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
255 { DIGI_VID, PCI_DEV_CX_IBM_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2 },
256 { DIGI_VID, PCI_DEV_EPCJ_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 3 },
257 { DIGI_VID, PCI_DEV_920_2_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 4 },
258 { DIGI_VID, PCI_DEV_920_4_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 5 },
259 { DIGI_VID, PCI_DEV_920_8_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 6 },
260 { DIGI_VID, PCI_DEV_XR_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 7 },
261 { DIGI_VID, PCI_DEV_XRJ_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 8 },
262 { DIGI_VID, PCI_DEV_XR_422_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 9 },
263 { DIGI_VID, PCI_DEV_XR_IBM_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 10 },
264 { DIGI_VID, PCI_DEV_XR_SAIP_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 11 },
265 { DIGI_VID, PCI_DEV_XR_BULL_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 12 },
266 { DIGI_VID, PCI_DEV_920_8_HP_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 13 },
267 { DIGI_VID, PCI_DEV_XEM_HP_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 14 },
268 {0,} /* 0 terminated list. */
270 MODULE_DEVICE_TABLE(pci, dgap_pci_tbl);
273 * A generic list of Product names, PCI Vendor ID, and PCI Device ID.
275 struct board_id {
276 uint config_type;
277 u8 *name;
278 uint maxports;
279 uint dpatype;
282 static struct board_id dgap_ids[] = {
283 { PPCM, PCI_DEV_XEM_NAME, 64, (T_PCXM|T_PCLITE|T_PCIBUS) },
284 { PCX, PCI_DEV_CX_NAME, 128, (T_CX|T_PCIBUS) },
285 { PCX, PCI_DEV_CX_IBM_NAME, 128, (T_CX|T_PCIBUS) },
286 { PEPC, PCI_DEV_EPCJ_NAME, 224, (T_EPC|T_PCIBUS) },
287 { APORT2_920P, PCI_DEV_920_2_NAME, 2, (T_PCXR|T_PCLITE|T_PCIBUS) },
288 { APORT4_920P, PCI_DEV_920_4_NAME, 4, (T_PCXR|T_PCLITE|T_PCIBUS) },
289 { APORT8_920P, PCI_DEV_920_8_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
290 { PAPORT8, PCI_DEV_XR_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
291 { PAPORT8, PCI_DEV_XRJ_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
292 { PAPORT8, PCI_DEV_XR_422_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
293 { PAPORT8, PCI_DEV_XR_IBM_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
294 { PAPORT8, PCI_DEV_XR_SAIP_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
295 { PAPORT8, PCI_DEV_XR_BULL_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
296 { APORT8_920P, PCI_DEV_920_8_HP_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
297 { PPCM, PCI_DEV_XEM_HP_NAME, 64, (T_PCXM|T_PCLITE|T_PCIBUS) },
298 {0,} /* 0 terminated list. */
301 static struct pci_driver dgap_driver = {
302 .name = "dgap",
303 .probe = dgap_init_one,
304 .id_table = dgap_pci_tbl,
305 .remove = dgap_remove_one,
308 struct firmware_info {
309 u8 *conf_name; /* dgap.conf */
310 u8 *bios_name; /* BIOS filename */
311 u8 *fep_name; /* FEP filename */
312 u8 *con_name; /* Concentrator filename FIXME*/
313 int num; /* sequence number */
317 * Firmware - BIOS, FEP, and CONC filenames
319 static struct firmware_info fw_info[] = {
320 { "dgap/dgap.conf", "dgap/sxbios.bin", "dgap/sxfep.bin", NULL, 0 },
321 { "dgap/dgap.conf", "dgap/cxpbios.bin", "dgap/cxpfep.bin", NULL, 1 },
322 { "dgap/dgap.conf", "dgap/cxpbios.bin", "dgap/cxpfep.bin", NULL, 2 },
323 { "dgap/dgap.conf", "dgap/pcibios.bin", "dgap/pcifep.bin", NULL, 3 },
324 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 4 },
325 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 5 },
326 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 6 },
327 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 7 },
328 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 8 },
329 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 9 },
330 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 10 },
331 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 11 },
332 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 12 },
333 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", NULL, 13 },
334 { "dgap/dgap.conf", "dgap/sxbios.bin", "dgap/sxfep.bin", NULL, 14 },
335 {NULL,}
339 * Default transparent print information.
341 static struct digi_t dgap_digi_init = {
342 .digi_flags = DIGI_COOK, /* Flags */
343 .digi_maxcps = 100, /* Max CPS */
344 .digi_maxchar = 50, /* Max chars in print queue */
345 .digi_bufsize = 100, /* Printer buffer size */
346 .digi_onlen = 4, /* size of printer on string */
347 .digi_offlen = 4, /* size of printer off string */
348 .digi_onstr = "\033[5i", /* ANSI printer on string ] */
349 .digi_offstr = "\033[4i", /* ANSI printer off string ] */
350 .digi_term = "ansi" /* default terminal type */
354 * Define a local default termios struct. All ports will be created
355 * with this termios initially.
357 * This defines a raw port at 9600 baud, 8 data bits, no parity,
358 * 1 stop bit.
361 static struct ktermios dgap_default_termios = {
362 .c_iflag = (DEFAULT_IFLAGS), /* iflags */
363 .c_oflag = (DEFAULT_OFLAGS), /* oflags */
364 .c_cflag = (DEFAULT_CFLAGS), /* cflags */
365 .c_lflag = (DEFAULT_LFLAGS), /* lflags */
366 .c_cc = INIT_C_CC,
367 .c_line = 0,
370 static const struct tty_operations dgap_tty_ops = {
371 .open = dgap_tty_open,
372 .close = dgap_tty_close,
373 .write = dgap_tty_write,
374 .write_room = dgap_tty_write_room,
375 .flush_buffer = dgap_tty_flush_buffer,
376 .chars_in_buffer = dgap_tty_chars_in_buffer,
377 .flush_chars = dgap_tty_flush_chars,
378 .ioctl = dgap_tty_ioctl,
379 .set_termios = dgap_tty_set_termios,
380 .stop = dgap_tty_stop,
381 .start = dgap_tty_start,
382 .throttle = dgap_tty_throttle,
383 .unthrottle = dgap_tty_unthrottle,
384 .hangup = dgap_tty_hangup,
385 .put_char = dgap_tty_put_char,
386 .tiocmget = dgap_tty_tiocmget,
387 .tiocmset = dgap_tty_tiocmset,
388 .break_ctl = dgap_tty_send_break,
389 .wait_until_sent = dgap_tty_wait_until_sent,
390 .send_xchar = dgap_tty_send_xchar
394 * Our needed internal static variables from dgap_parse.c
396 static struct cnode dgap_head;
397 #define MAXCWORD 200
398 static char dgap_cword[MAXCWORD];
400 struct toklist {
401 int token;
402 char *string;
405 static struct toklist dgap_tlist[] = {
406 { BEGIN, "config_begin" },
407 { END, "config_end" },
408 { BOARD, "board" },
409 { PCX, "Digi_AccelePort_C/X_PCI" },
410 { PEPC, "Digi_AccelePort_EPC/X_PCI" },
411 { PPCM, "Digi_AccelePort_Xem_PCI" },
412 { APORT2_920P, "Digi_AccelePort_2r_920_PCI" },
413 { APORT4_920P, "Digi_AccelePort_4r_920_PCI" },
414 { APORT8_920P, "Digi_AccelePort_8r_920_PCI" },
415 { PAPORT4, "Digi_AccelePort_4r_PCI(EIA-232/RS-422)" },
416 { PAPORT8, "Digi_AccelePort_8r_PCI(EIA-232/RS-422)" },
417 { IO, "io" },
418 { PCIINFO, "pciinfo" },
419 { LINE, "line" },
420 { CONC, "conc" },
421 { CONC, "concentrator" },
422 { CX, "cx" },
423 { CX, "ccon" },
424 { EPC, "epccon" },
425 { EPC, "epc" },
426 { MOD, "module" },
427 { ID, "id" },
428 { STARTO, "start" },
429 { SPEED, "speed" },
430 { CABLE, "cable" },
431 { CONNECT, "connect" },
432 { METHOD, "method" },
433 { STATUS, "status" },
434 { CUSTOM, "Custom" },
435 { BASIC, "Basic" },
436 { MEM, "mem" },
437 { MEM, "memory" },
438 { PORTS, "ports" },
439 { MODEM, "modem" },
440 { NPORTS, "nports" },
441 { TTYN, "ttyname" },
442 { CU, "cuname" },
443 { PRINT, "prname" },
444 { CMAJOR, "major" },
445 { ALTPIN, "altpin" },
446 { USEINTR, "useintr" },
447 { TTSIZ, "ttysize" },
448 { CHSIZ, "chsize" },
449 { BSSIZ, "boardsize" },
450 { UNTSIZ, "schedsize" },
451 { F2SIZ, "f2200size" },
452 { VPSIZ, "vpixsize" },
453 { 0, NULL }
456 /************************************************************************
458 * Driver load/unload functions
460 ************************************************************************/
463 * init_module()
465 * Module load. This is where it all starts.
467 static int dgap_init_module(void)
469 int rc;
471 pr_info("%s, Digi International Part Number %s\n", DG_NAME, DG_PART);
473 rc = dgap_start();
474 if (rc)
475 return rc;
477 rc = dgap_init_pci();
478 if (rc)
479 goto err_cleanup;
481 rc = dgap_create_driver_sysfiles(&dgap_driver);
482 if (rc)
483 goto err_cleanup;
485 dgap_driver_state = DRIVER_READY;
487 return 0;
489 err_cleanup:
491 dgap_cleanup_module();
493 return rc;
495 module_init(dgap_init_module);
498 * Start of driver.
500 static int dgap_start(void)
502 int rc;
503 unsigned long flags;
504 struct device *device;
507 * make sure that the globals are
508 * init'd before we do anything else
510 dgap_init_globals();
512 dgap_numboards = 0;
514 pr_info("For the tools package please visit http://www.digi.com\n");
517 * Register our base character device into the kernel.
521 * Register management/dpa devices
523 rc = register_chrdev(DIGI_DGAP_MAJOR, "dgap", &dgap_board_fops);
524 if (rc < 0)
525 return rc;
527 dgap_class = class_create(THIS_MODULE, "dgap_mgmt");
528 if (IS_ERR(dgap_class)) {
529 rc = PTR_ERR(dgap_class);
530 goto failed_class;
533 device = device_create(dgap_class, NULL,
534 MKDEV(DIGI_DGAP_MAJOR, 0),
535 NULL, "dgap_mgmt");
536 if (IS_ERR(device)) {
537 rc = PTR_ERR(device);
538 goto failed_device;
541 /* Start the poller */
542 spin_lock_irqsave(&dgap_poll_lock, flags);
543 init_timer(&dgap_poll_timer);
544 dgap_poll_timer.function = dgap_poll_handler;
545 dgap_poll_timer.data = 0;
546 dgap_poll_time = jiffies + dgap_jiffies_from_ms(dgap_poll_tick);
547 dgap_poll_timer.expires = dgap_poll_time;
548 spin_unlock_irqrestore(&dgap_poll_lock, flags);
550 add_timer(&dgap_poll_timer);
552 return rc;
554 failed_device:
555 class_destroy(dgap_class);
556 failed_class:
557 unregister_chrdev(DIGI_DGAP_MAJOR, "dgap");
558 return rc;
562 * Register pci driver, and return how many boards we have.
564 static int dgap_init_pci(void)
566 return pci_register_driver(&dgap_driver);
569 static int dgap_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
571 int rc;
573 if (dgap_numboards >= MAXBOARDS)
574 return -EPERM;
576 rc = pci_enable_device(pdev);
577 if (rc)
578 return -EIO;
580 rc = dgap_probe1(pdev, ent->driver_data);
581 if (rc)
582 return rc;
584 dgap_numboards++;
585 return dgap_firmware_load(pdev, ent->driver_data);
588 static int dgap_probe1(struct pci_dev *pdev, int card_type)
590 return dgap_found_board(pdev, card_type);
593 static void dgap_remove_one(struct pci_dev *dev)
595 /* Do Nothing */
599 * dgap_cleanup_module()
601 * Module unload. This is where it all ends.
603 static void dgap_cleanup_module(void)
605 int i;
606 ulong lock_flags;
608 spin_lock_irqsave(&dgap_poll_lock, lock_flags);
609 dgap_poll_stop = 1;
610 spin_unlock_irqrestore(&dgap_poll_lock, lock_flags);
612 /* Turn off poller right away. */
613 del_timer_sync(&dgap_poll_timer);
615 dgap_remove_driver_sysfiles(&dgap_driver);
617 device_destroy(dgap_class, MKDEV(DIGI_DGAP_MAJOR, 0));
618 class_destroy(dgap_class);
619 unregister_chrdev(DIGI_DGAP_MAJOR, "dgap");
621 for (i = 0; i < dgap_numboards; ++i) {
622 dgap_remove_ports_sysfiles(dgap_board[i]);
623 dgap_tty_uninit(dgap_board[i]);
624 dgap_cleanup_board(dgap_board[i]);
627 if (dgap_numboards)
628 pci_unregister_driver(&dgap_driver);
632 * dgap_cleanup_board()
634 * Free all the memory associated with a board
636 static void dgap_cleanup_board(struct board_t *brd)
638 int i;
640 if (!brd || brd->magic != DGAP_BOARD_MAGIC)
641 return;
643 if (brd->intr_used && brd->irq)
644 free_irq(brd->irq, brd);
646 tasklet_kill(&brd->helper_tasklet);
648 if (brd->re_map_port) {
649 release_mem_region(brd->membase + 0x200000, 0x200000);
650 iounmap(brd->re_map_port);
651 brd->re_map_port = NULL;
654 if (brd->re_map_membase) {
655 release_mem_region(brd->membase, 0x200000);
656 iounmap(brd->re_map_membase);
657 brd->re_map_membase = NULL;
660 /* Free all allocated channels structs */
661 for (i = 0; i < MAXPORTS ; i++)
662 kfree(brd->channels[i]);
664 kfree(brd->flipbuf);
665 kfree(brd->flipflagbuf);
667 dgap_board[brd->boardnum] = NULL;
669 kfree(brd);
673 * dgap_found_board()
675 * A board has been found, init it.
677 static int dgap_found_board(struct pci_dev *pdev, int id)
679 struct board_t *brd;
680 unsigned int pci_irq;
681 int i;
683 /* get the board structure and prep it */
684 brd = kzalloc(sizeof(struct board_t), GFP_KERNEL);
685 if (!brd)
686 return -ENOMEM;
688 dgap_board[dgap_numboards] = brd;
690 /* store the info for the board we've found */
691 brd->magic = DGAP_BOARD_MAGIC;
692 brd->boardnum = dgap_numboards;
693 brd->firstminor = 0;
694 brd->vendor = dgap_pci_tbl[id].vendor;
695 brd->device = dgap_pci_tbl[id].device;
696 brd->pdev = pdev;
697 brd->pci_bus = pdev->bus->number;
698 brd->pci_slot = PCI_SLOT(pdev->devfn);
699 brd->name = dgap_ids[id].name;
700 brd->maxports = dgap_ids[id].maxports;
701 brd->type = dgap_ids[id].config_type;
702 brd->dpatype = dgap_ids[id].dpatype;
703 brd->dpastatus = BD_NOFEP;
704 init_waitqueue_head(&brd->state_wait);
706 spin_lock_init(&brd->bd_lock);
708 brd->runwait = 0;
709 brd->inhibit_poller = FALSE;
710 brd->wait_for_bios = 0;
711 brd->wait_for_fep = 0;
713 for (i = 0; i < MAXPORTS; i++)
714 brd->channels[i] = NULL;
716 /* store which card & revision we have */
717 pci_read_config_word(pdev, PCI_SUBSYSTEM_VENDOR_ID, &brd->subvendor);
718 pci_read_config_word(pdev, PCI_SUBSYSTEM_ID, &brd->subdevice);
719 pci_read_config_byte(pdev, PCI_REVISION_ID, &brd->rev);
721 pci_irq = pdev->irq;
722 brd->irq = pci_irq;
724 /* get the PCI Base Address Registers */
726 /* Xr Jupiter and EPC use BAR 2 */
727 if (brd->device == PCI_DEV_XRJ_DID || brd->device == PCI_DEV_EPCJ_DID) {
728 brd->membase = pci_resource_start(pdev, 2);
729 brd->membase_end = pci_resource_end(pdev, 2);
731 /* Everyone else uses BAR 0 */
732 else {
733 brd->membase = pci_resource_start(pdev, 0);
734 brd->membase_end = pci_resource_end(pdev, 0);
737 if (!brd->membase)
738 return -ENODEV;
740 if (brd->membase & 1)
741 brd->membase &= ~3;
742 else
743 brd->membase &= ~15;
746 * On the PCI boards, there is no IO space allocated
747 * The I/O registers will be in the first 3 bytes of the
748 * upper 2MB of the 4MB memory space. The board memory
749 * will be mapped into the low 2MB of the 4MB memory space
751 brd->port = brd->membase + PCI_IO_OFFSET;
752 brd->port_end = brd->port + PCI_IO_SIZE;
755 * Special initialization for non-PLX boards
757 if (brd->device != PCI_DEV_XRJ_DID && brd->device != PCI_DEV_EPCJ_DID) {
758 unsigned short cmd;
760 pci_write_config_byte(pdev, 0x40, 0);
761 pci_write_config_byte(pdev, 0x46, 0);
763 /* Limit burst length to 2 doubleword transactions */
764 pci_write_config_byte(pdev, 0x42, 1);
767 * Enable IO and mem if not already done.
768 * This was needed for support on Itanium.
770 pci_read_config_word(pdev, PCI_COMMAND, &cmd);
771 cmd |= (PCI_COMMAND_IO | PCI_COMMAND_MEMORY);
772 pci_write_config_word(pdev, PCI_COMMAND, cmd);
775 /* init our poll helper tasklet */
776 tasklet_init(&brd->helper_tasklet, dgap_poll_tasklet,
777 (unsigned long) brd);
779 i = dgap_do_remap(brd);
780 if (i)
781 brd->state = BOARD_FAILED;
783 pr_info("dgap: board %d: %s (rev %d), irq %ld\n",
784 dgap_numboards, brd->name, brd->rev, brd->irq);
786 return 0;
790 static int dgap_finalize_board_init(struct board_t *brd)
792 int rc;
794 if (!brd || brd->magic != DGAP_BOARD_MAGIC)
795 return -ENODEV;
797 brd->use_interrupts = dgap_config_get_useintr(brd);
800 * Set up our interrupt handler if we are set to do interrupts.
802 if (brd->use_interrupts && brd->irq) {
804 rc = request_irq(brd->irq, dgap_intr, IRQF_SHARED, "DGAP", brd);
806 if (rc)
807 brd->intr_used = 0;
808 else
809 brd->intr_used = 1;
810 } else {
811 brd->intr_used = 0;
814 return 0;
817 static int dgap_firmware_load(struct pci_dev *pdev, int card_type)
819 struct board_t *brd = dgap_board[dgap_numboards - 1];
820 const struct firmware *fw;
821 char *tmp_ptr;
822 int ret;
824 dgap_get_vpd(brd);
825 dgap_do_reset_board(brd);
827 if ((fw_info[card_type].conf_name) && !dgap_config_buf) {
828 ret = request_firmware(&fw, fw_info[card_type].conf_name,
829 &pdev->dev);
830 if (ret) {
831 pr_err("dgap: config file %s not found\n",
832 fw_info[card_type].conf_name);
833 return ret;
836 dgap_config_buf = kzalloc(fw->size + 1, GFP_KERNEL);
837 if (!dgap_config_buf) {
838 release_firmware(fw);
839 return -ENOMEM;
842 memcpy(dgap_config_buf, fw->data, fw->size);
843 release_firmware(fw);
846 * preserve dgap_config_buf
847 * as dgap_parsefile would
848 * otherwise alter it.
850 tmp_ptr = dgap_config_buf;
852 if (dgap_parsefile(&tmp_ptr, TRUE) != 0) {
853 kfree(dgap_config_buf);
854 return -EINVAL;
856 kfree(dgap_config_buf);
859 ret = dgap_after_config_loaded(brd->boardnum);
860 if (ret)
861 return ret;
863 * Match this board to a config the user created for us.
865 brd->bd_config =
866 dgap_find_config(brd->type, brd->pci_bus, brd->pci_slot);
869 * Because the 4 port Xr products share the same PCI ID
870 * as the 8 port Xr products, if we receive a NULL config
871 * back, and this is a PAPORT8 board, retry with a
872 * PAPORT4 attempt as well.
874 if (brd->type == PAPORT8 && !brd->bd_config)
875 brd->bd_config =
876 dgap_find_config(PAPORT4, brd->pci_bus, brd->pci_slot);
878 if (!brd->bd_config) {
879 pr_err("dgap: No valid configuration found\n");
880 return -EINVAL;
883 ret = dgap_tty_register(brd);
884 if (ret)
885 return ret;
887 ret = dgap_finalize_board_init(brd);
888 if (ret)
889 return ret;
891 if (fw_info[card_type].bios_name) {
892 ret = request_firmware(&fw, fw_info[card_type].bios_name,
893 &pdev->dev);
894 if (ret) {
895 pr_err("dgap: bios file %s not found\n",
896 fw_info[card_type].bios_name);
897 return ret;
899 dgap_do_bios_load(brd, fw->data, fw->size);
900 release_firmware(fw);
902 /* Wait for BIOS to test board... */
903 ret = dgap_test_bios(brd);
904 if (ret)
905 return ret;
908 if (fw_info[card_type].fep_name) {
909 ret = request_firmware(&fw, fw_info[card_type].fep_name,
910 &pdev->dev);
911 if (ret) {
912 pr_err("dgap: fep file %s not found\n",
913 fw_info[card_type].fep_name);
914 return ret;
916 dgap_do_fep_load(brd, fw->data, fw->size);
917 release_firmware(fw);
919 /* Wait for FEP to load on board... */
920 ret = dgap_test_fep(brd);
921 if (ret)
922 return ret;
925 #ifdef DIGI_CONCENTRATORS_SUPPORTED
927 * If this is a CX or EPCX, we need to see if the firmware
928 * is requesting a concentrator image from us.
930 if ((bd->type == PCX) || (bd->type == PEPC)) {
931 chk_addr = (u16 *) (vaddr + DOWNREQ);
932 /* Nonzero if FEP is requesting concentrator image. */
933 check = readw(chk_addr);
934 vaddr = brd->re_map_membase;
937 if (fw_info[card_type].con_name && check && vaddr) {
938 ret = request_firmware(&fw, fw_info[card_type].con_name,
939 &pdev->dev);
940 if (ret) {
941 pr_err("dgap: conc file %s not found\n",
942 fw_info[card_type].con_name);
943 return ret;
945 /* Put concentrator firmware loading code here */
946 offset = readw((u16 *) (vaddr + DOWNREQ));
947 memcpy_toio(offset, fw->data, fw->size);
949 dgap_do_conc_load(brd, (char *)fw->data, fw->size)
950 release_firmware(fw);
952 #endif
954 * Do tty device initialization.
956 ret = dgap_tty_init(brd);
957 if (ret < 0) {
958 dgap_tty_uninit(brd);
959 return ret;
962 ret = dgap_tty_register_ports(brd);
963 if (ret)
964 return ret;
966 brd->state = BOARD_READY;
967 brd->dpastatus = BD_RUNNING;
969 return 0;
973 * Remap PCI memory.
975 static int dgap_do_remap(struct board_t *brd)
977 if (!brd || brd->magic != DGAP_BOARD_MAGIC)
978 return -EIO;
980 if (!request_mem_region(brd->membase, 0x200000, "dgap"))
981 return -ENOMEM;
983 if (!request_mem_region(brd->membase + PCI_IO_OFFSET, 0x200000,
984 "dgap")) {
985 release_mem_region(brd->membase, 0x200000);
986 return -ENOMEM;
989 brd->re_map_membase = ioremap(brd->membase, 0x200000);
990 if (!brd->re_map_membase) {
991 release_mem_region(brd->membase, 0x200000);
992 release_mem_region(brd->membase + PCI_IO_OFFSET, 0x200000);
993 return -ENOMEM;
996 brd->re_map_port = ioremap((brd->membase + PCI_IO_OFFSET), 0x200000);
997 if (!brd->re_map_port) {
998 release_mem_region(brd->membase, 0x200000);
999 release_mem_region(brd->membase + PCI_IO_OFFSET, 0x200000);
1000 iounmap(brd->re_map_membase);
1001 return -ENOMEM;
1004 return 0;
1007 /*****************************************************************************
1009 * Function:
1011 * dgap_poll_handler
1013 * Author:
1015 * Scott H Kilau
1017 * Parameters:
1019 * dummy -- ignored
1021 * Return Values:
1023 * none
1025 * Description:
1027 * As each timer expires, it determines (a) whether the "transmit"
1028 * waiter needs to be woken up, and (b) whether the poller needs to
1029 * be rescheduled.
1031 ******************************************************************************/
1033 static void dgap_poll_handler(ulong dummy)
1035 int i;
1036 struct board_t *brd;
1037 unsigned long lock_flags;
1038 ulong new_time;
1040 dgap_poll_counter++;
1043 * Do not start the board state machine until
1044 * driver tells us its up and running, and has
1045 * everything it needs.
1047 if (dgap_driver_state != DRIVER_READY)
1048 goto schedule_poller;
1051 * If we have just 1 board, or the system is not SMP,
1052 * then use the typical old style poller.
1053 * Otherwise, use our new tasklet based poller, which should
1054 * speed things up for multiple boards.
1056 if ((dgap_numboards == 1) || (num_online_cpus() <= 1)) {
1057 for (i = 0; i < dgap_numboards; i++) {
1059 brd = dgap_board[i];
1061 if (brd->state == BOARD_FAILED)
1062 continue;
1063 if (!brd->intr_running)
1064 /* Call the real board poller directly */
1065 dgap_poll_tasklet((unsigned long) brd);
1067 } else {
1069 * Go thru each board, kicking off a
1070 * tasklet for each if needed
1072 for (i = 0; i < dgap_numboards; i++) {
1073 brd = dgap_board[i];
1076 * Attempt to grab the board lock.
1078 * If we can't get it, no big deal, the next poll
1079 * will get it. Basically, I just really don't want
1080 * to spin in here, because I want to kick off my
1081 * tasklets as fast as I can, and then get out the
1082 * poller.
1084 if (!spin_trylock(&brd->bd_lock))
1085 continue;
1088 * If board is in a failed state, don't bother
1089 * scheduling a tasklet
1091 if (brd->state == BOARD_FAILED) {
1092 spin_unlock(&brd->bd_lock);
1093 continue;
1096 /* Schedule a poll helper task */
1097 if (!brd->intr_running)
1098 tasklet_schedule(&brd->helper_tasklet);
1101 * Can't do DGAP_UNLOCK here, as we don't have
1102 * lock_flags because we did a trylock above.
1104 spin_unlock(&brd->bd_lock);
1108 schedule_poller:
1111 * Schedule ourself back at the nominal wakeup interval.
1113 spin_lock_irqsave(&dgap_poll_lock, lock_flags);
1114 dgap_poll_time += dgap_jiffies_from_ms(dgap_poll_tick);
1116 new_time = dgap_poll_time - jiffies;
1118 if ((ulong) new_time >= 2 * dgap_poll_tick) {
1119 dgap_poll_time =
1120 jiffies + dgap_jiffies_from_ms(dgap_poll_tick);
1123 dgap_poll_timer.function = dgap_poll_handler;
1124 dgap_poll_timer.data = 0;
1125 dgap_poll_timer.expires = dgap_poll_time;
1126 spin_unlock_irqrestore(&dgap_poll_lock, lock_flags);
1128 if (!dgap_poll_stop)
1129 add_timer(&dgap_poll_timer);
1133 * dgap_intr()
1135 * Driver interrupt handler.
1137 static irqreturn_t dgap_intr(int irq, void *voidbrd)
1139 struct board_t *brd = (struct board_t *) voidbrd;
1141 if (!brd)
1142 return IRQ_NONE;
1145 * Check to make sure its for us.
1147 if (brd->magic != DGAP_BOARD_MAGIC)
1148 return IRQ_NONE;
1150 brd->intr_count++;
1153 * Schedule tasklet to run at a better time.
1155 tasklet_schedule(&brd->helper_tasklet);
1156 return IRQ_HANDLED;
1160 * dgap_init_globals()
1162 * This is where we initialize the globals from the static insmod
1163 * configuration variables. These are declared near the head of
1164 * this file.
1166 static void dgap_init_globals(void)
1168 int i;
1170 for (i = 0; i < MAXBOARDS; i++)
1171 dgap_board[i] = NULL;
1173 init_timer(&dgap_poll_timer);
1175 init_waitqueue_head(&dgap_dl_wait);
1178 /************************************************************************
1180 * Utility functions
1182 ************************************************************************/
1185 * dgap_ms_sleep()
1187 * Put the driver to sleep for x ms's
1189 * Returns 0 if timed out, !0 (showing signal) if interrupted by a signal.
1191 static int dgap_ms_sleep(ulong ms)
1193 current->state = TASK_INTERRUPTIBLE;
1194 schedule_timeout((ms * HZ) / 1000);
1195 return signal_pending(current);
1198 /************************************************************************
1200 * TTY Initialization/Cleanup Functions
1202 ************************************************************************/
1205 * dgap_tty_register()
1207 * Init the tty subsystem for this board.
1209 static int dgap_tty_register(struct board_t *brd)
1211 int rc;
1213 brd->serial_driver = tty_alloc_driver(MAXPORTS, 0);
1214 if (IS_ERR(brd->serial_driver))
1215 return PTR_ERR(brd->serial_driver);
1217 snprintf(brd->serial_name, MAXTTYNAMELEN, "tty_dgap_%d_",
1218 brd->boardnum);
1219 brd->serial_driver->name = brd->serial_name;
1220 brd->serial_driver->name_base = 0;
1221 brd->serial_driver->major = 0;
1222 brd->serial_driver->minor_start = 0;
1223 brd->serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
1224 brd->serial_driver->subtype = SERIAL_TYPE_NORMAL;
1225 brd->serial_driver->init_termios = dgap_default_termios;
1226 brd->serial_driver->driver_name = DRVSTR;
1227 brd->serial_driver->flags = (TTY_DRIVER_REAL_RAW |
1228 TTY_DRIVER_DYNAMIC_DEV |
1229 TTY_DRIVER_HARDWARE_BREAK);
1231 /* The kernel wants space to store pointers to tty_structs */
1232 brd->serial_driver->ttys =
1233 kzalloc(MAXPORTS * sizeof(struct tty_struct *), GFP_KERNEL);
1234 if (!brd->serial_driver->ttys) {
1235 rc = -ENOMEM;
1236 goto free_serial_drv;
1240 * Entry points for driver. Called by the kernel from
1241 * tty_io.c and n_tty.c.
1243 tty_set_operations(brd->serial_driver, &dgap_tty_ops);
1246 * If we're doing transparent print, we have to do all of the above
1247 * again, separately so we don't get the LD confused about what major
1248 * we are when we get into the dgap_tty_open() routine.
1250 brd->print_driver = tty_alloc_driver(MAXPORTS, 0);
1251 if (IS_ERR(brd->print_driver)) {
1252 rc = PTR_ERR(brd->print_driver);
1253 goto free_serial_drv;
1256 snprintf(brd->print_name, MAXTTYNAMELEN, "pr_dgap_%d_",
1257 brd->boardnum);
1258 brd->print_driver->name = brd->print_name;
1259 brd->print_driver->name_base = 0;
1260 brd->print_driver->major = 0;
1261 brd->print_driver->minor_start = 0;
1262 brd->print_driver->type = TTY_DRIVER_TYPE_SERIAL;
1263 brd->print_driver->subtype = SERIAL_TYPE_NORMAL;
1264 brd->print_driver->init_termios = dgap_default_termios;
1265 brd->print_driver->driver_name = DRVSTR;
1266 brd->print_driver->flags = (TTY_DRIVER_REAL_RAW |
1267 TTY_DRIVER_DYNAMIC_DEV |
1268 TTY_DRIVER_HARDWARE_BREAK);
1270 /* The kernel wants space to store pointers to tty_structs */
1271 brd->print_driver->ttys =
1272 kzalloc(MAXPORTS * sizeof(struct tty_struct *), GFP_KERNEL);
1273 if (!brd->print_driver->ttys) {
1274 rc = -ENOMEM;
1275 goto free_print_drv;
1279 * Entry points for driver. Called by the kernel from
1280 * tty_io.c and n_tty.c.
1282 tty_set_operations(brd->print_driver, &dgap_tty_ops);
1284 /* Register tty devices */
1285 rc = tty_register_driver(brd->serial_driver);
1286 if (rc < 0)
1287 goto free_print_drv;
1289 /* Register Transparent Print devices */
1290 rc = tty_register_driver(brd->print_driver);
1291 if (rc < 0)
1292 goto unregister_serial_drv;
1294 brd->dgap_major_serial_registered = TRUE;
1295 dgap_boards_by_major[brd->serial_driver->major] = brd;
1296 brd->dgap_serial_major = brd->serial_driver->major;
1298 brd->dgap_major_transparent_print_registered = TRUE;
1299 dgap_boards_by_major[brd->print_driver->major] = brd;
1300 brd->dgap_transparent_print_major = brd->print_driver->major;
1302 return 0;
1304 unregister_serial_drv:
1305 tty_unregister_driver(brd->serial_driver);
1306 free_print_drv:
1307 put_tty_driver(brd->print_driver);
1308 free_serial_drv:
1309 put_tty_driver(brd->serial_driver);
1311 return rc;
1315 * dgap_tty_init()
1317 * Init the tty subsystem. Called once per board after board has been
1318 * downloaded and init'ed.
1320 static int dgap_tty_init(struct board_t *brd)
1322 int i;
1323 int tlw;
1324 uint true_count;
1325 u8 __iomem *vaddr;
1326 u8 modem;
1327 struct channel_t *ch;
1328 struct bs_t __iomem *bs;
1329 struct cm_t __iomem *cm;
1331 if (!brd)
1332 return -EIO;
1335 * Initialize board structure elements.
1338 vaddr = brd->re_map_membase;
1339 true_count = readw((vaddr + NCHAN));
1341 brd->nasync = dgap_config_get_num_prts(brd);
1343 if (!brd->nasync)
1344 brd->nasync = brd->maxports;
1346 if (brd->nasync > brd->maxports)
1347 brd->nasync = brd->maxports;
1349 if (true_count != brd->nasync) {
1350 if ((brd->type == PPCM) && (true_count == 64)) {
1351 pr_warn("dgap: %s configured for %d ports, has %d ports.\n",
1352 brd->name, brd->nasync, true_count);
1353 pr_warn("dgap: Please make SURE the EBI cable running from the card\n");
1354 pr_warn("dgap: to each EM module is plugged into EBI IN!\n");
1355 } else if ((brd->type == PPCM) && (true_count == 0)) {
1356 pr_warn("dgap: %s configured for %d ports, has %d ports.\n",
1357 brd->name, brd->nasync, true_count);
1358 pr_warn("dgap: Please make SURE the EBI cable running from the card\n");
1359 pr_warn("dgap: to each EM module is plugged into EBI IN!\n");
1360 } else
1361 pr_warn("dgap: %s configured for %d ports, has %d ports.\n",
1362 brd->name, brd->nasync, true_count);
1364 brd->nasync = true_count;
1366 /* If no ports, don't bother going any further */
1367 if (!brd->nasync) {
1368 brd->state = BOARD_FAILED;
1369 brd->dpastatus = BD_NOFEP;
1370 return -EIO;
1375 * Allocate channel memory that might not have been allocated
1376 * when the driver was first loaded.
1378 for (i = 0; i < brd->nasync; i++) {
1379 if (!brd->channels[i]) {
1380 brd->channels[i] =
1381 kzalloc(sizeof(struct channel_t), GFP_KERNEL);
1382 if (!brd->channels[i])
1383 return -ENOMEM;
1387 ch = brd->channels[0];
1388 vaddr = brd->re_map_membase;
1390 bs = (struct bs_t __iomem *) ((ulong) vaddr + CHANBUF);
1391 cm = (struct cm_t __iomem *) ((ulong) vaddr + CMDBUF);
1393 brd->bd_bs = bs;
1395 /* Set up channel variables */
1396 for (i = 0; i < brd->nasync; i++, ch = brd->channels[i], bs++) {
1398 if (!brd->channels[i])
1399 continue;
1401 spin_lock_init(&ch->ch_lock);
1403 /* Store all our magic numbers */
1404 ch->magic = DGAP_CHANNEL_MAGIC;
1405 ch->ch_tun.magic = DGAP_UNIT_MAGIC;
1406 ch->ch_tun.un_type = DGAP_SERIAL;
1407 ch->ch_tun.un_ch = ch;
1408 ch->ch_tun.un_dev = i;
1410 ch->ch_pun.magic = DGAP_UNIT_MAGIC;
1411 ch->ch_pun.un_type = DGAP_PRINT;
1412 ch->ch_pun.un_ch = ch;
1413 ch->ch_pun.un_dev = i;
1415 ch->ch_vaddr = vaddr;
1416 ch->ch_bs = bs;
1417 ch->ch_cm = cm;
1418 ch->ch_bd = brd;
1419 ch->ch_portnum = i;
1420 ch->ch_digi = dgap_digi_init;
1423 * Set up digi dsr and dcd bits based on altpin flag.
1425 if (dgap_config_get_altpin(brd)) {
1426 ch->ch_dsr = DM_CD;
1427 ch->ch_cd = DM_DSR;
1428 ch->ch_digi.digi_flags |= DIGI_ALTPIN;
1429 } else {
1430 ch->ch_cd = DM_CD;
1431 ch->ch_dsr = DM_DSR;
1434 ch->ch_taddr = vaddr + (ioread16(&(ch->ch_bs->tx_seg)) << 4);
1435 ch->ch_raddr = vaddr + (ioread16(&(ch->ch_bs->rx_seg)) << 4);
1436 ch->ch_tx_win = 0;
1437 ch->ch_rx_win = 0;
1438 ch->ch_tsize = readw(&(ch->ch_bs->tx_max)) + 1;
1439 ch->ch_rsize = readw(&(ch->ch_bs->rx_max)) + 1;
1440 ch->ch_tstart = 0;
1441 ch->ch_rstart = 0;
1443 /* .25 second delay */
1444 ch->ch_close_delay = 250;
1447 * Set queue water marks, interrupt mask,
1448 * and general tty parameters.
1450 tlw = ch->ch_tsize >= 2000 ? ((ch->ch_tsize * 5) / 8) :
1451 ch->ch_tsize / 2;
1452 ch->ch_tlw = tlw;
1454 dgap_cmdw(ch, STLOW, tlw, 0);
1456 dgap_cmdw(ch, SRLOW, ch->ch_rsize / 2, 0);
1458 dgap_cmdw(ch, SRHIGH, 7 * ch->ch_rsize / 8, 0);
1460 ch->ch_mistat = readb(&(ch->ch_bs->m_stat));
1462 init_waitqueue_head(&ch->ch_flags_wait);
1463 init_waitqueue_head(&ch->ch_tun.un_flags_wait);
1464 init_waitqueue_head(&ch->ch_pun.un_flags_wait);
1466 /* Turn on all modem interrupts for now */
1467 modem = (DM_CD | DM_DSR | DM_CTS | DM_RI);
1468 writeb(modem, &(ch->ch_bs->m_int));
1471 * Set edelay to 0 if interrupts are turned on,
1472 * otherwise set edelay to the usual 100.
1474 if (brd->intr_used)
1475 writew(0, &(ch->ch_bs->edelay));
1476 else
1477 writew(100, &(ch->ch_bs->edelay));
1479 writeb(1, &(ch->ch_bs->idata));
1482 return 0;
1486 * dgap_tty_uninit()
1488 * Uninitialize the TTY portion of this driver. Free all memory and
1489 * resources.
1491 static void dgap_tty_uninit(struct board_t *brd)
1493 struct device *dev;
1494 int i;
1496 if (brd->dgap_major_serial_registered) {
1497 dgap_boards_by_major[brd->serial_driver->major] = NULL;
1498 brd->dgap_serial_major = 0;
1499 for (i = 0; i < brd->nasync; i++) {
1500 tty_port_destroy(&brd->serial_ports[i]);
1501 dev = brd->channels[i]->ch_tun.un_sysfs;
1502 dgap_remove_tty_sysfs(dev);
1503 tty_unregister_device(brd->serial_driver, i);
1505 tty_unregister_driver(brd->serial_driver);
1506 put_tty_driver(brd->serial_driver);
1507 kfree(brd->serial_ports);
1508 brd->dgap_major_serial_registered = FALSE;
1511 if (brd->dgap_major_transparent_print_registered) {
1512 dgap_boards_by_major[brd->print_driver->major] = NULL;
1513 brd->dgap_transparent_print_major = 0;
1514 for (i = 0; i < brd->nasync; i++) {
1515 tty_port_destroy(&brd->printer_ports[i]);
1516 dev = brd->channels[i]->ch_pun.un_sysfs;
1517 dgap_remove_tty_sysfs(dev);
1518 tty_unregister_device(brd->print_driver, i);
1520 tty_unregister_driver(brd->print_driver);
1521 put_tty_driver(brd->print_driver);
1522 kfree(brd->printer_ports);
1523 brd->dgap_major_transparent_print_registered = FALSE;
1527 /*=======================================================================
1529 * dgap_input - Process received data.
1531 * ch - Pointer to channel structure.
1533 *=======================================================================*/
1535 static void dgap_input(struct channel_t *ch)
1537 struct board_t *bd;
1538 struct bs_t __iomem *bs;
1539 struct tty_struct *tp;
1540 struct tty_ldisc *ld;
1541 uint rmask;
1542 uint head;
1543 uint tail;
1544 int data_len;
1545 ulong lock_flags;
1546 ulong lock_flags2;
1547 int flip_len;
1548 int len;
1549 int n;
1550 u8 *buf;
1551 u8 tmpchar;
1552 int s;
1554 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
1555 return;
1557 tp = ch->ch_tun.un_tty;
1559 bs = ch->ch_bs;
1560 if (!bs)
1561 return;
1563 bd = ch->ch_bd;
1564 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
1565 return;
1567 spin_lock_irqsave(&bd->bd_lock, lock_flags);
1568 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
1571 * Figure the number of characters in the buffer.
1572 * Exit immediately if none.
1575 rmask = ch->ch_rsize - 1;
1577 head = readw(&(bs->rx_head));
1578 head &= rmask;
1579 tail = readw(&(bs->rx_tail));
1580 tail &= rmask;
1582 data_len = (head - tail) & rmask;
1584 if (data_len == 0) {
1585 writeb(1, &(bs->idata));
1586 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
1587 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
1588 return;
1592 * If the device is not open, or CREAD is off, flush
1593 * input data and return immediately.
1595 if ((bd->state != BOARD_READY) || !tp ||
1596 (tp->magic != TTY_MAGIC) ||
1597 !(ch->ch_tun.un_flags & UN_ISOPEN) ||
1598 !(tp->termios.c_cflag & CREAD) ||
1599 (ch->ch_tun.un_flags & UN_CLOSING)) {
1601 writew(head, &(bs->rx_tail));
1602 writeb(1, &(bs->idata));
1603 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
1604 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
1605 return;
1609 * If we are throttled, simply don't read any data.
1611 if (ch->ch_flags & CH_RXBLOCK) {
1612 writeb(1, &(bs->idata));
1613 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
1614 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
1615 return;
1619 * Ignore oruns.
1621 tmpchar = readb(&(bs->orun));
1622 if (tmpchar) {
1623 ch->ch_err_overrun++;
1624 writeb(0, &(bs->orun));
1627 /* Decide how much data we can send into the tty layer */
1628 flip_len = TTY_FLIPBUF_SIZE;
1630 /* Chop down the length, if needed */
1631 len = min(data_len, flip_len);
1632 len = min(len, (N_TTY_BUF_SIZE - 1));
1634 ld = tty_ldisc_ref(tp);
1636 #ifdef TTY_DONT_FLIP
1638 * If the DONT_FLIP flag is on, don't flush our buffer, and act
1639 * like the ld doesn't have any space to put the data right now.
1641 if (test_bit(TTY_DONT_FLIP, &tp->flags))
1642 len = 0;
1643 #endif
1646 * If we were unable to get a reference to the ld,
1647 * don't flush our buffer, and act like the ld doesn't
1648 * have any space to put the data right now.
1650 if (!ld) {
1651 len = 0;
1652 } else {
1654 * If ld doesn't have a pointer to a receive_buf function,
1655 * flush the data, then act like the ld doesn't have any
1656 * space to put the data right now.
1658 if (!ld->ops->receive_buf) {
1659 writew(head, &(bs->rx_tail));
1660 len = 0;
1664 if (len <= 0) {
1665 writeb(1, &(bs->idata));
1666 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
1667 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
1668 if (ld)
1669 tty_ldisc_deref(ld);
1670 return;
1673 buf = ch->ch_bd->flipbuf;
1674 n = len;
1677 * n now contains the most amount of data we can copy,
1678 * bounded either by our buffer size or the amount
1679 * of data the card actually has pending...
1681 while (n) {
1683 s = ((head >= tail) ? head : ch->ch_rsize) - tail;
1684 s = min(s, n);
1686 if (s <= 0)
1687 break;
1689 memcpy_fromio(buf, ch->ch_raddr + tail, s);
1691 tail += s;
1692 buf += s;
1694 n -= s;
1695 /* Flip queue if needed */
1696 tail &= rmask;
1699 writew(tail, &(bs->rx_tail));
1700 writeb(1, &(bs->idata));
1701 ch->ch_rxcount += len;
1704 * If we are completely raw, we don't need to go through a lot
1705 * of the tty layers that exist.
1706 * In this case, we take the shortest and fastest route we
1707 * can to relay the data to the user.
1709 * On the other hand, if we are not raw, we need to go through
1710 * the tty layer, which has its API more well defined.
1712 if (I_PARMRK(tp) || I_BRKINT(tp) || I_INPCK(tp)) {
1713 dgap_parity_scan(ch, ch->ch_bd->flipbuf,
1714 ch->ch_bd->flipflagbuf, &len);
1716 len = tty_buffer_request_room(tp->port, len);
1717 tty_insert_flip_string_flags(tp->port, ch->ch_bd->flipbuf,
1718 ch->ch_bd->flipflagbuf, len);
1719 } else {
1720 len = tty_buffer_request_room(tp->port, len);
1721 tty_insert_flip_string(tp->port, ch->ch_bd->flipbuf, len);
1724 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
1725 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
1727 /* Tell the tty layer its okay to "eat" the data now */
1728 tty_flip_buffer_push(tp->port);
1730 if (ld)
1731 tty_ldisc_deref(ld);
1735 /************************************************************************
1736 * Determines when CARRIER changes state and takes appropriate
1737 * action.
1738 ************************************************************************/
1739 static void dgap_carrier(struct channel_t *ch)
1741 struct board_t *bd;
1743 int virt_carrier = 0;
1744 int phys_carrier = 0;
1746 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
1747 return;
1749 bd = ch->ch_bd;
1751 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
1752 return;
1754 /* Make sure altpin is always set correctly */
1755 if (ch->ch_digi.digi_flags & DIGI_ALTPIN) {
1756 ch->ch_dsr = DM_CD;
1757 ch->ch_cd = DM_DSR;
1758 } else {
1759 ch->ch_dsr = DM_DSR;
1760 ch->ch_cd = DM_CD;
1763 if (ch->ch_mistat & D_CD(ch))
1764 phys_carrier = 1;
1766 if (ch->ch_digi.digi_flags & DIGI_FORCEDCD)
1767 virt_carrier = 1;
1769 if (ch->ch_c_cflag & CLOCAL)
1770 virt_carrier = 1;
1773 * Test for a VIRTUAL carrier transition to HIGH.
1775 if (((ch->ch_flags & CH_FCAR) == 0) && (virt_carrier == 1)) {
1778 * When carrier rises, wake any threads waiting
1779 * for carrier in the open routine.
1782 if (waitqueue_active(&(ch->ch_flags_wait)))
1783 wake_up_interruptible(&ch->ch_flags_wait);
1787 * Test for a PHYSICAL carrier transition to HIGH.
1789 if (((ch->ch_flags & CH_CD) == 0) && (phys_carrier == 1)) {
1792 * When carrier rises, wake any threads waiting
1793 * for carrier in the open routine.
1796 if (waitqueue_active(&(ch->ch_flags_wait)))
1797 wake_up_interruptible(&ch->ch_flags_wait);
1801 * Test for a PHYSICAL transition to low, so long as we aren't
1802 * currently ignoring physical transitions (which is what "virtual
1803 * carrier" indicates).
1805 * The transition of the virtual carrier to low really doesn't
1806 * matter... it really only means "ignore carrier state", not
1807 * "make pretend that carrier is there".
1809 if ((virt_carrier == 0) &&
1810 ((ch->ch_flags & CH_CD) != 0) &&
1811 (phys_carrier == 0)) {
1814 * When carrier drops:
1816 * Drop carrier on all open units.
1818 * Flush queues, waking up any task waiting in the
1819 * line discipline.
1821 * Send a hangup to the control terminal.
1823 * Enable all select calls.
1825 if (waitqueue_active(&(ch->ch_flags_wait)))
1826 wake_up_interruptible(&ch->ch_flags_wait);
1828 if (ch->ch_tun.un_open_count > 0)
1829 tty_hangup(ch->ch_tun.un_tty);
1831 if (ch->ch_pun.un_open_count > 0)
1832 tty_hangup(ch->ch_pun.un_tty);
1836 * Make sure that our cached values reflect the current reality.
1838 if (virt_carrier == 1)
1839 ch->ch_flags |= CH_FCAR;
1840 else
1841 ch->ch_flags &= ~CH_FCAR;
1843 if (phys_carrier == 1)
1844 ch->ch_flags |= CH_CD;
1845 else
1846 ch->ch_flags &= ~CH_CD;
1849 /************************************************************************
1851 * TTY Entry points and helper functions
1853 ************************************************************************/
1856 * dgap_tty_open()
1859 static int dgap_tty_open(struct tty_struct *tty, struct file *file)
1861 struct board_t *brd;
1862 struct channel_t *ch;
1863 struct un_t *un;
1864 struct bs_t __iomem *bs;
1865 uint major;
1866 uint minor;
1867 int rc;
1868 ulong lock_flags;
1869 ulong lock_flags2;
1870 u16 head;
1872 major = MAJOR(tty_devnum(tty));
1873 minor = MINOR(tty_devnum(tty));
1875 if (major > 255)
1876 return -EIO;
1878 /* Get board pointer from our array of majors we have allocated */
1879 brd = dgap_boards_by_major[major];
1880 if (!brd)
1881 return -EIO;
1884 * If board is not yet up to a state of READY, go to
1885 * sleep waiting for it to happen or they cancel the open.
1887 rc = wait_event_interruptible(brd->state_wait,
1888 (brd->state & BOARD_READY));
1890 if (rc)
1891 return rc;
1893 spin_lock_irqsave(&brd->bd_lock, lock_flags);
1895 /* The wait above should guarantee this cannot happen */
1896 if (brd->state != BOARD_READY) {
1897 spin_unlock_irqrestore(&brd->bd_lock, lock_flags);
1898 return -EIO;
1901 /* If opened device is greater than our number of ports, bail. */
1902 if (MINOR(tty_devnum(tty)) > brd->nasync) {
1903 spin_unlock_irqrestore(&brd->bd_lock, lock_flags);
1904 return -EIO;
1907 ch = brd->channels[minor];
1908 if (!ch) {
1909 spin_unlock_irqrestore(&brd->bd_lock, lock_flags);
1910 return -EIO;
1913 /* Grab channel lock */
1914 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
1916 /* Figure out our type */
1917 if (major == brd->dgap_serial_major) {
1918 un = &brd->channels[minor]->ch_tun;
1919 un->un_type = DGAP_SERIAL;
1920 } else if (major == brd->dgap_transparent_print_major) {
1921 un = &brd->channels[minor]->ch_pun;
1922 un->un_type = DGAP_PRINT;
1923 } else {
1924 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
1925 spin_unlock_irqrestore(&brd->bd_lock, lock_flags);
1926 return -EIO;
1929 /* Store our unit into driver_data, so we always have it available. */
1930 tty->driver_data = un;
1933 * Error if channel info pointer is NULL.
1935 bs = ch->ch_bs;
1936 if (!bs) {
1937 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
1938 spin_unlock_irqrestore(&brd->bd_lock, lock_flags);
1939 return -EIO;
1943 * Initialize tty's
1945 if (!(un->un_flags & UN_ISOPEN)) {
1946 /* Store important variables. */
1947 un->un_tty = tty;
1949 /* Maybe do something here to the TTY struct as well? */
1953 * Initialize if neither terminal or printer is open.
1955 if (!((ch->ch_tun.un_flags | ch->ch_pun.un_flags) & UN_ISOPEN)) {
1957 ch->ch_mforce = 0;
1958 ch->ch_mval = 0;
1961 * Flush input queue.
1963 head = readw(&(bs->rx_head));
1964 writew(head, &(bs->rx_tail));
1966 ch->ch_flags = 0;
1967 ch->pscan_state = 0;
1968 ch->pscan_savechar = 0;
1970 ch->ch_c_cflag = tty->termios.c_cflag;
1971 ch->ch_c_iflag = tty->termios.c_iflag;
1972 ch->ch_c_oflag = tty->termios.c_oflag;
1973 ch->ch_c_lflag = tty->termios.c_lflag;
1974 ch->ch_startc = tty->termios.c_cc[VSTART];
1975 ch->ch_stopc = tty->termios.c_cc[VSTOP];
1977 /* TODO: flush our TTY struct here? */
1980 dgap_carrier(ch);
1982 * Run param in case we changed anything
1984 dgap_param(tty);
1987 * follow protocol for opening port
1990 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
1991 spin_unlock_irqrestore(&brd->bd_lock, lock_flags);
1993 rc = dgap_block_til_ready(tty, file, ch);
1995 if (!un->un_tty)
1996 return -ENODEV;
1998 /* No going back now, increment our unit and channel counters */
1999 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2000 ch->ch_open_count++;
2001 un->un_open_count++;
2002 un->un_flags |= (UN_ISOPEN);
2003 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2005 return rc;
2009 * dgap_block_til_ready()
2011 * Wait for DCD, if needed.
2013 static int dgap_block_til_ready(struct tty_struct *tty, struct file *file,
2014 struct channel_t *ch)
2016 int retval = 0;
2017 struct un_t *un;
2018 ulong lock_flags;
2019 uint old_flags;
2020 int sleep_on_un_flags;
2022 if (!tty || tty->magic != TTY_MAGIC || !file || !ch ||
2023 ch->magic != DGAP_CHANNEL_MAGIC)
2024 return -EIO;
2026 un = tty->driver_data;
2027 if (!un || un->magic != DGAP_UNIT_MAGIC)
2028 return -EIO;
2030 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2032 ch->ch_wopen++;
2034 /* Loop forever */
2035 while (1) {
2037 sleep_on_un_flags = 0;
2040 * If board has failed somehow during our sleep,
2041 * bail with error.
2043 if (ch->ch_bd->state == BOARD_FAILED) {
2044 retval = -EIO;
2045 break;
2048 /* If tty was hung up, break out of loop and set error. */
2049 if (tty_hung_up_p(file)) {
2050 retval = -EAGAIN;
2051 break;
2055 * If either unit is in the middle of the fragile part of close,
2056 * we just cannot touch the channel safely.
2057 * Go back to sleep, knowing that when the channel can be
2058 * touched safely, the close routine will signal the
2059 * ch_wait_flags to wake us back up.
2061 if (!((ch->ch_tun.un_flags | ch->ch_pun.un_flags) &
2062 UN_CLOSING)) {
2065 * Our conditions to leave cleanly and happily:
2066 * 1) NONBLOCKING on the tty is set.
2067 * 2) CLOCAL is set.
2068 * 3) DCD (fake or real) is active.
2071 if (file->f_flags & O_NONBLOCK)
2072 break;
2074 if (tty->flags & (1 << TTY_IO_ERROR))
2075 break;
2077 if (ch->ch_flags & CH_CD)
2078 break;
2080 if (ch->ch_flags & CH_FCAR)
2081 break;
2082 } else {
2083 sleep_on_un_flags = 1;
2087 * If there is a signal pending, the user probably
2088 * interrupted (ctrl-c) us.
2089 * Leave loop with error set.
2091 if (signal_pending(current)) {
2092 retval = -ERESTARTSYS;
2093 break;
2097 * Store the flags before we let go of channel lock
2099 if (sleep_on_un_flags)
2100 old_flags = ch->ch_tun.un_flags | ch->ch_pun.un_flags;
2101 else
2102 old_flags = ch->ch_flags;
2105 * Let go of channel lock before calling schedule.
2106 * Our poller will get any FEP events and wake us up when DCD
2107 * eventually goes active.
2110 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2113 * Wait for something in the flags to change
2114 * from the current value.
2116 if (sleep_on_un_flags) {
2117 retval = wait_event_interruptible(un->un_flags_wait,
2118 (old_flags != (ch->ch_tun.un_flags |
2119 ch->ch_pun.un_flags)));
2120 } else {
2121 retval = wait_event_interruptible(ch->ch_flags_wait,
2122 (old_flags != ch->ch_flags));
2126 * We got woken up for some reason.
2127 * Before looping around, grab our channel lock.
2129 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2132 ch->ch_wopen--;
2134 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2136 if (retval)
2137 return retval;
2139 return 0;
2143 * dgap_tty_hangup()
2145 * Hangup the port. Like a close, but don't wait for output to drain.
2147 static void dgap_tty_hangup(struct tty_struct *tty)
2149 struct board_t *bd;
2150 struct channel_t *ch;
2151 struct un_t *un;
2153 if (!tty || tty->magic != TTY_MAGIC)
2154 return;
2156 un = tty->driver_data;
2157 if (!un || un->magic != DGAP_UNIT_MAGIC)
2158 return;
2160 ch = un->un_ch;
2161 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2162 return;
2164 bd = ch->ch_bd;
2165 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
2166 return;
2168 /* flush the transmit queues */
2169 dgap_tty_flush_buffer(tty);
2173 * dgap_tty_close()
2176 static void dgap_tty_close(struct tty_struct *tty, struct file *file)
2178 struct ktermios *ts;
2179 struct board_t *bd;
2180 struct channel_t *ch;
2181 struct un_t *un;
2182 ulong lock_flags;
2184 if (!tty || tty->magic != TTY_MAGIC)
2185 return;
2187 un = tty->driver_data;
2188 if (!un || un->magic != DGAP_UNIT_MAGIC)
2189 return;
2191 ch = un->un_ch;
2192 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2193 return;
2195 bd = ch->ch_bd;
2196 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
2197 return;
2199 ts = &tty->termios;
2201 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2204 * Determine if this is the last close or not - and if we agree about
2205 * which type of close it is with the Line Discipline
2207 if ((tty->count == 1) && (un->un_open_count != 1)) {
2209 * Uh, oh. tty->count is 1, which means that the tty
2210 * structure will be freed. un_open_count should always
2211 * be one in these conditions. If it's greater than
2212 * one, we've got real problems, since it means the
2213 * serial port won't be shutdown.
2215 un->un_open_count = 1;
2218 if (--un->un_open_count < 0)
2219 un->un_open_count = 0;
2221 ch->ch_open_count--;
2223 if (ch->ch_open_count && un->un_open_count) {
2224 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2225 return;
2228 /* OK, its the last close on the unit */
2230 un->un_flags |= UN_CLOSING;
2232 tty->closing = 1;
2235 * Only officially close channel if count is 0 and
2236 * DIGI_PRINTER bit is not set.
2238 if ((ch->ch_open_count == 0) &&
2239 !(ch->ch_digi.digi_flags & DIGI_PRINTER)) {
2241 ch->ch_flags &= ~(CH_RXBLOCK);
2243 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2245 /* wait for output to drain */
2246 /* This will also return if we take an interrupt */
2248 dgap_wait_for_drain(tty);
2250 dgap_tty_flush_buffer(tty);
2251 tty_ldisc_flush(tty);
2253 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2255 tty->closing = 0;
2258 * If we have HUPCL set, lower DTR and RTS
2260 if (ch->ch_c_cflag & HUPCL) {
2261 ch->ch_mostat &= ~(D_RTS(ch)|D_DTR(ch));
2262 dgap_cmdb(ch, SMODEM, 0, D_DTR(ch)|D_RTS(ch), 0);
2265 * Go to sleep to ensure RTS/DTR
2266 * have been dropped for modems to see it.
2268 if (ch->ch_close_delay) {
2269 spin_unlock_irqrestore(&ch->ch_lock,
2270 lock_flags);
2271 dgap_ms_sleep(ch->ch_close_delay);
2272 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2276 ch->pscan_state = 0;
2277 ch->pscan_savechar = 0;
2278 ch->ch_baud_info = 0;
2283 * turn off print device when closing print device.
2285 if ((un->un_type == DGAP_PRINT) && (ch->ch_flags & CH_PRON)) {
2286 dgap_wmove(ch, ch->ch_digi.digi_offstr,
2287 (int) ch->ch_digi.digi_offlen);
2288 ch->ch_flags &= ~CH_PRON;
2291 un->un_tty = NULL;
2292 un->un_flags &= ~(UN_ISOPEN | UN_CLOSING);
2293 tty->driver_data = NULL;
2295 wake_up_interruptible(&ch->ch_flags_wait);
2296 wake_up_interruptible(&un->un_flags_wait);
2298 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2302 * dgap_tty_chars_in_buffer()
2304 * Return number of characters that have not been transmitted yet.
2306 * This routine is used by the line discipline to determine if there
2307 * is data waiting to be transmitted/drained/flushed or not.
2309 static int dgap_tty_chars_in_buffer(struct tty_struct *tty)
2311 struct board_t *bd;
2312 struct channel_t *ch;
2313 struct un_t *un;
2314 struct bs_t __iomem *bs;
2315 u8 tbusy;
2316 uint chars;
2317 u16 thead, ttail, tmask, chead, ctail;
2318 ulong lock_flags = 0;
2319 ulong lock_flags2 = 0;
2321 if (!tty)
2322 return 0;
2324 un = tty->driver_data;
2325 if (!un || un->magic != DGAP_UNIT_MAGIC)
2326 return 0;
2328 ch = un->un_ch;
2329 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2330 return 0;
2332 bd = ch->ch_bd;
2333 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
2334 return 0;
2336 bs = ch->ch_bs;
2337 if (!bs)
2338 return 0;
2340 spin_lock_irqsave(&bd->bd_lock, lock_flags);
2341 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
2343 tmask = (ch->ch_tsize - 1);
2345 /* Get Transmit queue pointers */
2346 thead = readw(&(bs->tx_head)) & tmask;
2347 ttail = readw(&(bs->tx_tail)) & tmask;
2349 /* Get tbusy flag */
2350 tbusy = readb(&(bs->tbusy));
2352 /* Get Command queue pointers */
2353 chead = readw(&(ch->ch_cm->cm_head));
2354 ctail = readw(&(ch->ch_cm->cm_tail));
2356 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
2357 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
2360 * The only way we know for sure if there is no pending
2361 * data left to be transferred, is if:
2362 * 1) Transmit head and tail are equal (empty).
2363 * 2) Command queue head and tail are equal (empty).
2364 * 3) The "TBUSY" flag is 0. (Transmitter not busy).
2367 if ((ttail == thead) && (tbusy == 0) && (chead == ctail)) {
2368 chars = 0;
2369 } else {
2370 if (thead >= ttail)
2371 chars = thead - ttail;
2372 else
2373 chars = thead - ttail + ch->ch_tsize;
2375 * Fudge factor here.
2376 * If chars is zero, we know that the command queue had
2377 * something in it or tbusy was set. Because we cannot
2378 * be sure if there is still some data to be transmitted,
2379 * lets lie, and tell ld we have 1 byte left.
2381 if (chars == 0) {
2383 * If TBUSY is still set, and our tx buffers are empty,
2384 * force the firmware to send me another wakeup after
2385 * TBUSY has been cleared.
2387 if (tbusy != 0) {
2388 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2389 un->un_flags |= UN_EMPTY;
2390 writeb(1, &(bs->iempty));
2391 spin_unlock_irqrestore(&ch->ch_lock,
2392 lock_flags);
2394 chars = 1;
2398 return chars;
2401 static int dgap_wait_for_drain(struct tty_struct *tty)
2403 struct channel_t *ch;
2404 struct un_t *un;
2405 struct bs_t __iomem *bs;
2406 int ret = 0;
2407 uint count = 1;
2408 ulong lock_flags = 0;
2410 if (!tty || tty->magic != TTY_MAGIC)
2411 return -EIO;
2413 un = tty->driver_data;
2414 if (!un || un->magic != DGAP_UNIT_MAGIC)
2415 return -EIO;
2417 ch = un->un_ch;
2418 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2419 return -EIO;
2421 bs = ch->ch_bs;
2422 if (!bs)
2423 return -EIO;
2425 /* Loop until data is drained */
2426 while (count != 0) {
2428 count = dgap_tty_chars_in_buffer(tty);
2430 if (count == 0)
2431 break;
2433 /* Set flag waiting for drain */
2434 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2435 un->un_flags |= UN_EMPTY;
2436 writeb(1, &(bs->iempty));
2437 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2439 /* Go to sleep till we get woken up */
2440 ret = wait_event_interruptible(un->un_flags_wait,
2441 ((un->un_flags & UN_EMPTY) == 0));
2442 /* If ret is non-zero, user ctrl-c'ed us */
2443 if (ret)
2444 break;
2447 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2448 un->un_flags &= ~(UN_EMPTY);
2449 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2451 return ret;
2455 * dgap_maxcps_room
2457 * Reduces bytes_available to the max number of characters
2458 * that can be sent currently given the maxcps value, and
2459 * returns the new bytes_available. This only affects printer
2460 * output.
2462 static int dgap_maxcps_room(struct tty_struct *tty, int bytes_available)
2464 struct channel_t *ch;
2465 struct un_t *un;
2467 if (!tty)
2468 return bytes_available;
2470 un = tty->driver_data;
2471 if (!un || un->magic != DGAP_UNIT_MAGIC)
2472 return bytes_available;
2474 ch = un->un_ch;
2475 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2476 return bytes_available;
2479 * If its not the Transparent print device, return
2480 * the full data amount.
2482 if (un->un_type != DGAP_PRINT)
2483 return bytes_available;
2485 if (ch->ch_digi.digi_maxcps > 0 && ch->ch_digi.digi_bufsize > 0) {
2486 int cps_limit = 0;
2487 unsigned long current_time = jiffies;
2488 unsigned long buffer_time = current_time +
2489 (HZ * ch->ch_digi.digi_bufsize) /
2490 ch->ch_digi.digi_maxcps;
2492 if (ch->ch_cpstime < current_time) {
2493 /* buffer is empty */
2494 ch->ch_cpstime = current_time; /* reset ch_cpstime */
2495 cps_limit = ch->ch_digi.digi_bufsize;
2496 } else if (ch->ch_cpstime < buffer_time) {
2497 /* still room in the buffer */
2498 cps_limit = ((buffer_time - ch->ch_cpstime) *
2499 ch->ch_digi.digi_maxcps) / HZ;
2500 } else {
2501 /* no room in the buffer */
2502 cps_limit = 0;
2505 bytes_available = min(cps_limit, bytes_available);
2508 return bytes_available;
2511 static inline void dgap_set_firmware_event(struct un_t *un, unsigned int event)
2513 struct channel_t *ch;
2514 struct bs_t __iomem *bs;
2516 if (!un || un->magic != DGAP_UNIT_MAGIC)
2517 return;
2518 ch = un->un_ch;
2519 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2520 return;
2521 bs = ch->ch_bs;
2522 if (!bs)
2523 return;
2525 if ((event & UN_LOW) != 0) {
2526 if ((un->un_flags & UN_LOW) == 0) {
2527 un->un_flags |= UN_LOW;
2528 writeb(1, &(bs->ilow));
2531 if ((event & UN_LOW) != 0) {
2532 if ((un->un_flags & UN_EMPTY) == 0) {
2533 un->un_flags |= UN_EMPTY;
2534 writeb(1, &(bs->iempty));
2540 * dgap_tty_write_room()
2542 * Return space available in Tx buffer
2544 static int dgap_tty_write_room(struct tty_struct *tty)
2546 struct channel_t *ch;
2547 struct un_t *un;
2548 struct bs_t __iomem *bs;
2549 u16 head, tail, tmask;
2550 int ret;
2551 ulong lock_flags = 0;
2553 if (!tty)
2554 return 0;
2556 un = tty->driver_data;
2557 if (!un || un->magic != DGAP_UNIT_MAGIC)
2558 return 0;
2560 ch = un->un_ch;
2561 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2562 return 0;
2564 bs = ch->ch_bs;
2565 if (!bs)
2566 return 0;
2568 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2570 tmask = ch->ch_tsize - 1;
2571 head = readw(&(bs->tx_head)) & tmask;
2572 tail = readw(&(bs->tx_tail)) & tmask;
2574 ret = tail - head - 1;
2575 if (ret < 0)
2576 ret += ch->ch_tsize;
2578 /* Limit printer to maxcps */
2579 ret = dgap_maxcps_room(tty, ret);
2582 * If we are printer device, leave space for
2583 * possibly both the on and off strings.
2585 if (un->un_type == DGAP_PRINT) {
2586 if (!(ch->ch_flags & CH_PRON))
2587 ret -= ch->ch_digi.digi_onlen;
2588 ret -= ch->ch_digi.digi_offlen;
2589 } else {
2590 if (ch->ch_flags & CH_PRON)
2591 ret -= ch->ch_digi.digi_offlen;
2594 if (ret < 0)
2595 ret = 0;
2598 * Schedule FEP to wake us up if needed.
2600 * TODO: This might be overkill...
2601 * Do we really need to schedule callbacks from the FEP
2602 * in every case? Can we get smarter based on ret?
2604 dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
2605 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2607 return ret;
2611 * dgap_tty_put_char()
2613 * Put a character into ch->ch_buf
2615 * - used by the line discipline for OPOST processing
2617 static int dgap_tty_put_char(struct tty_struct *tty, unsigned char c)
2620 * Simply call tty_write.
2622 dgap_tty_write(tty, &c, 1);
2623 return 1;
2627 * dgap_tty_write()
2629 * Take data from the user or kernel and send it out to the FEP.
2630 * In here exists all the Transparent Print magic as well.
2632 static int dgap_tty_write(struct tty_struct *tty, const unsigned char *buf,
2633 int count)
2635 struct channel_t *ch;
2636 struct un_t *un;
2637 struct bs_t __iomem *bs;
2638 char __iomem *vaddr;
2639 u16 head, tail, tmask, remain;
2640 int bufcount, n;
2641 int orig_count;
2642 ulong lock_flags;
2644 if (!tty)
2645 return 0;
2647 un = tty->driver_data;
2648 if (!un || un->magic != DGAP_UNIT_MAGIC)
2649 return 0;
2651 ch = un->un_ch;
2652 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2653 return 0;
2655 bs = ch->ch_bs;
2656 if (!bs)
2657 return 0;
2659 if (!count)
2660 return 0;
2663 * Store original amount of characters passed in.
2664 * This helps to figure out if we should ask the FEP
2665 * to send us an event when it has more space available.
2667 orig_count = count;
2669 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2671 /* Get our space available for the channel from the board */
2672 tmask = ch->ch_tsize - 1;
2673 head = readw(&(bs->tx_head)) & tmask;
2674 tail = readw(&(bs->tx_tail)) & tmask;
2676 bufcount = tail - head - 1;
2677 if (bufcount < 0)
2678 bufcount += ch->ch_tsize;
2681 * Limit printer output to maxcps overall, with bursts allowed
2682 * up to bufsize characters.
2684 bufcount = dgap_maxcps_room(tty, bufcount);
2687 * Take minimum of what the user wants to send, and the
2688 * space available in the FEP buffer.
2690 count = min(count, bufcount);
2693 * Bail if no space left.
2695 if (count <= 0) {
2696 dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
2697 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2698 return 0;
2702 * Output the printer ON string, if we are in terminal mode, but
2703 * need to be in printer mode.
2705 if ((un->un_type == DGAP_PRINT) && !(ch->ch_flags & CH_PRON)) {
2706 dgap_wmove(ch, ch->ch_digi.digi_onstr,
2707 (int) ch->ch_digi.digi_onlen);
2708 head = readw(&(bs->tx_head)) & tmask;
2709 ch->ch_flags |= CH_PRON;
2713 * On the other hand, output the printer OFF string, if we are
2714 * currently in printer mode, but need to output to the terminal.
2716 if ((un->un_type != DGAP_PRINT) && (ch->ch_flags & CH_PRON)) {
2717 dgap_wmove(ch, ch->ch_digi.digi_offstr,
2718 (int) ch->ch_digi.digi_offlen);
2719 head = readw(&(bs->tx_head)) & tmask;
2720 ch->ch_flags &= ~CH_PRON;
2723 n = count;
2726 * If the write wraps over the top of the circular buffer,
2727 * move the portion up to the wrap point, and reset the
2728 * pointers to the bottom.
2730 remain = ch->ch_tstart + ch->ch_tsize - head;
2732 if (n >= remain) {
2733 n -= remain;
2734 vaddr = ch->ch_taddr + head;
2736 memcpy_toio(vaddr, (u8 *) buf, remain);
2738 head = ch->ch_tstart;
2739 buf += remain;
2742 if (n > 0) {
2745 * Move rest of data.
2747 vaddr = ch->ch_taddr + head;
2748 remain = n;
2750 memcpy_toio(vaddr, (u8 *) buf, remain);
2751 head += remain;
2755 if (count) {
2756 ch->ch_txcount += count;
2757 head &= tmask;
2758 writew(head, &(bs->tx_head));
2761 dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
2764 * If this is the print device, and the
2765 * printer is still on, we need to turn it
2766 * off before going idle. If the buffer is
2767 * non-empty, wait until it goes empty.
2768 * Otherwise turn it off right now.
2770 if ((un->un_type == DGAP_PRINT) && (ch->ch_flags & CH_PRON)) {
2771 tail = readw(&(bs->tx_tail)) & tmask;
2773 if (tail != head) {
2774 un->un_flags |= UN_EMPTY;
2775 writeb(1, &(bs->iempty));
2776 } else {
2777 dgap_wmove(ch, ch->ch_digi.digi_offstr,
2778 (int) ch->ch_digi.digi_offlen);
2779 head = readw(&(bs->tx_head)) & tmask;
2780 ch->ch_flags &= ~CH_PRON;
2784 /* Update printer buffer empty time. */
2785 if ((un->un_type == DGAP_PRINT) && (ch->ch_digi.digi_maxcps > 0)
2786 && (ch->ch_digi.digi_bufsize > 0)) {
2787 ch->ch_cpstime += (HZ * count) / ch->ch_digi.digi_maxcps;
2790 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2792 return count;
2796 * Return modem signals to ld.
2798 static int dgap_tty_tiocmget(struct tty_struct *tty)
2800 struct channel_t *ch;
2801 struct un_t *un;
2802 int result;
2803 u8 mstat;
2804 ulong lock_flags;
2806 if (!tty || tty->magic != TTY_MAGIC)
2807 return -EIO;
2809 un = tty->driver_data;
2810 if (!un || un->magic != DGAP_UNIT_MAGIC)
2811 return -EIO;
2813 ch = un->un_ch;
2814 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2815 return -EIO;
2817 spin_lock_irqsave(&ch->ch_lock, lock_flags);
2819 mstat = readb(&(ch->ch_bs->m_stat));
2820 /* Append any outbound signals that might be pending... */
2821 mstat |= ch->ch_mostat;
2823 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
2825 result = 0;
2827 if (mstat & D_DTR(ch))
2828 result |= TIOCM_DTR;
2829 if (mstat & D_RTS(ch))
2830 result |= TIOCM_RTS;
2831 if (mstat & D_CTS(ch))
2832 result |= TIOCM_CTS;
2833 if (mstat & D_DSR(ch))
2834 result |= TIOCM_DSR;
2835 if (mstat & D_RI(ch))
2836 result |= TIOCM_RI;
2837 if (mstat & D_CD(ch))
2838 result |= TIOCM_CD;
2840 return result;
2844 * dgap_tty_tiocmset()
2846 * Set modem signals, called by ld.
2848 static int dgap_tty_tiocmset(struct tty_struct *tty,
2849 unsigned int set, unsigned int clear)
2851 struct board_t *bd;
2852 struct channel_t *ch;
2853 struct un_t *un;
2854 ulong lock_flags;
2855 ulong lock_flags2;
2857 if (!tty || tty->magic != TTY_MAGIC)
2858 return -EIO;
2860 un = tty->driver_data;
2861 if (!un || un->magic != DGAP_UNIT_MAGIC)
2862 return -EIO;
2864 ch = un->un_ch;
2865 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2866 return -EIO;
2868 bd = ch->ch_bd;
2869 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
2870 return -EIO;
2872 spin_lock_irqsave(&bd->bd_lock, lock_flags);
2873 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
2875 if (set & TIOCM_RTS) {
2876 ch->ch_mforce |= D_RTS(ch);
2877 ch->ch_mval |= D_RTS(ch);
2880 if (set & TIOCM_DTR) {
2881 ch->ch_mforce |= D_DTR(ch);
2882 ch->ch_mval |= D_DTR(ch);
2885 if (clear & TIOCM_RTS) {
2886 ch->ch_mforce |= D_RTS(ch);
2887 ch->ch_mval &= ~(D_RTS(ch));
2890 if (clear & TIOCM_DTR) {
2891 ch->ch_mforce |= D_DTR(ch);
2892 ch->ch_mval &= ~(D_DTR(ch));
2895 dgap_param(tty);
2897 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
2898 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
2900 return 0;
2904 * dgap_tty_send_break()
2906 * Send a Break, called by ld.
2908 static int dgap_tty_send_break(struct tty_struct *tty, int msec)
2910 struct board_t *bd;
2911 struct channel_t *ch;
2912 struct un_t *un;
2913 ulong lock_flags;
2914 ulong lock_flags2;
2916 if (!tty || tty->magic != TTY_MAGIC)
2917 return -EIO;
2919 un = tty->driver_data;
2920 if (!un || un->magic != DGAP_UNIT_MAGIC)
2921 return -EIO;
2923 ch = un->un_ch;
2924 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2925 return -EIO;
2927 bd = ch->ch_bd;
2928 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
2929 return -EIO;
2931 switch (msec) {
2932 case -1:
2933 msec = 0xFFFF;
2934 break;
2935 case 0:
2936 msec = 1;
2937 break;
2938 default:
2939 msec /= 10;
2940 break;
2943 spin_lock_irqsave(&bd->bd_lock, lock_flags);
2944 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
2945 #if 0
2946 dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
2947 #endif
2948 dgap_cmdw(ch, SBREAK, (u16) msec, 0);
2950 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
2951 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
2953 return 0;
2957 * dgap_tty_wait_until_sent()
2959 * wait until data has been transmitted, called by ld.
2961 static void dgap_tty_wait_until_sent(struct tty_struct *tty, int timeout)
2963 dgap_wait_for_drain(tty);
2967 * dgap_send_xchar()
2969 * send a high priority character, called by ld.
2971 static void dgap_tty_send_xchar(struct tty_struct *tty, char c)
2973 struct board_t *bd;
2974 struct channel_t *ch;
2975 struct un_t *un;
2976 ulong lock_flags;
2977 ulong lock_flags2;
2979 if (!tty || tty->magic != TTY_MAGIC)
2980 return;
2982 un = tty->driver_data;
2983 if (!un || un->magic != DGAP_UNIT_MAGIC)
2984 return;
2986 ch = un->un_ch;
2987 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2988 return;
2990 bd = ch->ch_bd;
2991 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
2992 return;
2994 spin_lock_irqsave(&bd->bd_lock, lock_flags);
2995 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
2998 * This is technically what we should do.
2999 * However, the NIST tests specifically want
3000 * to see each XON or XOFF character that it
3001 * sends, so lets just send each character
3002 * by hand...
3004 #if 0
3005 if (c == STOP_CHAR(tty))
3006 dgap_cmdw(ch, RPAUSE, 0, 0);
3007 else if (c == START_CHAR(tty))
3008 dgap_cmdw(ch, RRESUME, 0, 0);
3009 else
3010 dgap_wmove(ch, &c, 1);
3011 #else
3012 dgap_wmove(ch, &c, 1);
3013 #endif
3015 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3016 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3018 return;
3022 * Return modem signals to ld.
3024 static int dgap_get_modem_info(struct channel_t *ch, unsigned int __user *value)
3026 int result;
3027 u8 mstat;
3028 ulong lock_flags;
3029 int rc;
3031 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3032 return -EIO;
3034 spin_lock_irqsave(&ch->ch_lock, lock_flags);
3036 mstat = readb(&(ch->ch_bs->m_stat));
3037 /* Append any outbound signals that might be pending... */
3038 mstat |= ch->ch_mostat;
3040 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
3042 result = 0;
3044 if (mstat & D_DTR(ch))
3045 result |= TIOCM_DTR;
3046 if (mstat & D_RTS(ch))
3047 result |= TIOCM_RTS;
3048 if (mstat & D_CTS(ch))
3049 result |= TIOCM_CTS;
3050 if (mstat & D_DSR(ch))
3051 result |= TIOCM_DSR;
3052 if (mstat & D_RI(ch))
3053 result |= TIOCM_RI;
3054 if (mstat & D_CD(ch))
3055 result |= TIOCM_CD;
3057 rc = put_user(result, value);
3059 return rc;
3063 * dgap_set_modem_info()
3065 * Set modem signals, called by ld.
3067 static int dgap_set_modem_info(struct tty_struct *tty, unsigned int command,
3068 unsigned int __user *value)
3070 struct board_t *bd;
3071 struct channel_t *ch;
3072 struct un_t *un;
3073 int ret;
3074 unsigned int arg;
3075 ulong lock_flags;
3076 ulong lock_flags2;
3078 if (!tty || tty->magic != TTY_MAGIC)
3079 return -EIO;
3081 un = tty->driver_data;
3082 if (!un || un->magic != DGAP_UNIT_MAGIC)
3083 return -EIO;
3085 ch = un->un_ch;
3086 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3087 return -EIO;
3089 bd = ch->ch_bd;
3090 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3091 return -EIO;
3093 ret = get_user(arg, value);
3094 if (ret)
3095 return ret;
3097 switch (command) {
3098 case TIOCMBIS:
3099 if (arg & TIOCM_RTS) {
3100 ch->ch_mforce |= D_RTS(ch);
3101 ch->ch_mval |= D_RTS(ch);
3104 if (arg & TIOCM_DTR) {
3105 ch->ch_mforce |= D_DTR(ch);
3106 ch->ch_mval |= D_DTR(ch);
3109 break;
3111 case TIOCMBIC:
3112 if (arg & TIOCM_RTS) {
3113 ch->ch_mforce |= D_RTS(ch);
3114 ch->ch_mval &= ~(D_RTS(ch));
3117 if (arg & TIOCM_DTR) {
3118 ch->ch_mforce |= D_DTR(ch);
3119 ch->ch_mval &= ~(D_DTR(ch));
3122 break;
3124 case TIOCMSET:
3125 ch->ch_mforce = D_DTR(ch)|D_RTS(ch);
3127 if (arg & TIOCM_RTS)
3128 ch->ch_mval |= D_RTS(ch);
3129 else
3130 ch->ch_mval &= ~(D_RTS(ch));
3132 if (arg & TIOCM_DTR)
3133 ch->ch_mval |= (D_DTR(ch));
3134 else
3135 ch->ch_mval &= ~(D_DTR(ch));
3137 break;
3139 default:
3140 return -EINVAL;
3143 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3144 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3146 dgap_param(tty);
3148 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3149 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3151 return 0;
3155 * dgap_tty_digigeta()
3157 * Ioctl to get the information for ditty.
3162 static int dgap_tty_digigeta(struct tty_struct *tty,
3163 struct digi_t __user *retinfo)
3165 struct channel_t *ch;
3166 struct un_t *un;
3167 struct digi_t tmp;
3168 ulong lock_flags;
3170 if (!retinfo)
3171 return -EFAULT;
3173 if (!tty || tty->magic != TTY_MAGIC)
3174 return -EFAULT;
3176 un = tty->driver_data;
3177 if (!un || un->magic != DGAP_UNIT_MAGIC)
3178 return -EFAULT;
3180 ch = un->un_ch;
3181 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3182 return -EFAULT;
3184 memset(&tmp, 0, sizeof(tmp));
3186 spin_lock_irqsave(&ch->ch_lock, lock_flags);
3187 memcpy(&tmp, &ch->ch_digi, sizeof(tmp));
3188 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
3190 if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
3191 return -EFAULT;
3193 return 0;
3197 * dgap_tty_digiseta()
3199 * Ioctl to set the information for ditty.
3204 static int dgap_tty_digiseta(struct tty_struct *tty,
3205 struct digi_t __user *new_info)
3207 struct board_t *bd;
3208 struct channel_t *ch;
3209 struct un_t *un;
3210 struct digi_t new_digi;
3211 ulong lock_flags = 0;
3212 unsigned long lock_flags2;
3214 if (!tty || tty->magic != TTY_MAGIC)
3215 return -EFAULT;
3217 un = tty->driver_data;
3218 if (!un || un->magic != DGAP_UNIT_MAGIC)
3219 return -EFAULT;
3221 ch = un->un_ch;
3222 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3223 return -EFAULT;
3225 bd = ch->ch_bd;
3226 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3227 return -EFAULT;
3229 if (copy_from_user(&new_digi, new_info, sizeof(struct digi_t)))
3230 return -EFAULT;
3232 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3233 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3235 memcpy(&ch->ch_digi, &new_digi, sizeof(struct digi_t));
3237 if (ch->ch_digi.digi_maxcps < 1)
3238 ch->ch_digi.digi_maxcps = 1;
3240 if (ch->ch_digi.digi_maxcps > 10000)
3241 ch->ch_digi.digi_maxcps = 10000;
3243 if (ch->ch_digi.digi_bufsize < 10)
3244 ch->ch_digi.digi_bufsize = 10;
3246 if (ch->ch_digi.digi_maxchar < 1)
3247 ch->ch_digi.digi_maxchar = 1;
3249 if (ch->ch_digi.digi_maxchar > ch->ch_digi.digi_bufsize)
3250 ch->ch_digi.digi_maxchar = ch->ch_digi.digi_bufsize;
3252 if (ch->ch_digi.digi_onlen > DIGI_PLEN)
3253 ch->ch_digi.digi_onlen = DIGI_PLEN;
3255 if (ch->ch_digi.digi_offlen > DIGI_PLEN)
3256 ch->ch_digi.digi_offlen = DIGI_PLEN;
3258 dgap_param(tty);
3260 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3261 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3263 return 0;
3267 * dgap_tty_digigetedelay()
3269 * Ioctl to get the current edelay setting.
3274 static int dgap_tty_digigetedelay(struct tty_struct *tty, int __user *retinfo)
3276 struct channel_t *ch;
3277 struct un_t *un;
3278 int tmp;
3279 ulong lock_flags;
3281 if (!retinfo)
3282 return -EFAULT;
3284 if (!tty || tty->magic != TTY_MAGIC)
3285 return -EFAULT;
3287 un = tty->driver_data;
3288 if (!un || un->magic != DGAP_UNIT_MAGIC)
3289 return -EFAULT;
3291 ch = un->un_ch;
3292 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3293 return -EFAULT;
3295 memset(&tmp, 0, sizeof(tmp));
3297 spin_lock_irqsave(&ch->ch_lock, lock_flags);
3298 tmp = readw(&(ch->ch_bs->edelay));
3299 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
3301 if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
3302 return -EFAULT;
3304 return 0;
3308 * dgap_tty_digisetedelay()
3310 * Ioctl to set the EDELAY setting
3313 static int dgap_tty_digisetedelay(struct tty_struct *tty, int __user *new_info)
3315 struct board_t *bd;
3316 struct channel_t *ch;
3317 struct un_t *un;
3318 int new_digi;
3319 ulong lock_flags;
3320 ulong lock_flags2;
3322 if (!tty || tty->magic != TTY_MAGIC)
3323 return -EFAULT;
3325 un = tty->driver_data;
3326 if (!un || un->magic != DGAP_UNIT_MAGIC)
3327 return -EFAULT;
3329 ch = un->un_ch;
3330 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3331 return -EFAULT;
3333 bd = ch->ch_bd;
3334 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3335 return -EFAULT;
3337 if (copy_from_user(&new_digi, new_info, sizeof(int)))
3338 return -EFAULT;
3340 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3341 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3343 writew((u16) new_digi, &(ch->ch_bs->edelay));
3345 dgap_param(tty);
3347 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3348 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3350 return 0;
3354 * dgap_tty_digigetcustombaud()
3356 * Ioctl to get the current custom baud rate setting.
3358 static int dgap_tty_digigetcustombaud(struct tty_struct *tty,
3359 int __user *retinfo)
3361 struct channel_t *ch;
3362 struct un_t *un;
3363 int tmp;
3364 ulong lock_flags;
3366 if (!retinfo)
3367 return -EFAULT;
3369 if (!tty || tty->magic != TTY_MAGIC)
3370 return -EFAULT;
3372 un = tty->driver_data;
3373 if (!un || un->magic != DGAP_UNIT_MAGIC)
3374 return -EFAULT;
3376 ch = un->un_ch;
3377 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3378 return -EFAULT;
3380 memset(&tmp, 0, sizeof(tmp));
3382 spin_lock_irqsave(&ch->ch_lock, lock_flags);
3383 tmp = dgap_get_custom_baud(ch);
3384 spin_unlock_irqrestore(&ch->ch_lock, lock_flags);
3386 if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
3387 return -EFAULT;
3389 return 0;
3393 * dgap_tty_digisetcustombaud()
3395 * Ioctl to set the custom baud rate setting
3397 static int dgap_tty_digisetcustombaud(struct tty_struct *tty,
3398 int __user *new_info)
3400 struct board_t *bd;
3401 struct channel_t *ch;
3402 struct un_t *un;
3403 uint new_rate;
3404 ulong lock_flags;
3405 ulong lock_flags2;
3407 if (!tty || tty->magic != TTY_MAGIC)
3408 return -EFAULT;
3410 un = tty->driver_data;
3411 if (!un || un->magic != DGAP_UNIT_MAGIC)
3412 return -EFAULT;
3414 ch = un->un_ch;
3415 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3416 return -EFAULT;
3418 bd = ch->ch_bd;
3419 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3420 return -EFAULT;
3423 if (copy_from_user(&new_rate, new_info, sizeof(unsigned int)))
3424 return -EFAULT;
3426 if (bd->bd_flags & BD_FEP5PLUS) {
3428 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3429 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3431 ch->ch_custom_speed = new_rate;
3433 dgap_param(tty);
3435 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3436 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3439 return 0;
3443 * dgap_set_termios()
3445 static void dgap_tty_set_termios(struct tty_struct *tty,
3446 struct ktermios *old_termios)
3448 struct board_t *bd;
3449 struct channel_t *ch;
3450 struct un_t *un;
3451 unsigned long lock_flags;
3452 unsigned long lock_flags2;
3454 if (!tty || tty->magic != TTY_MAGIC)
3455 return;
3457 un = tty->driver_data;
3458 if (!un || un->magic != DGAP_UNIT_MAGIC)
3459 return;
3461 ch = un->un_ch;
3462 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3463 return;
3465 bd = ch->ch_bd;
3466 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3467 return;
3469 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3470 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3472 ch->ch_c_cflag = tty->termios.c_cflag;
3473 ch->ch_c_iflag = tty->termios.c_iflag;
3474 ch->ch_c_oflag = tty->termios.c_oflag;
3475 ch->ch_c_lflag = tty->termios.c_lflag;
3476 ch->ch_startc = tty->termios.c_cc[VSTART];
3477 ch->ch_stopc = tty->termios.c_cc[VSTOP];
3479 dgap_carrier(ch);
3480 dgap_param(tty);
3482 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3483 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3486 static void dgap_tty_throttle(struct tty_struct *tty)
3488 struct board_t *bd;
3489 struct channel_t *ch;
3490 struct un_t *un;
3491 ulong lock_flags;
3492 ulong lock_flags2;
3494 if (!tty || tty->magic != TTY_MAGIC)
3495 return;
3497 un = tty->driver_data;
3498 if (!un || un->magic != DGAP_UNIT_MAGIC)
3499 return;
3501 ch = un->un_ch;
3502 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3503 return;
3505 bd = ch->ch_bd;
3506 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3507 return;
3509 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3510 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3512 ch->ch_flags |= (CH_RXBLOCK);
3513 #if 1
3514 dgap_cmdw(ch, RPAUSE, 0, 0);
3515 #endif
3517 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3518 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3522 static void dgap_tty_unthrottle(struct tty_struct *tty)
3524 struct board_t *bd;
3525 struct channel_t *ch;
3526 struct un_t *un;
3527 ulong lock_flags;
3528 ulong lock_flags2;
3530 if (!tty || tty->magic != TTY_MAGIC)
3531 return;
3533 un = tty->driver_data;
3534 if (!un || un->magic != DGAP_UNIT_MAGIC)
3535 return;
3537 ch = un->un_ch;
3538 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3539 return;
3541 bd = ch->ch_bd;
3542 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3543 return;
3545 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3546 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3548 ch->ch_flags &= ~(CH_RXBLOCK);
3550 #if 1
3551 dgap_cmdw(ch, RRESUME, 0, 0);
3552 #endif
3554 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3555 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3558 static void dgap_tty_start(struct tty_struct *tty)
3560 struct board_t *bd;
3561 struct channel_t *ch;
3562 struct un_t *un;
3563 ulong lock_flags;
3564 ulong lock_flags2;
3566 if (!tty || tty->magic != TTY_MAGIC)
3567 return;
3569 un = tty->driver_data;
3570 if (!un || un->magic != DGAP_UNIT_MAGIC)
3571 return;
3573 ch = un->un_ch;
3574 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3575 return;
3577 bd = ch->ch_bd;
3578 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3579 return;
3581 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3582 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3584 dgap_cmdw(ch, RESUMETX, 0, 0);
3586 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3587 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3590 static void dgap_tty_stop(struct tty_struct *tty)
3592 struct board_t *bd;
3593 struct channel_t *ch;
3594 struct un_t *un;
3595 ulong lock_flags;
3596 ulong lock_flags2;
3598 if (!tty || tty->magic != TTY_MAGIC)
3599 return;
3601 un = tty->driver_data;
3602 if (!un || un->magic != DGAP_UNIT_MAGIC)
3603 return;
3605 ch = un->un_ch;
3606 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3607 return;
3609 bd = ch->ch_bd;
3610 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3611 return;
3613 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3614 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3616 dgap_cmdw(ch, PAUSETX, 0, 0);
3618 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3619 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3623 * dgap_tty_flush_chars()
3625 * Flush the cook buffer
3627 * Note to self, and any other poor souls who venture here:
3629 * flush in this case DOES NOT mean dispose of the data.
3630 * instead, it means "stop buffering and send it if you
3631 * haven't already." Just guess how I figured that out... SRW 2-Jun-98
3633 * It is also always called in interrupt context - JAR 8-Sept-99
3635 static void dgap_tty_flush_chars(struct tty_struct *tty)
3637 struct board_t *bd;
3638 struct channel_t *ch;
3639 struct un_t *un;
3640 ulong lock_flags;
3641 ulong lock_flags2;
3643 if (!tty || tty->magic != TTY_MAGIC)
3644 return;
3646 un = tty->driver_data;
3647 if (!un || un->magic != DGAP_UNIT_MAGIC)
3648 return;
3650 ch = un->un_ch;
3651 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3652 return;
3654 bd = ch->ch_bd;
3655 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3656 return;
3658 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3659 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3661 /* TODO: Do something here */
3663 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3664 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3668 * dgap_tty_flush_buffer()
3670 * Flush Tx buffer (make in == out)
3672 static void dgap_tty_flush_buffer(struct tty_struct *tty)
3674 struct board_t *bd;
3675 struct channel_t *ch;
3676 struct un_t *un;
3677 ulong lock_flags;
3678 ulong lock_flags2;
3679 u16 head;
3681 if (!tty || tty->magic != TTY_MAGIC)
3682 return;
3684 un = tty->driver_data;
3685 if (!un || un->magic != DGAP_UNIT_MAGIC)
3686 return;
3688 ch = un->un_ch;
3689 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3690 return;
3692 bd = ch->ch_bd;
3693 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3694 return;
3696 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3697 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3699 ch->ch_flags &= ~CH_STOP;
3700 head = readw(&(ch->ch_bs->tx_head));
3701 dgap_cmdw(ch, FLUSHTX, (u16) head, 0);
3702 dgap_cmdw(ch, RESUMETX, 0, 0);
3703 if (ch->ch_tun.un_flags & (UN_LOW|UN_EMPTY)) {
3704 ch->ch_tun.un_flags &= ~(UN_LOW|UN_EMPTY);
3705 wake_up_interruptible(&ch->ch_tun.un_flags_wait);
3707 if (ch->ch_pun.un_flags & (UN_LOW|UN_EMPTY)) {
3708 ch->ch_pun.un_flags &= ~(UN_LOW|UN_EMPTY);
3709 wake_up_interruptible(&ch->ch_pun.un_flags_wait);
3712 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3713 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3714 if (waitqueue_active(&tty->write_wait))
3715 wake_up_interruptible(&tty->write_wait);
3716 tty_wakeup(tty);
3719 /*****************************************************************************
3721 * The IOCTL function and all of its helpers
3723 *****************************************************************************/
3726 * dgap_tty_ioctl()
3728 * The usual assortment of ioctl's
3730 static int dgap_tty_ioctl(struct tty_struct *tty, unsigned int cmd,
3731 unsigned long arg)
3733 struct board_t *bd;
3734 struct channel_t *ch;
3735 struct un_t *un;
3736 int rc;
3737 u16 head;
3738 ulong lock_flags = 0;
3739 ulong lock_flags2 = 0;
3740 void __user *uarg = (void __user *) arg;
3742 if (!tty || tty->magic != TTY_MAGIC)
3743 return -ENODEV;
3745 un = tty->driver_data;
3746 if (!un || un->magic != DGAP_UNIT_MAGIC)
3747 return -ENODEV;
3749 ch = un->un_ch;
3750 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3751 return -ENODEV;
3753 bd = ch->ch_bd;
3754 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3755 return -ENODEV;
3757 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3758 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3760 if (un->un_open_count <= 0) {
3761 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3762 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3763 return -EIO;
3766 switch (cmd) {
3768 /* Here are all the standard ioctl's that we MUST implement */
3770 case TCSBRK:
3772 * TCSBRK is SVID version: non-zero arg --> no break
3773 * this behaviour is exploited by tcdrain().
3775 * According to POSIX.1 spec (7.2.2.1.2) breaks should be
3776 * between 0.25 and 0.5 seconds so we'll ask for something
3777 * in the middle: 0.375 seconds.
3779 rc = tty_check_change(tty);
3780 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3781 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3782 if (rc)
3783 return rc;
3785 rc = dgap_wait_for_drain(tty);
3787 if (rc)
3788 return -EINTR;
3790 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3791 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3793 if (((cmd == TCSBRK) && (!arg)) || (cmd == TCSBRKP))
3794 dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
3796 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3797 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3799 return 0;
3801 case TCSBRKP:
3802 /* support for POSIX tcsendbreak()
3804 * According to POSIX.1 spec (7.2.2.1.2) breaks should be
3805 * between 0.25 and 0.5 seconds so we'll ask for something
3806 * in the middle: 0.375 seconds.
3808 rc = tty_check_change(tty);
3809 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3810 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3811 if (rc)
3812 return rc;
3814 rc = dgap_wait_for_drain(tty);
3815 if (rc)
3816 return -EINTR;
3818 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3819 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3821 dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
3823 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3824 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3826 return 0;
3828 case TIOCSBRK:
3830 * FEP5 doesn't support turning on a break unconditionally.
3831 * The FEP5 device will stop sending a break automatically
3832 * after the specified time value that was sent when turning on
3833 * the break.
3835 rc = tty_check_change(tty);
3836 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3837 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3838 if (rc)
3839 return rc;
3841 rc = dgap_wait_for_drain(tty);
3842 if (rc)
3843 return -EINTR;
3845 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3846 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3848 dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
3850 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3851 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3853 return 0;
3855 case TIOCCBRK:
3857 * FEP5 doesn't support turning off a break unconditionally.
3858 * The FEP5 device will stop sending a break automatically
3859 * after the specified time value that was sent when turning on
3860 * the break.
3862 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3863 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3864 return 0;
3866 case TIOCGSOFTCAR:
3868 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3869 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3871 rc = put_user(C_CLOCAL(tty) ? 1 : 0,
3872 (unsigned long __user *) arg);
3873 return rc;
3875 case TIOCSSOFTCAR:
3876 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3877 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3879 rc = get_user(arg, (unsigned long __user *) arg);
3880 if (rc)
3881 return rc;
3883 spin_lock_irqsave(&bd->bd_lock, lock_flags);
3884 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
3885 tty->termios.c_cflag = ((tty->termios.c_cflag & ~CLOCAL) |
3886 (arg ? CLOCAL : 0));
3887 dgap_param(tty);
3888 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3889 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3891 return 0;
3893 case TIOCMGET:
3894 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3895 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3896 return dgap_get_modem_info(ch, uarg);
3898 case TIOCMBIS:
3899 case TIOCMBIC:
3900 case TIOCMSET:
3901 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3902 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3903 return dgap_set_modem_info(tty, cmd, uarg);
3906 * Here are any additional ioctl's that we want to implement
3909 case TCFLSH:
3911 * The linux tty driver doesn't have a flush
3912 * input routine for the driver, assuming all backed
3913 * up data is in the line disc. buffers. However,
3914 * we all know that's not the case. Here, we
3915 * act on the ioctl, but then lie and say we didn't
3916 * so the line discipline will process the flush
3917 * also.
3919 rc = tty_check_change(tty);
3920 if (rc) {
3921 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3922 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3923 return rc;
3926 if ((arg == TCIFLUSH) || (arg == TCIOFLUSH)) {
3927 if (!(un->un_type == DGAP_PRINT)) {
3928 head = readw(&(ch->ch_bs->rx_head));
3929 writew(head, &(ch->ch_bs->rx_tail));
3930 writeb(0, &(ch->ch_bs->orun));
3934 if ((arg != TCOFLUSH) && (arg != TCIOFLUSH)) {
3935 /* pretend we didn't recognize this IOCTL */
3936 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3937 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3939 return -ENOIOCTLCMD;
3942 ch->ch_flags &= ~CH_STOP;
3943 head = readw(&(ch->ch_bs->tx_head));
3944 dgap_cmdw(ch, FLUSHTX, (u16) head, 0);
3945 dgap_cmdw(ch, RESUMETX, 0, 0);
3946 if (ch->ch_tun.un_flags & (UN_LOW|UN_EMPTY)) {
3947 ch->ch_tun.un_flags &= ~(UN_LOW|UN_EMPTY);
3948 wake_up_interruptible(&ch->ch_tun.un_flags_wait);
3950 if (ch->ch_pun.un_flags & (UN_LOW|UN_EMPTY)) {
3951 ch->ch_pun.un_flags &= ~(UN_LOW|UN_EMPTY);
3952 wake_up_interruptible(&ch->ch_pun.un_flags_wait);
3954 if (waitqueue_active(&tty->write_wait))
3955 wake_up_interruptible(&tty->write_wait);
3957 /* Can't hold any locks when calling tty_wakeup! */
3958 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3959 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3960 tty_wakeup(tty);
3962 /* pretend we didn't recognize this IOCTL */
3963 return -ENOIOCTLCMD;
3965 case TCSETSF:
3966 case TCSETSW:
3968 * The linux tty driver doesn't have a flush
3969 * input routine for the driver, assuming all backed
3970 * up data is in the line disc. buffers. However,
3971 * we all know that's not the case. Here, we
3972 * act on the ioctl, but then lie and say we didn't
3973 * so the line discipline will process the flush
3974 * also.
3976 if (cmd == TCSETSF) {
3977 /* flush rx */
3978 ch->ch_flags &= ~CH_STOP;
3979 head = readw(&(ch->ch_bs->rx_head));
3980 writew(head, &(ch->ch_bs->rx_tail));
3983 /* now wait for all the output to drain */
3984 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3985 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3986 rc = dgap_wait_for_drain(tty);
3987 if (rc)
3988 return -EINTR;
3990 /* pretend we didn't recognize this */
3991 return -ENOIOCTLCMD;
3993 case TCSETAW:
3995 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
3996 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
3997 rc = dgap_wait_for_drain(tty);
3998 if (rc)
3999 return -EINTR;
4001 /* pretend we didn't recognize this */
4002 return -ENOIOCTLCMD;
4004 case TCXONC:
4006 * The Linux Line Discipline (LD) would do this for us if we
4007 * let it, but we have the special firmware options to do this
4008 * the "right way" regardless of hardware or software flow
4009 * control so we'll do it outselves instead of letting the LD
4010 * do it.
4012 rc = tty_check_change(tty);
4013 if (rc) {
4014 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4015 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4016 return rc;
4019 switch (arg) {
4021 case TCOON:
4022 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4023 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4024 dgap_tty_start(tty);
4025 return 0;
4026 case TCOOFF:
4027 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4028 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4029 dgap_tty_stop(tty);
4030 return 0;
4031 case TCION:
4032 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4033 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4034 /* Make the ld do it */
4035 return -ENOIOCTLCMD;
4036 case TCIOFF:
4037 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4038 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4039 /* Make the ld do it */
4040 return -ENOIOCTLCMD;
4041 default:
4042 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4043 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4044 return -EINVAL;
4047 case DIGI_GETA:
4048 /* get information for ditty */
4049 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4050 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4051 return dgap_tty_digigeta(tty, uarg);
4053 case DIGI_SETAW:
4054 case DIGI_SETAF:
4056 /* set information for ditty */
4057 if (cmd == (DIGI_SETAW)) {
4059 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4060 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4061 rc = dgap_wait_for_drain(tty);
4062 if (rc)
4063 return -EINTR;
4064 spin_lock_irqsave(&bd->bd_lock, lock_flags);
4065 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
4066 } else
4067 tty_ldisc_flush(tty);
4068 /* fall thru */
4070 case DIGI_SETA:
4071 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4072 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4073 return dgap_tty_digiseta(tty, uarg);
4075 case DIGI_GEDELAY:
4076 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4077 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4078 return dgap_tty_digigetedelay(tty, uarg);
4080 case DIGI_SEDELAY:
4081 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4082 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4083 return dgap_tty_digisetedelay(tty, uarg);
4085 case DIGI_GETCUSTOMBAUD:
4086 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4087 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4088 return dgap_tty_digigetcustombaud(tty, uarg);
4090 case DIGI_SETCUSTOMBAUD:
4091 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4092 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4093 return dgap_tty_digisetcustombaud(tty, uarg);
4095 case DIGI_RESET_PORT:
4096 dgap_firmware_reset_port(ch);
4097 dgap_param(tty);
4098 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4099 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4100 return 0;
4102 default:
4103 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
4104 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4106 return -ENOIOCTLCMD;
4110 static int dgap_after_config_loaded(int board)
4113 * Initialize KME waitqueues...
4115 init_waitqueue_head(&(dgap_board[board]->kme_wait));
4118 * allocate flip buffer for board.
4120 dgap_board[board]->flipbuf = kmalloc(MYFLIPLEN, GFP_KERNEL);
4121 if (!dgap_board[board]->flipbuf)
4122 return -ENOMEM;
4124 dgap_board[board]->flipflagbuf = kmalloc(MYFLIPLEN, GFP_KERNEL);
4125 if (!dgap_board[board]->flipflagbuf) {
4126 kfree(dgap_board[board]->flipbuf);
4127 return -ENOMEM;
4130 return 0;
4134 * Create pr and tty device entries
4136 static int dgap_tty_register_ports(struct board_t *brd)
4138 struct channel_t *ch;
4139 int i;
4141 brd->serial_ports = kcalloc(brd->nasync, sizeof(*brd->serial_ports),
4142 GFP_KERNEL);
4143 if (!brd->serial_ports)
4144 return -ENOMEM;
4146 brd->printer_ports = kcalloc(brd->nasync, sizeof(*brd->printer_ports),
4147 GFP_KERNEL);
4148 if (!brd->printer_ports) {
4149 kfree(brd->serial_ports);
4150 return -ENOMEM;
4153 for (i = 0; i < brd->nasync; i++) {
4154 tty_port_init(&brd->serial_ports[i]);
4155 tty_port_init(&brd->printer_ports[i]);
4158 ch = brd->channels[0];
4159 for (i = 0; i < brd->nasync; i++, ch = brd->channels[i]) {
4161 struct device *classp;
4163 classp = tty_port_register_device(&brd->serial_ports[i],
4164 brd->serial_driver,
4165 brd->firstminor + i, NULL);
4167 dgap_create_tty_sysfs(&ch->ch_tun, classp);
4168 ch->ch_tun.un_sysfs = classp;
4170 classp = tty_port_register_device(&brd->printer_ports[i],
4171 brd->print_driver,
4172 brd->firstminor + i, NULL);
4174 dgap_create_tty_sysfs(&ch->ch_pun, classp);
4175 ch->ch_pun.un_sysfs = classp;
4177 dgap_create_ports_sysfiles(brd);
4179 return 0;
4183 * Copies the BIOS code from the user to the board,
4184 * and starts the BIOS running.
4186 static void dgap_do_bios_load(struct board_t *brd, const u8 *ubios, int len)
4188 u8 __iomem *addr;
4189 uint offset;
4190 int i;
4192 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4193 return;
4195 addr = brd->re_map_membase;
4198 * clear POST area
4200 for (i = 0; i < 16; i++)
4201 writeb(0, addr + POSTAREA + i);
4204 * Download bios
4206 offset = 0x1000;
4207 memcpy_toio(addr + offset, ubios, len);
4209 writel(0x0bf00401, addr);
4210 writel(0, (addr + 4));
4212 /* Clear the reset, and change states. */
4213 writeb(FEPCLR, brd->re_map_port);
4217 * Checks to see if the BIOS completed running on the card.
4219 static int dgap_test_bios(struct board_t *brd)
4221 u8 __iomem *addr;
4222 u16 word;
4223 u16 err1;
4224 u16 err2;
4226 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4227 return -EINVAL;
4229 addr = brd->re_map_membase;
4230 word = readw(addr + POSTAREA);
4233 * It can take 5-6 seconds for a board to
4234 * pass the bios self test and post results.
4235 * Give it 10 seconds.
4237 brd->wait_for_bios = 0;
4238 while (brd->wait_for_bios < 1000) {
4239 /* Check to see if BIOS thinks board is good. (GD). */
4240 if (word == *(u16 *) "GD")
4241 return 0;
4242 msleep_interruptible(10);
4243 brd->wait_for_bios++;
4244 word = readw(addr + POSTAREA);
4247 /* Gave up on board after too long of time taken */
4248 err1 = readw(addr + SEQUENCE);
4249 err2 = readw(addr + ERROR);
4250 pr_warn("dgap: %s failed diagnostics. Error #(%x,%x).\n",
4251 brd->name, err1, err2);
4252 brd->state = BOARD_FAILED;
4253 brd->dpastatus = BD_NOBIOS;
4255 return -EIO;
4259 * Copies the FEP code from the user to the board,
4260 * and starts the FEP running.
4262 static void dgap_do_fep_load(struct board_t *brd, const u8 *ufep, int len)
4264 u8 __iomem *addr;
4265 uint offset;
4267 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4268 return;
4270 addr = brd->re_map_membase;
4273 * Download FEP
4275 offset = 0x1000;
4276 memcpy_toio(addr + offset, ufep, len);
4279 * If board is a concentrator product, we need to give
4280 * it its config string describing how the concentrators look.
4282 if ((brd->type == PCX) || (brd->type == PEPC)) {
4283 u8 string[100];
4284 u8 __iomem *config;
4285 u8 *xconfig;
4286 int i = 0;
4288 xconfig = dgap_create_config_string(brd, string);
4290 /* Write string to board memory */
4291 config = addr + CONFIG;
4292 for (; i < CONFIGSIZE; i++, config++, xconfig++) {
4293 writeb(*xconfig, config);
4294 if ((*xconfig & 0xff) == 0xff)
4295 break;
4299 writel(0xbfc01004, (addr + 0xc34));
4300 writel(0x3, (addr + 0xc30));
4305 * Waits for the FEP to report thats its ready for us to use.
4307 static int dgap_test_fep(struct board_t *brd)
4309 u8 __iomem *addr;
4310 u16 word;
4311 u16 err1;
4312 u16 err2;
4314 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4315 return -EINVAL;
4317 addr = brd->re_map_membase;
4318 word = readw(addr + FEPSTAT);
4321 * It can take 2-3 seconds for the FEP to
4322 * be up and running. Give it 5 secs.
4324 brd->wait_for_fep = 0;
4325 while (brd->wait_for_fep < 500) {
4326 /* Check to see if FEP is up and running now. */
4327 if (word == *(u16 *) "OS") {
4329 * Check to see if the board can support FEP5+ commands.
4331 word = readw(addr + FEP5_PLUS);
4332 if (word == *(u16 *) "5A")
4333 brd->bd_flags |= BD_FEP5PLUS;
4335 return 0;
4337 msleep_interruptible(10);
4338 brd->wait_for_fep++;
4339 word = readw(addr + FEPSTAT);
4342 /* Gave up on board after too long of time taken */
4343 err1 = readw(addr + SEQUENCE);
4344 err2 = readw(addr + ERROR);
4345 pr_warn("dgap: FEPOS for %s not functioning. Error #(%x,%x).\n",
4346 brd->name, err1, err2);
4347 brd->state = BOARD_FAILED;
4348 brd->dpastatus = BD_NOFEP;
4350 return -EIO;
4354 * Physically forces the FEP5 card to reset itself.
4356 static void dgap_do_reset_board(struct board_t *brd)
4358 u8 check;
4359 u32 check1;
4360 u32 check2;
4361 int i;
4363 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) ||
4364 !brd->re_map_membase || !brd->re_map_port)
4365 return;
4367 /* FEPRST does not vary among supported boards */
4368 writeb(FEPRST, brd->re_map_port);
4370 for (i = 0; i <= 1000; i++) {
4371 check = readb(brd->re_map_port) & 0xe;
4372 if (check == FEPRST)
4373 break;
4374 udelay(10);
4377 if (i > 1000) {
4378 pr_warn("dgap: Board not resetting... Failing board.\n");
4379 brd->state = BOARD_FAILED;
4380 brd->dpastatus = BD_NOFEP;
4381 return;
4385 * Make sure there really is memory out there.
4387 writel(0xa55a3cc3, (brd->re_map_membase + LOWMEM));
4388 writel(0x5aa5c33c, (brd->re_map_membase + HIGHMEM));
4389 check1 = readl(brd->re_map_membase + LOWMEM);
4390 check2 = readl(brd->re_map_membase + HIGHMEM);
4392 if ((check1 != 0xa55a3cc3) || (check2 != 0x5aa5c33c)) {
4393 pr_warn("dgap: No memory at %p for board.\n",
4394 brd->re_map_membase);
4395 brd->state = BOARD_FAILED;
4396 brd->dpastatus = BD_NOFEP;
4397 return;
4401 #ifdef DIGI_CONCENTRATORS_SUPPORTED
4403 * Sends a concentrator image into the FEP5 board.
4405 static void dgap_do_conc_load(struct board_t *brd, u8 *uaddr, int len)
4407 char __iomem *vaddr;
4408 u16 offset;
4409 struct downld_t *to_dp;
4411 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4412 return;
4414 vaddr = brd->re_map_membase;
4416 offset = readw((u16 *) (vaddr + DOWNREQ));
4417 to_dp = (struct downld_t *) (vaddr + (int) offset);
4418 memcpy_toio(to_dp, uaddr, len);
4420 /* Tell card we have data for it */
4421 writew(0, vaddr + (DOWNREQ));
4423 brd->conc_dl_status = NO_PENDING_CONCENTRATOR_REQUESTS;
4425 #endif
4427 #define EXPANSION_ROM_SIZE (64 * 1024)
4428 #define FEP5_ROM_MAGIC (0xFEFFFFFF)
4430 static void dgap_get_vpd(struct board_t *brd)
4432 u32 magic;
4433 u32 base_offset;
4434 u16 rom_offset;
4435 u16 vpd_offset;
4436 u16 image_length;
4437 u16 i;
4438 u8 byte1;
4439 u8 byte2;
4442 * Poke the magic number at the PCI Rom Address location.
4443 * If VPD is supported, the value read from that address
4444 * will be non-zero.
4446 magic = FEP5_ROM_MAGIC;
4447 pci_write_config_dword(brd->pdev, PCI_ROM_ADDRESS, magic);
4448 pci_read_config_dword(brd->pdev, PCI_ROM_ADDRESS, &magic);
4450 /* VPD not supported, bail */
4451 if (!magic)
4452 return;
4455 * To get to the OTPROM memory, we have to send the boards base
4456 * address or'ed with 1 into the PCI Rom Address location.
4458 magic = brd->membase | 0x01;
4459 pci_write_config_dword(brd->pdev, PCI_ROM_ADDRESS, magic);
4460 pci_read_config_dword(brd->pdev, PCI_ROM_ADDRESS, &magic);
4462 byte1 = readb(brd->re_map_membase);
4463 byte2 = readb(brd->re_map_membase + 1);
4466 * If the board correctly swapped to the OTPROM memory,
4467 * the first 2 bytes (header) should be 0x55, 0xAA
4469 if (byte1 == 0x55 && byte2 == 0xAA) {
4471 base_offset = 0;
4474 * We have to run through all the OTPROM memory looking
4475 * for the VPD offset.
4477 while (base_offset <= EXPANSION_ROM_SIZE) {
4480 * Lots of magic numbers here.
4482 * The VPD offset is located inside the ROM Data
4483 * Structure.
4485 * We also have to remember the length of each
4486 * ROM Data Structure, so we can "hop" to the next
4487 * entry if the VPD isn't in the current
4488 * ROM Data Structure.
4490 rom_offset = readw(brd->re_map_membase +
4491 base_offset + 0x18);
4492 image_length = readw(brd->re_map_membase +
4493 rom_offset + 0x10) * 512;
4494 vpd_offset = readw(brd->re_map_membase +
4495 rom_offset + 0x08);
4497 /* Found the VPD entry */
4498 if (vpd_offset)
4499 break;
4501 /* We didn't find a VPD entry, go to next ROM entry. */
4502 base_offset += image_length;
4504 byte1 = readb(brd->re_map_membase + base_offset);
4505 byte2 = readb(brd->re_map_membase + base_offset + 1);
4508 * If the new ROM offset doesn't have 0x55, 0xAA
4509 * as its header, we have run out of ROM.
4511 if (byte1 != 0x55 || byte2 != 0xAA)
4512 break;
4516 * If we have a VPD offset, then mark the board
4517 * as having a valid VPD, and copy VPDSIZE (512) bytes of
4518 * that VPD to the buffer we have in our board structure.
4520 if (vpd_offset) {
4521 brd->bd_flags |= BD_HAS_VPD;
4522 for (i = 0; i < VPDSIZE; i++) {
4523 brd->vpd[i] = readb(brd->re_map_membase +
4524 vpd_offset + i);
4530 * We MUST poke the magic number at the PCI Rom Address location again.
4531 * This makes the card report the regular board memory back to us,
4532 * rather than the OTPROM memory.
4534 magic = FEP5_ROM_MAGIC;
4535 pci_write_config_dword(brd->pdev, PCI_ROM_ADDRESS, magic);
4539 * Our board poller function.
4541 static void dgap_poll_tasklet(unsigned long data)
4543 struct board_t *bd = (struct board_t *) data;
4544 ulong lock_flags;
4545 char __iomem *vaddr;
4546 u16 head, tail;
4548 if (!bd || (bd->magic != DGAP_BOARD_MAGIC))
4549 return;
4551 if (bd->inhibit_poller)
4552 return;
4554 spin_lock_irqsave(&bd->bd_lock, lock_flags);
4556 vaddr = bd->re_map_membase;
4559 * If board is ready, parse deeper to see if there is anything to do.
4561 if (bd->state == BOARD_READY) {
4563 struct ev_t __iomem *eaddr;
4565 if (!bd->re_map_membase) {
4566 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4567 return;
4569 if (!bd->re_map_port) {
4570 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4571 return;
4574 if (!bd->nasync)
4575 goto out;
4577 eaddr = (struct ev_t __iomem *) (vaddr + EVBUF);
4579 /* Get our head and tail */
4580 head = readw(&(eaddr->ev_head));
4581 tail = readw(&(eaddr->ev_tail));
4584 * If there is an event pending. Go service it.
4586 if (head != tail) {
4587 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4588 dgap_event(bd);
4589 spin_lock_irqsave(&bd->bd_lock, lock_flags);
4592 out:
4594 * If board is doing interrupts, ACK the interrupt.
4596 if (bd && bd->intr_running)
4597 readb(bd->re_map_port + 2);
4599 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4600 return;
4603 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
4606 /*=======================================================================
4608 * dgap_cmdb - Sends a 2 byte command to the FEP.
4610 * ch - Pointer to channel structure.
4611 * cmd - Command to be sent.
4612 * byte1 - Integer containing first byte to be sent.
4613 * byte2 - Integer containing second byte to be sent.
4614 * ncmds - Wait until ncmds or fewer cmds are left
4615 * in the cmd buffer before returning.
4617 *=======================================================================*/
4618 static void dgap_cmdb(struct channel_t *ch, u8 cmd, u8 byte1,
4619 u8 byte2, uint ncmds)
4621 char __iomem *vaddr;
4622 struct __iomem cm_t *cm_addr;
4623 uint count;
4624 uint n;
4625 u16 head;
4626 u16 tail;
4628 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
4629 return;
4632 * Check if board is still alive.
4634 if (ch->ch_bd->state == BOARD_FAILED)
4635 return;
4638 * Make sure the pointers are in range before
4639 * writing to the FEP memory.
4641 vaddr = ch->ch_bd->re_map_membase;
4643 if (!vaddr)
4644 return;
4646 cm_addr = (struct cm_t __iomem *) (vaddr + CMDBUF);
4647 head = readw(&(cm_addr->cm_head));
4650 * Forget it if pointers out of range.
4652 if (head >= (CMDMAX - CMDSTART) || (head & 03)) {
4653 ch->ch_bd->state = BOARD_FAILED;
4654 return;
4658 * Put the data in the circular command buffer.
4660 writeb(cmd, (vaddr + head + CMDSTART + 0));
4661 writeb((u8) ch->ch_portnum, (vaddr + head + CMDSTART + 1));
4662 writeb(byte1, (vaddr + head + CMDSTART + 2));
4663 writeb(byte2, (vaddr + head + CMDSTART + 3));
4665 head = (head + 4) & (CMDMAX - CMDSTART - 4);
4667 writew(head, &(cm_addr->cm_head));
4670 * Wait if necessary before updating the head
4671 * pointer to limit the number of outstanding
4672 * commands to the FEP. If the time spent waiting
4673 * is outlandish, declare the FEP dead.
4675 for (count = dgap_count ;;) {
4677 head = readw(&(cm_addr->cm_head));
4678 tail = readw(&(cm_addr->cm_tail));
4680 n = (head - tail) & (CMDMAX - CMDSTART - 4);
4682 if (n <= ncmds * sizeof(struct cm_t))
4683 break;
4685 if (--count == 0) {
4686 ch->ch_bd->state = BOARD_FAILED;
4687 return;
4689 udelay(10);
4693 /*=======================================================================
4695 * dgap_cmdw - Sends a 1 word command to the FEP.
4697 * ch - Pointer to channel structure.
4698 * cmd - Command to be sent.
4699 * word - Integer containing word to be sent.
4700 * ncmds - Wait until ncmds or fewer cmds are left
4701 * in the cmd buffer before returning.
4703 *=======================================================================*/
4704 static void dgap_cmdw(struct channel_t *ch, u8 cmd, u16 word, uint ncmds)
4706 char __iomem *vaddr;
4707 struct __iomem cm_t *cm_addr;
4708 uint count;
4709 uint n;
4710 u16 head;
4711 u16 tail;
4713 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
4714 return;
4717 * Check if board is still alive.
4719 if (ch->ch_bd->state == BOARD_FAILED)
4720 return;
4723 * Make sure the pointers are in range before
4724 * writing to the FEP memory.
4726 vaddr = ch->ch_bd->re_map_membase;
4727 if (!vaddr)
4728 return;
4730 cm_addr = (struct cm_t __iomem *) (vaddr + CMDBUF);
4731 head = readw(&(cm_addr->cm_head));
4734 * Forget it if pointers out of range.
4736 if (head >= (CMDMAX - CMDSTART) || (head & 03)) {
4737 ch->ch_bd->state = BOARD_FAILED;
4738 return;
4742 * Put the data in the circular command buffer.
4744 writeb(cmd, (vaddr + head + CMDSTART + 0));
4745 writeb((u8) ch->ch_portnum, (vaddr + head + CMDSTART + 1));
4746 writew((u16) word, (vaddr + head + CMDSTART + 2));
4748 head = (head + 4) & (CMDMAX - CMDSTART - 4);
4750 writew(head, &(cm_addr->cm_head));
4753 * Wait if necessary before updating the head
4754 * pointer to limit the number of outstanding
4755 * commands to the FEP. If the time spent waiting
4756 * is outlandish, declare the FEP dead.
4758 for (count = dgap_count ;;) {
4760 head = readw(&(cm_addr->cm_head));
4761 tail = readw(&(cm_addr->cm_tail));
4763 n = (head - tail) & (CMDMAX - CMDSTART - 4);
4765 if (n <= ncmds * sizeof(struct cm_t))
4766 break;
4768 if (--count == 0) {
4769 ch->ch_bd->state = BOARD_FAILED;
4770 return;
4772 udelay(10);
4776 /*=======================================================================
4778 * dgap_cmdw_ext - Sends a extended word command to the FEP.
4780 * ch - Pointer to channel structure.
4781 * cmd - Command to be sent.
4782 * word - Integer containing word to be sent.
4783 * ncmds - Wait until ncmds or fewer cmds are left
4784 * in the cmd buffer before returning.
4786 *=======================================================================*/
4787 static void dgap_cmdw_ext(struct channel_t *ch, u16 cmd, u16 word, uint ncmds)
4789 char __iomem *vaddr;
4790 struct __iomem cm_t *cm_addr;
4791 uint count;
4792 uint n;
4793 u16 head;
4794 u16 tail;
4796 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
4797 return;
4800 * Check if board is still alive.
4802 if (ch->ch_bd->state == BOARD_FAILED)
4803 return;
4806 * Make sure the pointers are in range before
4807 * writing to the FEP memory.
4809 vaddr = ch->ch_bd->re_map_membase;
4810 if (!vaddr)
4811 return;
4813 cm_addr = (struct cm_t __iomem *) (vaddr + CMDBUF);
4814 head = readw(&(cm_addr->cm_head));
4817 * Forget it if pointers out of range.
4819 if (head >= (CMDMAX - CMDSTART) || (head & 03)) {
4820 ch->ch_bd->state = BOARD_FAILED;
4821 return;
4825 * Put the data in the circular command buffer.
4828 /* Write an FF to tell the FEP that we want an extended command */
4829 writeb((u8) 0xff, (vaddr + head + CMDSTART + 0));
4831 writeb((u8) ch->ch_portnum, (vaddr + head + CMDSTART + 1));
4832 writew((u16) cmd, (vaddr + head + CMDSTART + 2));
4835 * If the second part of the command won't fit,
4836 * put it at the beginning of the circular buffer.
4838 if (((head + 4) >= ((CMDMAX - CMDSTART)) || (head & 03)))
4839 writew((u16) word, (vaddr + CMDSTART));
4840 else
4841 writew((u16) word, (vaddr + head + CMDSTART + 4));
4843 head = (head + 8) & (CMDMAX - CMDSTART - 4);
4845 writew(head, &(cm_addr->cm_head));
4848 * Wait if necessary before updating the head
4849 * pointer to limit the number of outstanding
4850 * commands to the FEP. If the time spent waiting
4851 * is outlandish, declare the FEP dead.
4853 for (count = dgap_count ;;) {
4855 head = readw(&(cm_addr->cm_head));
4856 tail = readw(&(cm_addr->cm_tail));
4858 n = (head - tail) & (CMDMAX - CMDSTART - 4);
4860 if (n <= ncmds * sizeof(struct cm_t))
4861 break;
4863 if (--count == 0) {
4864 ch->ch_bd->state = BOARD_FAILED;
4865 return;
4867 udelay(10);
4871 /*=======================================================================
4873 * dgap_wmove - Write data to FEP buffer.
4875 * ch - Pointer to channel structure.
4876 * buf - Poiter to characters to be moved.
4877 * cnt - Number of characters to move.
4879 *=======================================================================*/
4880 static void dgap_wmove(struct channel_t *ch, char *buf, uint cnt)
4882 int n;
4883 char __iomem *taddr;
4884 struct bs_t __iomem *bs;
4885 u16 head;
4887 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
4888 return;
4891 * Check parameters.
4893 bs = ch->ch_bs;
4894 head = readw(&(bs->tx_head));
4897 * If pointers are out of range, just return.
4899 if ((cnt > ch->ch_tsize) ||
4900 (unsigned)(head - ch->ch_tstart) >= ch->ch_tsize)
4901 return;
4904 * If the write wraps over the top of the circular buffer,
4905 * move the portion up to the wrap point, and reset the
4906 * pointers to the bottom.
4908 n = ch->ch_tstart + ch->ch_tsize - head;
4910 if (cnt >= n) {
4911 cnt -= n;
4912 taddr = ch->ch_taddr + head;
4913 memcpy_toio(taddr, buf, n);
4914 head = ch->ch_tstart;
4915 buf += n;
4919 * Move rest of data.
4921 taddr = ch->ch_taddr + head;
4922 n = cnt;
4923 memcpy_toio(taddr, buf, n);
4924 head += cnt;
4926 writew(head, &(bs->tx_head));
4930 * Retrives the current custom baud rate from FEP memory,
4931 * and returns it back to the user.
4932 * Returns 0 on error.
4934 static uint dgap_get_custom_baud(struct channel_t *ch)
4936 u8 __iomem *vaddr;
4937 ulong offset;
4938 uint value;
4940 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
4941 return 0;
4943 if (!ch->ch_bd || ch->ch_bd->magic != DGAP_BOARD_MAGIC)
4944 return 0;
4946 if (!(ch->ch_bd->bd_flags & BD_FEP5PLUS))
4947 return 0;
4949 vaddr = ch->ch_bd->re_map_membase;
4951 if (!vaddr)
4952 return 0;
4955 * Go get from fep mem, what the fep
4956 * believes the custom baud rate is.
4958 offset = (ioread16(vaddr + ECS_SEG) << 4) + (ch->ch_portnum * 0x28)
4959 + LINE_SPEED;
4961 value = readw(vaddr + offset);
4962 return value;
4966 * Calls the firmware to reset this channel.
4968 static void dgap_firmware_reset_port(struct channel_t *ch)
4970 dgap_cmdb(ch, CHRESET, 0, 0, 0);
4973 * Now that the channel is reset, we need to make sure
4974 * all the current settings get reapplied to the port
4975 * in the firmware.
4977 * So we will set the driver's cache of firmware
4978 * settings all to 0, and then call param.
4980 ch->ch_fepiflag = 0;
4981 ch->ch_fepcflag = 0;
4982 ch->ch_fepoflag = 0;
4983 ch->ch_fepstartc = 0;
4984 ch->ch_fepstopc = 0;
4985 ch->ch_fepastartc = 0;
4986 ch->ch_fepastopc = 0;
4987 ch->ch_mostat = 0;
4988 ch->ch_hflow = 0;
4991 /*=======================================================================
4993 * dgap_param - Set Digi parameters.
4995 * struct tty_struct * - TTY for port.
4997 *=======================================================================*/
4998 static int dgap_param(struct tty_struct *tty)
5000 struct ktermios *ts;
5001 struct board_t *bd;
5002 struct channel_t *ch;
5003 struct bs_t __iomem *bs;
5004 struct un_t *un;
5005 u16 head;
5006 u16 cflag;
5007 u16 iflag;
5008 u8 mval;
5009 u8 hflow;
5011 if (!tty || tty->magic != TTY_MAGIC)
5012 return -EIO;
5014 un = (struct un_t *) tty->driver_data;
5015 if (!un || un->magic != DGAP_UNIT_MAGIC)
5016 return -EIO;
5018 ch = un->un_ch;
5019 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5020 return -EIO;
5022 bd = ch->ch_bd;
5023 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
5024 return -EIO;
5026 bs = ch->ch_bs;
5027 if (!bs)
5028 return -EIO;
5030 ts = &tty->termios;
5033 * If baud rate is zero, flush queues, and set mval to drop DTR.
5035 if ((ch->ch_c_cflag & (CBAUD)) == 0) {
5037 /* flush rx */
5038 head = readw(&(ch->ch_bs->rx_head));
5039 writew(head, &(ch->ch_bs->rx_tail));
5041 /* flush tx */
5042 head = readw(&(ch->ch_bs->tx_head));
5043 writew(head, &(ch->ch_bs->tx_tail));
5045 ch->ch_flags |= (CH_BAUD0);
5047 /* Drop RTS and DTR */
5048 ch->ch_mval &= ~(D_RTS(ch)|D_DTR(ch));
5049 mval = D_DTR(ch) | D_RTS(ch);
5050 ch->ch_baud_info = 0;
5052 } else if (ch->ch_custom_speed && (bd->bd_flags & BD_FEP5PLUS)) {
5054 * Tell the fep to do the command
5057 dgap_cmdw_ext(ch, 0xff01, ch->ch_custom_speed, 0);
5060 * Now go get from fep mem, what the fep
5061 * believes the custom baud rate is.
5063 ch->ch_custom_speed = dgap_get_custom_baud(ch);
5064 ch->ch_baud_info = ch->ch_custom_speed;
5066 /* Handle transition from B0 */
5067 if (ch->ch_flags & CH_BAUD0) {
5068 ch->ch_flags &= ~(CH_BAUD0);
5069 ch->ch_mval |= (D_RTS(ch)|D_DTR(ch));
5071 mval = D_DTR(ch) | D_RTS(ch);
5073 } else {
5075 * Set baud rate, character size, and parity.
5079 int iindex = 0;
5080 int jindex = 0;
5081 int baud = 0;
5083 ulong bauds[4][16] = {
5084 { /* slowbaud */
5085 0, 50, 75, 110,
5086 134, 150, 200, 300,
5087 600, 1200, 1800, 2400,
5088 4800, 9600, 19200, 38400 },
5089 { /* slowbaud & CBAUDEX */
5090 0, 57600, 115200, 230400,
5091 460800, 150, 200, 921600,
5092 600, 1200, 1800, 2400,
5093 4800, 9600, 19200, 38400 },
5094 { /* fastbaud */
5095 0, 57600, 76800, 115200,
5096 14400, 57600, 230400, 76800,
5097 115200, 230400, 28800, 460800,
5098 921600, 9600, 19200, 38400 },
5099 { /* fastbaud & CBAUDEX */
5100 0, 57600, 115200, 230400,
5101 460800, 150, 200, 921600,
5102 600, 1200, 1800, 2400,
5103 4800, 9600, 19200, 38400 }
5107 * Only use the TXPrint baud rate if the
5108 * terminal unit is NOT open
5110 if (!(ch->ch_tun.un_flags & UN_ISOPEN) &&
5111 (un->un_type == DGAP_PRINT))
5112 baud = C_BAUD(ch->ch_pun.un_tty) & 0xff;
5113 else
5114 baud = C_BAUD(ch->ch_tun.un_tty) & 0xff;
5116 if (ch->ch_c_cflag & CBAUDEX)
5117 iindex = 1;
5119 if (ch->ch_digi.digi_flags & DIGI_FAST)
5120 iindex += 2;
5122 jindex = baud;
5124 if ((iindex >= 0) && (iindex < 4) &&
5125 (jindex >= 0) && (jindex < 16))
5126 baud = bauds[iindex][jindex];
5127 else
5128 baud = 0;
5130 if (baud == 0)
5131 baud = 9600;
5133 ch->ch_baud_info = baud;
5136 * CBAUD has bit position 0x1000 set these days to
5137 * indicate Linux baud rate remap.
5138 * We use a different bit assignment for high speed.
5139 * Clear this bit out while grabbing the parts of
5140 * "cflag" we want.
5142 cflag = ch->ch_c_cflag & ((CBAUD ^ CBAUDEX) | PARODD | PARENB |
5143 CSTOPB | CSIZE);
5146 * HUPCL bit is used by FEP to indicate fast baud
5147 * table is to be used.
5149 if ((ch->ch_digi.digi_flags & DIGI_FAST) ||
5150 (ch->ch_c_cflag & CBAUDEX))
5151 cflag |= HUPCL;
5153 if ((ch->ch_c_cflag & CBAUDEX) &&
5154 !(ch->ch_digi.digi_flags & DIGI_FAST)) {
5156 * The below code is trying to guarantee that only
5157 * baud rates 115200, 230400, 460800, 921600 are
5158 * remapped. We use exclusive or because the various
5159 * baud rates share common bit positions and therefore
5160 * can't be tested for easily.
5162 tcflag_t tcflag = (ch->ch_c_cflag & CBAUD) | CBAUDEX;
5163 int baudpart = 0;
5166 * Map high speed requests to index
5167 * into FEP's baud table
5169 switch (tcflag) {
5170 case B57600:
5171 baudpart = 1;
5172 break;
5173 #ifdef B76800
5174 case B76800:
5175 baudpart = 2;
5176 break;
5177 #endif
5178 case B115200:
5179 baudpart = 3;
5180 break;
5181 case B230400:
5182 baudpart = 9;
5183 break;
5184 case B460800:
5185 baudpart = 11;
5186 break;
5187 #ifdef B921600
5188 case B921600:
5189 baudpart = 12;
5190 break;
5191 #endif
5192 default:
5193 baudpart = 0;
5196 if (baudpart)
5197 cflag = (cflag & ~(CBAUD | CBAUDEX)) | baudpart;
5200 cflag &= 0xffff;
5202 if (cflag != ch->ch_fepcflag) {
5203 ch->ch_fepcflag = (u16) (cflag & 0xffff);
5206 * Okay to have channel and board
5207 * locks held calling this
5209 dgap_cmdw(ch, SCFLAG, (u16) cflag, 0);
5212 /* Handle transition from B0 */
5213 if (ch->ch_flags & CH_BAUD0) {
5214 ch->ch_flags &= ~(CH_BAUD0);
5215 ch->ch_mval |= (D_RTS(ch)|D_DTR(ch));
5217 mval = D_DTR(ch) | D_RTS(ch);
5221 * Get input flags.
5223 iflag = ch->ch_c_iflag & (IGNBRK | BRKINT | IGNPAR | PARMRK |
5224 INPCK | ISTRIP | IXON | IXANY | IXOFF);
5226 if ((ch->ch_startc == _POSIX_VDISABLE) ||
5227 (ch->ch_stopc == _POSIX_VDISABLE)) {
5228 iflag &= ~(IXON | IXOFF);
5229 ch->ch_c_iflag &= ~(IXON | IXOFF);
5233 * Only the IBM Xr card can switch between
5234 * 232 and 422 modes on the fly
5236 if (bd->device == PCI_DEV_XR_IBM_DID) {
5237 if (ch->ch_digi.digi_flags & DIGI_422)
5238 dgap_cmdb(ch, SCOMMODE, MODE_422, 0, 0);
5239 else
5240 dgap_cmdb(ch, SCOMMODE, MODE_232, 0, 0);
5243 if (ch->ch_digi.digi_flags & DIGI_ALTPIN)
5244 iflag |= IALTPIN;
5246 if (iflag != ch->ch_fepiflag) {
5247 ch->ch_fepiflag = iflag;
5249 /* Okay to have channel and board locks held calling this */
5250 dgap_cmdw(ch, SIFLAG, (u16) ch->ch_fepiflag, 0);
5254 * Select hardware handshaking.
5256 hflow = 0;
5258 if (ch->ch_c_cflag & CRTSCTS)
5259 hflow |= (D_RTS(ch) | D_CTS(ch));
5260 if (ch->ch_digi.digi_flags & RTSPACE)
5261 hflow |= D_RTS(ch);
5262 if (ch->ch_digi.digi_flags & DTRPACE)
5263 hflow |= D_DTR(ch);
5264 if (ch->ch_digi.digi_flags & CTSPACE)
5265 hflow |= D_CTS(ch);
5266 if (ch->ch_digi.digi_flags & DSRPACE)
5267 hflow |= D_DSR(ch);
5268 if (ch->ch_digi.digi_flags & DCDPACE)
5269 hflow |= D_CD(ch);
5271 if (hflow != ch->ch_hflow) {
5272 ch->ch_hflow = hflow;
5274 /* Okay to have channel and board locks held calling this */
5275 dgap_cmdb(ch, SHFLOW, (u8) hflow, 0xff, 0);
5279 * Set RTS and/or DTR Toggle if needed,
5280 * but only if product is FEP5+ based.
5282 if (bd->bd_flags & BD_FEP5PLUS) {
5283 u16 hflow2 = 0;
5284 if (ch->ch_digi.digi_flags & DIGI_RTS_TOGGLE)
5285 hflow2 |= (D_RTS(ch));
5286 if (ch->ch_digi.digi_flags & DIGI_DTR_TOGGLE)
5287 hflow2 |= (D_DTR(ch));
5289 dgap_cmdw_ext(ch, 0xff03, hflow2, 0);
5293 * Set modem control lines.
5296 mval ^= ch->ch_mforce & (mval ^ ch->ch_mval);
5298 if (ch->ch_mostat ^ mval) {
5299 ch->ch_mostat = mval;
5301 /* Okay to have channel and board locks held calling this */
5302 dgap_cmdb(ch, SMODEM, (u8) mval, D_RTS(ch)|D_DTR(ch), 0);
5306 * Read modem signals, and then call carrier function.
5308 ch->ch_mistat = readb(&(bs->m_stat));
5309 dgap_carrier(ch);
5312 * Set the start and stop characters.
5314 if (ch->ch_startc != ch->ch_fepstartc ||
5315 ch->ch_stopc != ch->ch_fepstopc) {
5316 ch->ch_fepstartc = ch->ch_startc;
5317 ch->ch_fepstopc = ch->ch_stopc;
5319 /* Okay to have channel and board locks held calling this */
5320 dgap_cmdb(ch, SFLOWC, ch->ch_fepstartc, ch->ch_fepstopc, 0);
5324 * Set the Auxiliary start and stop characters.
5326 if (ch->ch_astartc != ch->ch_fepastartc ||
5327 ch->ch_astopc != ch->ch_fepastopc) {
5328 ch->ch_fepastartc = ch->ch_astartc;
5329 ch->ch_fepastopc = ch->ch_astopc;
5331 /* Okay to have channel and board locks held calling this */
5332 dgap_cmdb(ch, SAFLOWC, ch->ch_fepastartc, ch->ch_fepastopc, 0);
5335 return 0;
5339 * dgap_parity_scan()
5341 * Convert the FEP5 way of reporting parity errors and breaks into
5342 * the Linux line discipline way.
5344 static void dgap_parity_scan(struct channel_t *ch, unsigned char *cbuf,
5345 unsigned char *fbuf, int *len)
5347 int l = *len;
5348 int count = 0;
5349 unsigned char *in, *cout, *fout;
5350 unsigned char c;
5352 in = cbuf;
5353 cout = cbuf;
5354 fout = fbuf;
5356 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5357 return;
5359 while (l--) {
5360 c = *in++;
5361 switch (ch->pscan_state) {
5362 default:
5363 /* reset to sanity and fall through */
5364 ch->pscan_state = 0;
5366 case 0:
5367 /* No FF seen yet */
5368 if (c == (unsigned char) '\377')
5369 /* delete this character from stream */
5370 ch->pscan_state = 1;
5371 else {
5372 *cout++ = c;
5373 *fout++ = TTY_NORMAL;
5374 count += 1;
5376 break;
5378 case 1:
5379 /* first FF seen */
5380 if (c == (unsigned char) '\377') {
5381 /* doubled ff, transform to single ff */
5382 *cout++ = c;
5383 *fout++ = TTY_NORMAL;
5384 count += 1;
5385 ch->pscan_state = 0;
5386 } else {
5387 /* save value examination in next state */
5388 ch->pscan_savechar = c;
5389 ch->pscan_state = 2;
5391 break;
5393 case 2:
5394 /* third character of ff sequence */
5396 *cout++ = c;
5398 if (ch->pscan_savechar == 0x0) {
5400 if (c == 0x0) {
5401 ch->ch_err_break++;
5402 *fout++ = TTY_BREAK;
5403 } else {
5404 ch->ch_err_parity++;
5405 *fout++ = TTY_PARITY;
5409 count += 1;
5410 ch->pscan_state = 0;
5413 *len = count;
5416 static void dgap_write_wakeup(struct board_t *bd, struct channel_t *ch,
5417 struct un_t *un, u32 mask,
5418 unsigned long *irq_flags1,
5419 unsigned long *irq_flags2)
5421 if (!(un->un_flags & mask))
5422 return;
5424 un->un_flags &= ~mask;
5426 if (!(un->un_flags & UN_ISOPEN))
5427 return;
5429 if ((un->un_tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
5430 un->un_tty->ldisc->ops->write_wakeup) {
5431 spin_unlock_irqrestore(&ch->ch_lock, *irq_flags2);
5432 spin_unlock_irqrestore(&bd->bd_lock, *irq_flags1);
5434 (un->un_tty->ldisc->ops->write_wakeup)(un->un_tty);
5436 spin_lock_irqsave(&bd->bd_lock, *irq_flags1);
5437 spin_lock_irqsave(&ch->ch_lock, *irq_flags2);
5439 wake_up_interruptible(&un->un_tty->write_wait);
5440 wake_up_interruptible(&un->un_flags_wait);
5443 /*=======================================================================
5445 * dgap_event - FEP to host event processing routine.
5447 * bd - Board of current event.
5449 *=======================================================================*/
5450 static int dgap_event(struct board_t *bd)
5452 struct channel_t *ch;
5453 ulong lock_flags;
5454 ulong lock_flags2;
5455 struct bs_t __iomem *bs;
5456 u8 __iomem *event;
5457 u8 __iomem *vaddr;
5458 struct ev_t __iomem *eaddr;
5459 uint head;
5460 uint tail;
5461 int port;
5462 int reason;
5463 int modem;
5464 int b1;
5466 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
5467 return -EIO;
5469 spin_lock_irqsave(&bd->bd_lock, lock_flags);
5471 vaddr = bd->re_map_membase;
5473 if (!vaddr) {
5474 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
5475 return -EIO;
5478 eaddr = (struct ev_t __iomem *) (vaddr + EVBUF);
5480 /* Get our head and tail */
5481 head = readw(&(eaddr->ev_head));
5482 tail = readw(&(eaddr->ev_tail));
5485 * Forget it if pointers out of range.
5488 if (head >= EVMAX - EVSTART || tail >= EVMAX - EVSTART ||
5489 (head | tail) & 03) {
5490 /* Let go of board lock */
5491 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
5492 return -EIO;
5496 * Loop to process all the events in the buffer.
5498 while (tail != head) {
5501 * Get interrupt information.
5504 event = bd->re_map_membase + tail + EVSTART;
5506 port = ioread8(event);
5507 reason = ioread8(event + 1);
5508 modem = ioread8(event + 2);
5509 b1 = ioread8(event + 3);
5512 * Make sure the interrupt is valid.
5514 if (port >= bd->nasync)
5515 goto next;
5517 if (!(reason & (IFMODEM | IFBREAK | IFTLW | IFTEM | IFDATA)))
5518 goto next;
5520 ch = bd->channels[port];
5522 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5523 goto next;
5526 * If we have made it here, the event was valid.
5527 * Lock down the channel.
5529 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
5531 bs = ch->ch_bs;
5533 if (!bs) {
5534 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
5535 goto next;
5539 * Process received data.
5541 if (reason & IFDATA) {
5544 * ALL LOCKS *MUST* BE DROPPED BEFORE CALLING INPUT!
5545 * input could send some data to ld, which in turn
5546 * could do a callback to one of our other functions.
5548 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
5549 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
5551 dgap_input(ch);
5553 spin_lock_irqsave(&bd->bd_lock, lock_flags);
5554 spin_lock_irqsave(&ch->ch_lock, lock_flags2);
5556 if (ch->ch_flags & CH_RACTIVE)
5557 ch->ch_flags |= CH_RENABLE;
5558 else
5559 writeb(1, &(bs->idata));
5561 if (ch->ch_flags & CH_RWAIT) {
5562 ch->ch_flags &= ~CH_RWAIT;
5564 wake_up_interruptible
5565 (&ch->ch_tun.un_flags_wait);
5570 * Process Modem change signals.
5572 if (reason & IFMODEM) {
5573 ch->ch_mistat = modem;
5574 dgap_carrier(ch);
5578 * Process break.
5580 if (reason & IFBREAK) {
5582 if (ch->ch_tun.un_tty) {
5583 /* A break has been indicated */
5584 ch->ch_err_break++;
5585 tty_buffer_request_room
5586 (ch->ch_tun.un_tty->port, 1);
5587 tty_insert_flip_char(ch->ch_tun.un_tty->port,
5588 0, TTY_BREAK);
5589 tty_flip_buffer_push(ch->ch_tun.un_tty->port);
5594 * Process Transmit low.
5596 if (reason & IFTLW) {
5597 dgap_write_wakeup(bd, ch, &ch->ch_tun, UN_LOW,
5598 &lock_flags, &lock_flags2);
5599 dgap_write_wakeup(bd, ch, &ch->ch_pun, UN_LOW,
5600 &lock_flags, &lock_flags2);
5601 if (ch->ch_flags & CH_WLOW) {
5602 ch->ch_flags &= ~CH_WLOW;
5603 wake_up_interruptible(&ch->ch_flags_wait);
5608 * Process Transmit empty.
5610 if (reason & IFTEM) {
5611 dgap_write_wakeup(bd, ch, &ch->ch_tun, UN_EMPTY,
5612 &lock_flags, &lock_flags2);
5613 dgap_write_wakeup(bd, ch, &ch->ch_pun, UN_EMPTY,
5614 &lock_flags, &lock_flags2);
5615 if (ch->ch_flags & CH_WEMPTY) {
5616 ch->ch_flags &= ~CH_WEMPTY;
5617 wake_up_interruptible(&ch->ch_flags_wait);
5621 spin_unlock_irqrestore(&ch->ch_lock, lock_flags2);
5623 next:
5624 tail = (tail + 4) & (EVMAX - EVSTART - 4);
5627 writew(tail, &(eaddr->ev_tail));
5628 spin_unlock_irqrestore(&bd->bd_lock, lock_flags);
5630 return 0;
5633 static ssize_t dgap_driver_version_show(struct device_driver *ddp, char *buf)
5635 return snprintf(buf, PAGE_SIZE, "%s\n", DG_PART);
5637 static DRIVER_ATTR(version, S_IRUSR, dgap_driver_version_show, NULL);
5640 static ssize_t dgap_driver_boards_show(struct device_driver *ddp, char *buf)
5642 return snprintf(buf, PAGE_SIZE, "%d\n", dgap_numboards);
5644 static DRIVER_ATTR(boards, S_IRUSR, dgap_driver_boards_show, NULL);
5647 static ssize_t dgap_driver_maxboards_show(struct device_driver *ddp, char *buf)
5649 return snprintf(buf, PAGE_SIZE, "%d\n", MAXBOARDS);
5651 static DRIVER_ATTR(maxboards, S_IRUSR, dgap_driver_maxboards_show, NULL);
5654 static ssize_t dgap_driver_pollcounter_show(struct device_driver *ddp,
5655 char *buf)
5657 return snprintf(buf, PAGE_SIZE, "%ld\n", dgap_poll_counter);
5659 static DRIVER_ATTR(pollcounter, S_IRUSR, dgap_driver_pollcounter_show, NULL);
5661 static ssize_t dgap_driver_pollrate_show(struct device_driver *ddp, char *buf)
5663 return snprintf(buf, PAGE_SIZE, "%dms\n", dgap_poll_tick);
5666 static ssize_t dgap_driver_pollrate_store(struct device_driver *ddp,
5667 const char *buf, size_t count)
5669 if (sscanf(buf, "%d\n", &dgap_poll_tick) != 1)
5670 return -EINVAL;
5671 return count;
5673 static DRIVER_ATTR(pollrate, (S_IRUSR | S_IWUSR), dgap_driver_pollrate_show,
5674 dgap_driver_pollrate_store);
5676 static int dgap_create_driver_sysfiles(struct pci_driver *dgap_driver)
5678 int rc = 0;
5679 struct device_driver *driverfs = &dgap_driver->driver;
5681 rc |= driver_create_file(driverfs, &driver_attr_version);
5682 rc |= driver_create_file(driverfs, &driver_attr_boards);
5683 rc |= driver_create_file(driverfs, &driver_attr_maxboards);
5684 rc |= driver_create_file(driverfs, &driver_attr_pollrate);
5685 rc |= driver_create_file(driverfs, &driver_attr_pollcounter);
5687 return rc;
5690 static void dgap_remove_driver_sysfiles(struct pci_driver *dgap_driver)
5692 struct device_driver *driverfs = &dgap_driver->driver;
5693 driver_remove_file(driverfs, &driver_attr_version);
5694 driver_remove_file(driverfs, &driver_attr_boards);
5695 driver_remove_file(driverfs, &driver_attr_maxboards);
5696 driver_remove_file(driverfs, &driver_attr_pollrate);
5697 driver_remove_file(driverfs, &driver_attr_pollcounter);
5700 static struct board_t *dgap_verify_board(struct device *p)
5702 struct board_t *bd;
5704 if (!p)
5705 return NULL;
5707 bd = dev_get_drvdata(p);
5708 if (!bd || bd->magic != DGAP_BOARD_MAGIC || bd->state != BOARD_READY)
5709 return NULL;
5711 return bd;
5714 static ssize_t dgap_ports_state_show(struct device *p,
5715 struct device_attribute *attr,
5716 char *buf)
5718 struct board_t *bd;
5719 int count = 0;
5720 int i;
5722 bd = dgap_verify_board(p);
5723 if (!bd)
5724 return 0;
5726 for (i = 0; i < bd->nasync; i++) {
5727 count += snprintf(buf + count, PAGE_SIZE - count,
5728 "%d %s\n", bd->channels[i]->ch_portnum,
5729 bd->channels[i]->ch_open_count ? "Open" : "Closed");
5731 return count;
5733 static DEVICE_ATTR(ports_state, S_IRUSR, dgap_ports_state_show, NULL);
5735 static ssize_t dgap_ports_baud_show(struct device *p,
5736 struct device_attribute *attr,
5737 char *buf)
5739 struct board_t *bd;
5740 int count = 0;
5741 int i;
5743 bd = dgap_verify_board(p);
5744 if (!bd)
5745 return 0;
5747 for (i = 0; i < bd->nasync; i++) {
5748 count += snprintf(buf + count, PAGE_SIZE - count, "%d %d\n",
5749 bd->channels[i]->ch_portnum,
5750 bd->channels[i]->ch_baud_info);
5752 return count;
5754 static DEVICE_ATTR(ports_baud, S_IRUSR, dgap_ports_baud_show, NULL);
5756 static ssize_t dgap_ports_msignals_show(struct device *p,
5757 struct device_attribute *attr,
5758 char *buf)
5760 struct board_t *bd;
5761 int count = 0;
5762 int i;
5764 bd = dgap_verify_board(p);
5765 if (!bd)
5766 return 0;
5768 for (i = 0; i < bd->nasync; i++) {
5769 if (bd->channels[i]->ch_open_count)
5770 count += snprintf(buf + count, PAGE_SIZE - count,
5771 "%d %s %s %s %s %s %s\n",
5772 bd->channels[i]->ch_portnum,
5773 (bd->channels[i]->ch_mostat &
5774 UART_MCR_RTS) ? "RTS" : "",
5775 (bd->channels[i]->ch_mistat &
5776 UART_MSR_CTS) ? "CTS" : "",
5777 (bd->channels[i]->ch_mostat &
5778 UART_MCR_DTR) ? "DTR" : "",
5779 (bd->channels[i]->ch_mistat &
5780 UART_MSR_DSR) ? "DSR" : "",
5781 (bd->channels[i]->ch_mistat &
5782 UART_MSR_DCD) ? "DCD" : "",
5783 (bd->channels[i]->ch_mistat &
5784 UART_MSR_RI) ? "RI" : "");
5785 else
5786 count += snprintf(buf + count, PAGE_SIZE - count,
5787 "%d\n", bd->channels[i]->ch_portnum);
5789 return count;
5791 static DEVICE_ATTR(ports_msignals, S_IRUSR, dgap_ports_msignals_show, NULL);
5793 static ssize_t dgap_ports_iflag_show(struct device *p,
5794 struct device_attribute *attr,
5795 char *buf)
5797 struct board_t *bd;
5798 int count = 0;
5799 int i;
5801 bd = dgap_verify_board(p);
5802 if (!bd)
5803 return 0;
5805 for (i = 0; i < bd->nasync; i++)
5806 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
5807 bd->channels[i]->ch_portnum,
5808 bd->channels[i]->ch_c_iflag);
5809 return count;
5811 static DEVICE_ATTR(ports_iflag, S_IRUSR, dgap_ports_iflag_show, NULL);
5813 static ssize_t dgap_ports_cflag_show(struct device *p,
5814 struct device_attribute *attr,
5815 char *buf)
5817 struct board_t *bd;
5818 int count = 0;
5819 int i;
5821 bd = dgap_verify_board(p);
5822 if (!bd)
5823 return 0;
5825 for (i = 0; i < bd->nasync; i++)
5826 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
5827 bd->channels[i]->ch_portnum,
5828 bd->channels[i]->ch_c_cflag);
5829 return count;
5831 static DEVICE_ATTR(ports_cflag, S_IRUSR, dgap_ports_cflag_show, NULL);
5833 static ssize_t dgap_ports_oflag_show(struct device *p,
5834 struct device_attribute *attr,
5835 char *buf)
5837 struct board_t *bd;
5838 int count = 0;
5839 int i;
5841 bd = dgap_verify_board(p);
5842 if (!bd)
5843 return 0;
5845 for (i = 0; i < bd->nasync; i++)
5846 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
5847 bd->channels[i]->ch_portnum,
5848 bd->channels[i]->ch_c_oflag);
5849 return count;
5851 static DEVICE_ATTR(ports_oflag, S_IRUSR, dgap_ports_oflag_show, NULL);
5853 static ssize_t dgap_ports_lflag_show(struct device *p,
5854 struct device_attribute *attr,
5855 char *buf)
5857 struct board_t *bd;
5858 int count = 0;
5859 int i;
5861 bd = dgap_verify_board(p);
5862 if (!bd)
5863 return 0;
5865 for (i = 0; i < bd->nasync; i++)
5866 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
5867 bd->channels[i]->ch_portnum,
5868 bd->channels[i]->ch_c_lflag);
5869 return count;
5871 static DEVICE_ATTR(ports_lflag, S_IRUSR, dgap_ports_lflag_show, NULL);
5873 static ssize_t dgap_ports_digi_flag_show(struct device *p,
5874 struct device_attribute *attr,
5875 char *buf)
5877 struct board_t *bd;
5878 int count = 0;
5879 int i;
5881 bd = dgap_verify_board(p);
5882 if (!bd)
5883 return 0;
5885 for (i = 0; i < bd->nasync; i++)
5886 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
5887 bd->channels[i]->ch_portnum,
5888 bd->channels[i]->ch_digi.digi_flags);
5889 return count;
5891 static DEVICE_ATTR(ports_digi_flag, S_IRUSR, dgap_ports_digi_flag_show, NULL);
5893 static ssize_t dgap_ports_rxcount_show(struct device *p,
5894 struct device_attribute *attr,
5895 char *buf)
5897 struct board_t *bd;
5898 int count = 0;
5899 int i;
5901 bd = dgap_verify_board(p);
5902 if (!bd)
5903 return 0;
5905 for (i = 0; i < bd->nasync; i++)
5906 count += snprintf(buf + count, PAGE_SIZE - count, "%d %ld\n",
5907 bd->channels[i]->ch_portnum,
5908 bd->channels[i]->ch_rxcount);
5909 return count;
5911 static DEVICE_ATTR(ports_rxcount, S_IRUSR, dgap_ports_rxcount_show, NULL);
5913 static ssize_t dgap_ports_txcount_show(struct device *p,
5914 struct device_attribute *attr,
5915 char *buf)
5917 struct board_t *bd;
5918 int count = 0;
5919 int i;
5921 bd = dgap_verify_board(p);
5922 if (!bd)
5923 return 0;
5925 for (i = 0; i < bd->nasync; i++)
5926 count += snprintf(buf + count, PAGE_SIZE - count, "%d %ld\n",
5927 bd->channels[i]->ch_portnum,
5928 bd->channels[i]->ch_txcount);
5929 return count;
5931 static DEVICE_ATTR(ports_txcount, S_IRUSR, dgap_ports_txcount_show, NULL);
5933 /* this function creates the sys files that will export each signal status
5934 * to sysfs each value will be put in a separate filename
5936 static void dgap_create_ports_sysfiles(struct board_t *bd)
5938 dev_set_drvdata(&bd->pdev->dev, bd);
5939 device_create_file(&(bd->pdev->dev), &dev_attr_ports_state);
5940 device_create_file(&(bd->pdev->dev), &dev_attr_ports_baud);
5941 device_create_file(&(bd->pdev->dev), &dev_attr_ports_msignals);
5942 device_create_file(&(bd->pdev->dev), &dev_attr_ports_iflag);
5943 device_create_file(&(bd->pdev->dev), &dev_attr_ports_cflag);
5944 device_create_file(&(bd->pdev->dev), &dev_attr_ports_oflag);
5945 device_create_file(&(bd->pdev->dev), &dev_attr_ports_lflag);
5946 device_create_file(&(bd->pdev->dev), &dev_attr_ports_digi_flag);
5947 device_create_file(&(bd->pdev->dev), &dev_attr_ports_rxcount);
5948 device_create_file(&(bd->pdev->dev), &dev_attr_ports_txcount);
5951 /* removes all the sys files created for that port */
5952 static void dgap_remove_ports_sysfiles(struct board_t *bd)
5954 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_state);
5955 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_baud);
5956 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_msignals);
5957 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_iflag);
5958 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_cflag);
5959 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_oflag);
5960 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_lflag);
5961 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_digi_flag);
5962 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_rxcount);
5963 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_txcount);
5966 static ssize_t dgap_tty_state_show(struct device *d,
5967 struct device_attribute *attr,
5968 char *buf)
5970 struct board_t *bd;
5971 struct channel_t *ch;
5972 struct un_t *un;
5974 if (!d)
5975 return 0;
5976 un = dev_get_drvdata(d);
5977 if (!un || un->magic != DGAP_UNIT_MAGIC)
5978 return 0;
5979 ch = un->un_ch;
5980 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5981 return 0;
5982 bd = ch->ch_bd;
5983 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
5984 return 0;
5985 if (bd->state != BOARD_READY)
5986 return 0;
5988 return snprintf(buf, PAGE_SIZE, "%s", un->un_open_count ?
5989 "Open" : "Closed");
5991 static DEVICE_ATTR(state, S_IRUSR, dgap_tty_state_show, NULL);
5993 static ssize_t dgap_tty_baud_show(struct device *d,
5994 struct device_attribute *attr,
5995 char *buf)
5997 struct board_t *bd;
5998 struct channel_t *ch;
5999 struct un_t *un;
6001 if (!d)
6002 return 0;
6003 un = dev_get_drvdata(d);
6004 if (!un || un->magic != DGAP_UNIT_MAGIC)
6005 return 0;
6006 ch = un->un_ch;
6007 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6008 return 0;
6009 bd = ch->ch_bd;
6010 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6011 return 0;
6012 if (bd->state != BOARD_READY)
6013 return 0;
6015 return snprintf(buf, PAGE_SIZE, "%d\n", ch->ch_baud_info);
6017 static DEVICE_ATTR(baud, S_IRUSR, dgap_tty_baud_show, NULL);
6019 static ssize_t dgap_tty_msignals_show(struct device *d,
6020 struct device_attribute *attr,
6021 char *buf)
6023 struct board_t *bd;
6024 struct channel_t *ch;
6025 struct un_t *un;
6027 if (!d)
6028 return 0;
6029 un = dev_get_drvdata(d);
6030 if (!un || un->magic != DGAP_UNIT_MAGIC)
6031 return 0;
6032 ch = un->un_ch;
6033 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6034 return 0;
6035 bd = ch->ch_bd;
6036 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6037 return 0;
6038 if (bd->state != BOARD_READY)
6039 return 0;
6041 if (ch->ch_open_count) {
6042 return snprintf(buf, PAGE_SIZE, "%s %s %s %s %s %s\n",
6043 (ch->ch_mostat & UART_MCR_RTS) ? "RTS" : "",
6044 (ch->ch_mistat & UART_MSR_CTS) ? "CTS" : "",
6045 (ch->ch_mostat & UART_MCR_DTR) ? "DTR" : "",
6046 (ch->ch_mistat & UART_MSR_DSR) ? "DSR" : "",
6047 (ch->ch_mistat & UART_MSR_DCD) ? "DCD" : "",
6048 (ch->ch_mistat & UART_MSR_RI) ? "RI" : "");
6050 return 0;
6052 static DEVICE_ATTR(msignals, S_IRUSR, dgap_tty_msignals_show, NULL);
6054 static ssize_t dgap_tty_iflag_show(struct device *d,
6055 struct device_attribute *attr,
6056 char *buf)
6058 struct board_t *bd;
6059 struct channel_t *ch;
6060 struct un_t *un;
6062 if (!d)
6063 return 0;
6064 un = dev_get_drvdata(d);
6065 if (!un || un->magic != DGAP_UNIT_MAGIC)
6066 return 0;
6067 ch = un->un_ch;
6068 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6069 return 0;
6070 bd = ch->ch_bd;
6071 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6072 return 0;
6073 if (bd->state != BOARD_READY)
6074 return 0;
6076 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_c_iflag);
6078 static DEVICE_ATTR(iflag, S_IRUSR, dgap_tty_iflag_show, NULL);
6080 static ssize_t dgap_tty_cflag_show(struct device *d,
6081 struct device_attribute *attr,
6082 char *buf)
6084 struct board_t *bd;
6085 struct channel_t *ch;
6086 struct un_t *un;
6088 if (!d)
6089 return 0;
6090 un = dev_get_drvdata(d);
6091 if (!un || un->magic != DGAP_UNIT_MAGIC)
6092 return 0;
6093 ch = un->un_ch;
6094 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6095 return 0;
6096 bd = ch->ch_bd;
6097 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6098 return 0;
6099 if (bd->state != BOARD_READY)
6100 return 0;
6102 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_c_cflag);
6104 static DEVICE_ATTR(cflag, S_IRUSR, dgap_tty_cflag_show, NULL);
6106 static ssize_t dgap_tty_oflag_show(struct device *d,
6107 struct device_attribute *attr,
6108 char *buf)
6110 struct board_t *bd;
6111 struct channel_t *ch;
6112 struct un_t *un;
6114 if (!d)
6115 return 0;
6116 un = dev_get_drvdata(d);
6117 if (!un || un->magic != DGAP_UNIT_MAGIC)
6118 return 0;
6119 ch = un->un_ch;
6120 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6121 return 0;
6122 bd = ch->ch_bd;
6123 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6124 return 0;
6125 if (bd->state != BOARD_READY)
6126 return 0;
6128 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_c_oflag);
6130 static DEVICE_ATTR(oflag, S_IRUSR, dgap_tty_oflag_show, NULL);
6132 static ssize_t dgap_tty_lflag_show(struct device *d,
6133 struct device_attribute *attr,
6134 char *buf)
6136 struct board_t *bd;
6137 struct channel_t *ch;
6138 struct un_t *un;
6140 if (!d)
6141 return 0;
6142 un = dev_get_drvdata(d);
6143 if (!un || un->magic != DGAP_UNIT_MAGIC)
6144 return 0;
6145 ch = un->un_ch;
6146 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6147 return 0;
6148 bd = ch->ch_bd;
6149 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6150 return 0;
6151 if (bd->state != BOARD_READY)
6152 return 0;
6154 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_c_lflag);
6156 static DEVICE_ATTR(lflag, S_IRUSR, dgap_tty_lflag_show, NULL);
6158 static ssize_t dgap_tty_digi_flag_show(struct device *d,
6159 struct device_attribute *attr,
6160 char *buf)
6162 struct board_t *bd;
6163 struct channel_t *ch;
6164 struct un_t *un;
6166 if (!d)
6167 return 0;
6168 un = dev_get_drvdata(d);
6169 if (!un || un->magic != DGAP_UNIT_MAGIC)
6170 return 0;
6171 ch = un->un_ch;
6172 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6173 return 0;
6174 bd = ch->ch_bd;
6175 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6176 return 0;
6177 if (bd->state != BOARD_READY)
6178 return 0;
6180 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_digi.digi_flags);
6182 static DEVICE_ATTR(digi_flag, S_IRUSR, dgap_tty_digi_flag_show, NULL);
6184 static ssize_t dgap_tty_rxcount_show(struct device *d,
6185 struct device_attribute *attr,
6186 char *buf)
6188 struct board_t *bd;
6189 struct channel_t *ch;
6190 struct un_t *un;
6192 if (!d)
6193 return 0;
6194 un = dev_get_drvdata(d);
6195 if (!un || un->magic != DGAP_UNIT_MAGIC)
6196 return 0;
6197 ch = un->un_ch;
6198 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6199 return 0;
6200 bd = ch->ch_bd;
6201 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6202 return 0;
6203 if (bd->state != BOARD_READY)
6204 return 0;
6206 return snprintf(buf, PAGE_SIZE, "%ld\n", ch->ch_rxcount);
6208 static DEVICE_ATTR(rxcount, S_IRUSR, dgap_tty_rxcount_show, NULL);
6210 static ssize_t dgap_tty_txcount_show(struct device *d,
6211 struct device_attribute *attr,
6212 char *buf)
6214 struct board_t *bd;
6215 struct channel_t *ch;
6216 struct un_t *un;
6218 if (!d)
6219 return 0;
6220 un = dev_get_drvdata(d);
6221 if (!un || un->magic != DGAP_UNIT_MAGIC)
6222 return 0;
6223 ch = un->un_ch;
6224 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6225 return 0;
6226 bd = ch->ch_bd;
6227 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6228 return 0;
6229 if (bd->state != BOARD_READY)
6230 return 0;
6232 return snprintf(buf, PAGE_SIZE, "%ld\n", ch->ch_txcount);
6234 static DEVICE_ATTR(txcount, S_IRUSR, dgap_tty_txcount_show, NULL);
6236 static ssize_t dgap_tty_name_show(struct device *d,
6237 struct device_attribute *attr,
6238 char *buf)
6240 struct board_t *bd;
6241 struct channel_t *ch;
6242 struct un_t *un;
6243 int cn;
6244 int bn;
6245 struct cnode *cptr;
6246 int found = FALSE;
6247 int ncount = 0;
6248 int starto = 0;
6249 int i;
6251 if (!d)
6252 return 0;
6253 un = dev_get_drvdata(d);
6254 if (!un || un->magic != DGAP_UNIT_MAGIC)
6255 return 0;
6256 ch = un->un_ch;
6257 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6258 return 0;
6259 bd = ch->ch_bd;
6260 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6261 return 0;
6262 if (bd->state != BOARD_READY)
6263 return 0;
6265 bn = bd->boardnum;
6266 cn = ch->ch_portnum;
6268 for (cptr = bd->bd_config; cptr; cptr = cptr->next) {
6270 if ((cptr->type == BNODE) &&
6271 ((cptr->u.board.type == APORT2_920P) ||
6272 (cptr->u.board.type == APORT4_920P) ||
6273 (cptr->u.board.type == APORT8_920P) ||
6274 (cptr->u.board.type == PAPORT4) ||
6275 (cptr->u.board.type == PAPORT8))) {
6277 found = TRUE;
6278 if (cptr->u.board.v_start)
6279 starto = cptr->u.board.start;
6280 else
6281 starto = 1;
6284 if (cptr->type == TNODE && found == TRUE) {
6285 char *ptr1;
6286 if (strstr(cptr->u.ttyname, "tty")) {
6287 ptr1 = cptr->u.ttyname;
6288 ptr1 += 3;
6289 } else
6290 ptr1 = cptr->u.ttyname;
6292 for (i = 0; i < dgap_config_get_num_prts(bd); i++) {
6293 if (cn != i)
6294 continue;
6296 return snprintf(buf, PAGE_SIZE, "%s%s%02d\n",
6297 (un->un_type == DGAP_PRINT) ?
6298 "pr" : "tty",
6299 ptr1, i + starto);
6303 if (cptr->type == CNODE) {
6305 for (i = 0; i < cptr->u.conc.nport; i++) {
6306 if (cn != (i + ncount))
6307 continue;
6309 return snprintf(buf, PAGE_SIZE, "%s%s%02ld\n",
6310 (un->un_type == DGAP_PRINT) ?
6311 "pr" : "tty",
6312 cptr->u.conc.id,
6313 i + (cptr->u.conc.v_start ?
6314 cptr->u.conc.start : 1));
6317 ncount += cptr->u.conc.nport;
6320 if (cptr->type == MNODE) {
6322 for (i = 0; i < cptr->u.module.nport; i++) {
6323 if (cn != (i + ncount))
6324 continue;
6326 return snprintf(buf, PAGE_SIZE, "%s%s%02ld\n",
6327 (un->un_type == DGAP_PRINT) ?
6328 "pr" : "tty",
6329 cptr->u.module.id,
6330 i + (cptr->u.module.v_start ?
6331 cptr->u.module.start : 1));
6334 ncount += cptr->u.module.nport;
6339 return snprintf(buf, PAGE_SIZE, "%s_dgap_%d_%d\n",
6340 (un->un_type == DGAP_PRINT) ? "pr" : "tty", bn, cn);
6342 static DEVICE_ATTR(custom_name, S_IRUSR, dgap_tty_name_show, NULL);
6344 static struct attribute *dgap_sysfs_tty_entries[] = {
6345 &dev_attr_state.attr,
6346 &dev_attr_baud.attr,
6347 &dev_attr_msignals.attr,
6348 &dev_attr_iflag.attr,
6349 &dev_attr_cflag.attr,
6350 &dev_attr_oflag.attr,
6351 &dev_attr_lflag.attr,
6352 &dev_attr_digi_flag.attr,
6353 &dev_attr_rxcount.attr,
6354 &dev_attr_txcount.attr,
6355 &dev_attr_custom_name.attr,
6356 NULL
6359 static struct attribute_group dgap_tty_attribute_group = {
6360 .name = NULL,
6361 .attrs = dgap_sysfs_tty_entries,
6364 static void dgap_create_tty_sysfs(struct un_t *un, struct device *c)
6366 int ret;
6368 ret = sysfs_create_group(&c->kobj, &dgap_tty_attribute_group);
6369 if (ret)
6370 return;
6372 dev_set_drvdata(c, un);
6376 static void dgap_remove_tty_sysfs(struct device *c)
6378 sysfs_remove_group(&c->kobj, &dgap_tty_attribute_group);
6382 * Parse a configuration file read into memory as a string.
6384 static int dgap_parsefile(char **in, int remove)
6386 struct cnode *p, *brd, *line, *conc;
6387 int rc;
6388 char *s;
6389 int linecnt = 0;
6391 p = &dgap_head;
6392 brd = line = conc = NULL;
6394 /* perhaps we are adding to an existing list? */
6395 while (p->next)
6396 p = p->next;
6398 /* file must start with a BEGIN */
6399 while ((rc = dgap_gettok(in, p)) != BEGIN) {
6400 if (rc == 0) {
6401 dgap_err("unexpected EOF");
6402 return -1;
6406 for (; ;) {
6407 rc = dgap_gettok(in, p);
6408 if (rc == 0) {
6409 dgap_err("unexpected EOF");
6410 return -1;
6413 switch (rc) {
6414 case 0:
6415 dgap_err("unexpected end of file");
6416 return -1;
6418 case BEGIN: /* should only be 1 begin */
6419 dgap_err("unexpected config_begin\n");
6420 return -1;
6422 case END:
6423 return 0;
6425 case BOARD: /* board info */
6426 if (dgap_checknode(p))
6427 return -1;
6428 p->next = dgap_newnode(BNODE);
6429 if (!p->next) {
6430 dgap_err("out of memory");
6431 return -1;
6433 p = p->next;
6435 p->u.board.status = kstrdup("No", GFP_KERNEL);
6436 line = conc = NULL;
6437 brd = p;
6438 linecnt = -1;
6439 break;
6441 case APORT2_920P: /* AccelePort_4 */
6442 if (p->type != BNODE) {
6443 dgap_err("unexpected Digi_2r_920 string");
6444 return -1;
6446 p->u.board.type = APORT2_920P;
6447 p->u.board.v_type = 1;
6448 break;
6450 case APORT4_920P: /* AccelePort_4 */
6451 if (p->type != BNODE) {
6452 dgap_err("unexpected Digi_4r_920 string");
6453 return -1;
6455 p->u.board.type = APORT4_920P;
6456 p->u.board.v_type = 1;
6457 break;
6459 case APORT8_920P: /* AccelePort_8 */
6460 if (p->type != BNODE) {
6461 dgap_err("unexpected Digi_8r_920 string");
6462 return -1;
6464 p->u.board.type = APORT8_920P;
6465 p->u.board.v_type = 1;
6466 break;
6468 case PAPORT4: /* AccelePort_4 PCI */
6469 if (p->type != BNODE) {
6470 dgap_err("unexpected Digi_4r(PCI) string");
6471 return -1;
6473 p->u.board.type = PAPORT4;
6474 p->u.board.v_type = 1;
6475 break;
6477 case PAPORT8: /* AccelePort_8 PCI */
6478 if (p->type != BNODE) {
6479 dgap_err("unexpected Digi_8r string");
6480 return -1;
6482 p->u.board.type = PAPORT8;
6483 p->u.board.v_type = 1;
6484 break;
6486 case PCX: /* PCI C/X */
6487 if (p->type != BNODE) {
6488 dgap_err("unexpected Digi_C/X_(PCI) string");
6489 return -1;
6491 p->u.board.type = PCX;
6492 p->u.board.v_type = 1;
6493 p->u.board.conc1 = 0;
6494 p->u.board.conc2 = 0;
6495 p->u.board.module1 = 0;
6496 p->u.board.module2 = 0;
6497 break;
6499 case PEPC: /* PCI EPC/X */
6500 if (p->type != BNODE) {
6501 dgap_err("unexpected \"Digi_EPC/X_(PCI)\" string");
6502 return -1;
6504 p->u.board.type = PEPC;
6505 p->u.board.v_type = 1;
6506 p->u.board.conc1 = 0;
6507 p->u.board.conc2 = 0;
6508 p->u.board.module1 = 0;
6509 p->u.board.module2 = 0;
6510 break;
6512 case PPCM: /* PCI/Xem */
6513 if (p->type != BNODE) {
6514 dgap_err("unexpected PCI/Xem string");
6515 return -1;
6517 p->u.board.type = PPCM;
6518 p->u.board.v_type = 1;
6519 p->u.board.conc1 = 0;
6520 p->u.board.conc2 = 0;
6521 break;
6523 case IO: /* i/o port */
6524 if (p->type != BNODE) {
6525 dgap_err("IO port only vaild for boards");
6526 return -1;
6528 s = dgap_getword(in);
6529 if (!s) {
6530 dgap_err("unexpected end of file");
6531 return -1;
6533 p->u.board.portstr = kstrdup(s, GFP_KERNEL);
6534 if (kstrtol(s, 0, &p->u.board.port)) {
6535 dgap_err("bad number for IO port");
6536 return -1;
6538 p->u.board.v_port = 1;
6539 break;
6541 case MEM: /* memory address */
6542 if (p->type != BNODE) {
6543 dgap_err("memory address only vaild for boards");
6544 return -1;
6546 s = dgap_getword(in);
6547 if (!s) {
6548 dgap_err("unexpected end of file");
6549 return -1;
6551 p->u.board.addrstr = kstrdup(s, GFP_KERNEL);
6552 if (kstrtoul(s, 0, &p->u.board.addr)) {
6553 dgap_err("bad number for memory address");
6554 return -1;
6556 p->u.board.v_addr = 1;
6557 break;
6559 case PCIINFO: /* pci information */
6560 if (p->type != BNODE) {
6561 dgap_err("memory address only vaild for boards");
6562 return -1;
6564 s = dgap_getword(in);
6565 if (!s) {
6566 dgap_err("unexpected end of file");
6567 return -1;
6569 p->u.board.pcibusstr = kstrdup(s, GFP_KERNEL);
6570 if (kstrtoul(s, 0, &p->u.board.pcibus)) {
6571 dgap_err("bad number for pci bus");
6572 return -1;
6574 p->u.board.v_pcibus = 1;
6575 s = dgap_getword(in);
6576 if (!s) {
6577 dgap_err("unexpected end of file");
6578 return -1;
6580 p->u.board.pcislotstr = kstrdup(s, GFP_KERNEL);
6581 if (kstrtoul(s, 0, &p->u.board.pcislot)) {
6582 dgap_err("bad number for pci slot");
6583 return -1;
6585 p->u.board.v_pcislot = 1;
6586 break;
6588 case METHOD:
6589 if (p->type != BNODE) {
6590 dgap_err("install method only vaild for boards");
6591 return -1;
6593 s = dgap_getword(in);
6594 if (!s) {
6595 dgap_err("unexpected end of file");
6596 return -1;
6598 p->u.board.method = kstrdup(s, GFP_KERNEL);
6599 p->u.board.v_method = 1;
6600 break;
6602 case STATUS:
6603 if (p->type != BNODE) {
6604 dgap_err("config status only vaild for boards");
6605 return -1;
6607 s = dgap_getword(in);
6608 if (!s) {
6609 dgap_err("unexpected end of file");
6610 return -1;
6612 p->u.board.status = kstrdup(s, GFP_KERNEL);
6613 break;
6615 case NPORTS: /* number of ports */
6616 if (p->type == BNODE) {
6617 s = dgap_getword(in);
6618 if (!s) {
6619 dgap_err("unexpected end of file");
6620 return -1;
6622 if (kstrtol(s, 0, &p->u.board.nport)) {
6623 dgap_err("bad number for number of ports");
6624 return -1;
6626 p->u.board.v_nport = 1;
6627 } else if (p->type == CNODE) {
6628 s = dgap_getword(in);
6629 if (!s) {
6630 dgap_err("unexpected end of file");
6631 return -1;
6633 if (kstrtol(s, 0, &p->u.conc.nport)) {
6634 dgap_err("bad number for number of ports");
6635 return -1;
6637 p->u.conc.v_nport = 1;
6638 } else if (p->type == MNODE) {
6639 s = dgap_getword(in);
6640 if (!s) {
6641 dgap_err("unexpected end of file");
6642 return -1;
6644 if (kstrtol(s, 0, &p->u.module.nport)) {
6645 dgap_err("bad number for number of ports");
6646 return -1;
6648 p->u.module.v_nport = 1;
6649 } else {
6650 dgap_err("nports only valid for concentrators or modules");
6651 return -1;
6653 break;
6655 case ID: /* letter ID used in tty name */
6656 s = dgap_getword(in);
6657 if (!s) {
6658 dgap_err("unexpected end of file");
6659 return -1;
6662 p->u.board.status = kstrdup(s, GFP_KERNEL);
6664 if (p->type == CNODE) {
6665 p->u.conc.id = kstrdup(s, GFP_KERNEL);
6666 p->u.conc.v_id = 1;
6667 } else if (p->type == MNODE) {
6668 p->u.module.id = kstrdup(s, GFP_KERNEL);
6669 p->u.module.v_id = 1;
6670 } else {
6671 dgap_err("id only valid for concentrators or modules");
6672 return -1;
6674 break;
6676 case STARTO: /* start offset of ID */
6677 if (p->type == BNODE) {
6678 s = dgap_getword(in);
6679 if (!s) {
6680 dgap_err("unexpected end of file");
6681 return -1;
6683 if (kstrtol(s, 0, &p->u.board.start)) {
6684 dgap_err("bad number for start of tty count");
6685 return -1;
6687 p->u.board.v_start = 1;
6688 } else if (p->type == CNODE) {
6689 s = dgap_getword(in);
6690 if (!s) {
6691 dgap_err("unexpected end of file");
6692 return -1;
6694 if (kstrtol(s, 0, &p->u.conc.start)) {
6695 dgap_err("bad number for start of tty count");
6696 return -1;
6698 p->u.conc.v_start = 1;
6699 } else if (p->type == MNODE) {
6700 s = dgap_getword(in);
6701 if (!s) {
6702 dgap_err("unexpected end of file");
6703 return -1;
6705 if (kstrtol(s, 0, &p->u.module.start)) {
6706 dgap_err("bad number for start of tty count");
6707 return -1;
6709 p->u.module.v_start = 1;
6710 } else {
6711 dgap_err("start only valid for concentrators or modules");
6712 return -1;
6714 break;
6716 case TTYN: /* tty name prefix */
6717 if (dgap_checknode(p))
6718 return -1;
6719 p->next = dgap_newnode(TNODE);
6720 if (!p->next) {
6721 dgap_err("out of memory");
6722 return -1;
6724 p = p->next;
6725 s = dgap_getword(in);
6726 if (!s) {
6727 dgap_err("unexpeced end of file");
6728 return -1;
6730 p->u.ttyname = kstrdup(s, GFP_KERNEL);
6731 if (!p->u.ttyname) {
6732 dgap_err("out of memory");
6733 return -1;
6735 break;
6737 case CU: /* cu name prefix */
6738 if (dgap_checknode(p))
6739 return -1;
6740 p->next = dgap_newnode(CUNODE);
6741 if (!p->next) {
6742 dgap_err("out of memory");
6743 return -1;
6745 p = p->next;
6746 s = dgap_getword(in);
6747 if (!s) {
6748 dgap_err("unexpeced end of file");
6749 return -1;
6751 p->u.cuname = kstrdup(s, GFP_KERNEL);
6752 if (!p->u.cuname) {
6753 dgap_err("out of memory");
6754 return -1;
6756 break;
6758 case LINE: /* line information */
6759 if (dgap_checknode(p))
6760 return -1;
6761 if (!brd) {
6762 dgap_err("must specify board before line info");
6763 return -1;
6765 switch (brd->u.board.type) {
6766 case PPCM:
6767 dgap_err("line not vaild for PC/em");
6768 return -1;
6770 p->next = dgap_newnode(LNODE);
6771 if (!p->next) {
6772 dgap_err("out of memory");
6773 return -1;
6775 p = p->next;
6776 conc = NULL;
6777 line = p;
6778 linecnt++;
6779 break;
6781 case CONC: /* concentrator information */
6782 if (dgap_checknode(p))
6783 return -1;
6784 if (!line) {
6785 dgap_err("must specify line info before concentrator");
6786 return -1;
6788 p->next = dgap_newnode(CNODE);
6789 if (!p->next) {
6790 dgap_err("out of memory");
6791 return -1;
6793 p = p->next;
6794 conc = p;
6795 if (linecnt)
6796 brd->u.board.conc2++;
6797 else
6798 brd->u.board.conc1++;
6800 break;
6802 case CX: /* c/x type concentrator */
6803 if (p->type != CNODE) {
6804 dgap_err("cx only valid for concentrators");
6805 return -1;
6807 p->u.conc.type = CX;
6808 p->u.conc.v_type = 1;
6809 break;
6811 case EPC: /* epc type concentrator */
6812 if (p->type != CNODE) {
6813 dgap_err("cx only valid for concentrators");
6814 return -1;
6816 p->u.conc.type = EPC;
6817 p->u.conc.v_type = 1;
6818 break;
6820 case MOD: /* EBI module */
6821 if (dgap_checknode(p))
6822 return -1;
6823 if (!brd) {
6824 dgap_err("must specify board info before EBI modules");
6825 return -1;
6827 switch (brd->u.board.type) {
6828 case PPCM:
6829 linecnt = 0;
6830 break;
6831 default:
6832 if (!conc) {
6833 dgap_err("must specify concentrator info before EBI module");
6834 return -1;
6837 p->next = dgap_newnode(MNODE);
6838 if (!p->next) {
6839 dgap_err("out of memory");
6840 return -1;
6842 p = p->next;
6843 if (linecnt)
6844 brd->u.board.module2++;
6845 else
6846 brd->u.board.module1++;
6848 break;
6850 case PORTS: /* ports type EBI module */
6851 if (p->type != MNODE) {
6852 dgap_err("ports only valid for EBI modules");
6853 return -1;
6855 p->u.module.type = PORTS;
6856 p->u.module.v_type = 1;
6857 break;
6859 case MODEM: /* ports type EBI module */
6860 if (p->type != MNODE) {
6861 dgap_err("modem only valid for modem modules");
6862 return -1;
6864 p->u.module.type = MODEM;
6865 p->u.module.v_type = 1;
6866 break;
6868 case CABLE:
6869 if (p->type == LNODE) {
6870 s = dgap_getword(in);
6871 if (!s) {
6872 dgap_err("unexpected end of file");
6873 return -1;
6875 p->u.line.cable = kstrdup(s, GFP_KERNEL);
6876 p->u.line.v_cable = 1;
6878 break;
6880 case SPEED: /* sync line speed indication */
6881 if (p->type == LNODE) {
6882 s = dgap_getword(in);
6883 if (!s) {
6884 dgap_err("unexpected end of file");
6885 return -1;
6887 if (kstrtol(s, 0, &p->u.line.speed)) {
6888 dgap_err("bad number for line speed");
6889 return -1;
6891 p->u.line.v_speed = 1;
6892 } else if (p->type == CNODE) {
6893 s = dgap_getword(in);
6894 if (!s) {
6895 dgap_err("unexpected end of file");
6896 return -1;
6898 if (kstrtol(s, 0, &p->u.conc.speed)) {
6899 dgap_err("bad number for line speed");
6900 return -1;
6902 p->u.conc.v_speed = 1;
6903 } else {
6904 dgap_err("speed valid only for lines or concentrators.");
6905 return -1;
6907 break;
6909 case CONNECT:
6910 if (p->type == CNODE) {
6911 s = dgap_getword(in);
6912 if (!s) {
6913 dgap_err("unexpected end of file");
6914 return -1;
6916 p->u.conc.connect = kstrdup(s, GFP_KERNEL);
6917 p->u.conc.v_connect = 1;
6919 break;
6920 case PRINT: /* transparent print name prefix */
6921 if (dgap_checknode(p))
6922 return -1;
6923 p->next = dgap_newnode(PNODE);
6924 if (!p->next) {
6925 dgap_err("out of memory");
6926 return -1;
6928 p = p->next;
6929 s = dgap_getword(in);
6930 if (!s) {
6931 dgap_err("unexpeced end of file");
6932 return -1;
6934 p->u.printname = kstrdup(s, GFP_KERNEL);
6935 if (!p->u.printname) {
6936 dgap_err("out of memory");
6937 return -1;
6939 break;
6941 case CMAJOR: /* major number */
6942 if (dgap_checknode(p))
6943 return -1;
6944 p->next = dgap_newnode(JNODE);
6945 if (!p->next) {
6946 dgap_err("out of memory");
6947 return -1;
6949 p = p->next;
6950 s = dgap_getword(in);
6951 if (!s) {
6952 dgap_err("unexpected end of file");
6953 return -1;
6955 if (kstrtol(s, 0, &p->u.majornumber)) {
6956 dgap_err("bad number for major number");
6957 return -1;
6959 break;
6961 case ALTPIN: /* altpin setting */
6962 if (dgap_checknode(p))
6963 return -1;
6964 p->next = dgap_newnode(ANODE);
6965 if (!p->next) {
6966 dgap_err("out of memory");
6967 return -1;
6969 p = p->next;
6970 s = dgap_getword(in);
6971 if (!s) {
6972 dgap_err("unexpected end of file");
6973 return -1;
6975 if (kstrtol(s, 0, &p->u.altpin)) {
6976 dgap_err("bad number for altpin");
6977 return -1;
6979 break;
6981 case USEINTR: /* enable interrupt setting */
6982 if (dgap_checknode(p))
6983 return -1;
6984 p->next = dgap_newnode(INTRNODE);
6985 if (!p->next) {
6986 dgap_err("out of memory");
6987 return -1;
6989 p = p->next;
6990 s = dgap_getword(in);
6991 if (!s) {
6992 dgap_err("unexpected end of file");
6993 return -1;
6995 if (kstrtol(s, 0, &p->u.useintr)) {
6996 dgap_err("bad number for useintr");
6997 return -1;
6999 break;
7001 case TTSIZ: /* size of tty structure */
7002 if (dgap_checknode(p))
7003 return -1;
7004 p->next = dgap_newnode(TSNODE);
7005 if (!p->next) {
7006 dgap_err("out of memory");
7007 return -1;
7009 p = p->next;
7010 s = dgap_getword(in);
7011 if (!s) {
7012 dgap_err("unexpected end of file");
7013 return -1;
7015 if (kstrtol(s, 0, &p->u.ttysize)) {
7016 dgap_err("bad number for ttysize");
7017 return -1;
7019 break;
7021 case CHSIZ: /* channel structure size */
7022 if (dgap_checknode(p))
7023 return -1;
7024 p->next = dgap_newnode(CSNODE);
7025 if (!p->next) {
7026 dgap_err("out of memory");
7027 return -1;
7029 p = p->next;
7030 s = dgap_getword(in);
7031 if (!s) {
7032 dgap_err("unexpected end of file");
7033 return -1;
7035 if (kstrtol(s, 0, &p->u.chsize)) {
7036 dgap_err("bad number for chsize");
7037 return -1;
7039 break;
7041 case BSSIZ: /* board structure size */
7042 if (dgap_checknode(p))
7043 return -1;
7044 p->next = dgap_newnode(BSNODE);
7045 if (!p->next) {
7046 dgap_err("out of memory");
7047 return -1;
7049 p = p->next;
7050 s = dgap_getword(in);
7051 if (!s) {
7052 dgap_err("unexpected end of file");
7053 return -1;
7055 if (kstrtol(s, 0, &p->u.bssize)) {
7056 dgap_err("bad number for bssize");
7057 return -1;
7059 break;
7061 case UNTSIZ: /* sched structure size */
7062 if (dgap_checknode(p))
7063 return -1;
7064 p->next = dgap_newnode(USNODE);
7065 if (!p->next) {
7066 dgap_err("out of memory");
7067 return -1;
7069 p = p->next;
7070 s = dgap_getword(in);
7071 if (!s) {
7072 dgap_err("unexpected end of file");
7073 return -1;
7075 if (kstrtol(s, 0, &p->u.unsize)) {
7076 dgap_err("bad number for schedsize");
7077 return -1;
7079 break;
7081 case F2SIZ: /* f2200 structure size */
7082 if (dgap_checknode(p))
7083 return -1;
7084 p->next = dgap_newnode(FSNODE);
7085 if (!p->next) {
7086 dgap_err("out of memory");
7087 return -1;
7089 p = p->next;
7090 s = dgap_getword(in);
7091 if (!s) {
7092 dgap_err("unexpected end of file");
7093 return -1;
7095 if (kstrtol(s, 0, &p->u.f2size)) {
7096 dgap_err("bad number for f2200size");
7097 return -1;
7099 break;
7101 case VPSIZ: /* vpix structure size */
7102 if (dgap_checknode(p))
7103 return -1;
7104 p->next = dgap_newnode(VSNODE);
7105 if (!p->next) {
7106 dgap_err("out of memory");
7107 return -1;
7109 p = p->next;
7110 s = dgap_getword(in);
7111 if (!s) {
7112 dgap_err("unexpected end of file");
7113 return -1;
7115 if (kstrtol(s, 0, &p->u.vpixsize)) {
7116 dgap_err("bad number for vpixsize");
7117 return -1;
7119 break;
7125 * dgap_sindex: much like index(), but it looks for a match of any character in
7126 * the group, and returns that position. If the first character is a ^, then
7127 * this will match the first occurrence not in that group.
7129 static char *dgap_sindex(char *string, char *group)
7131 char *ptr;
7133 if (!string || !group)
7134 return (char *) NULL;
7136 if (*group == '^') {
7137 group++;
7138 for (; *string; string++) {
7139 for (ptr = group; *ptr; ptr++) {
7140 if (*ptr == *string)
7141 break;
7143 if (*ptr == '\0')
7144 return string;
7146 } else {
7147 for (; *string; string++) {
7148 for (ptr = group; *ptr; ptr++) {
7149 if (*ptr == *string)
7150 return string;
7155 return (char *) NULL;
7159 * Get a token from the input file; return 0 if end of file is reached
7161 static int dgap_gettok(char **in, struct cnode *p)
7163 char *w;
7164 struct toklist *t;
7166 if (strstr(dgap_cword, "boar")) {
7167 w = dgap_getword(in);
7168 snprintf(dgap_cword, MAXCWORD, "%s", w);
7169 for (t = dgap_tlist; t->token != 0; t++) {
7170 if (!strcmp(w, t->string))
7171 return t->token;
7173 dgap_err("board !!type not specified");
7174 return 1;
7175 } else {
7176 while ((w = dgap_getword(in))) {
7177 snprintf(dgap_cword, MAXCWORD, "%s", w);
7178 for (t = dgap_tlist; t->token != 0; t++) {
7179 if (!strcmp(w, t->string))
7180 return t->token;
7183 return 0;
7188 * get a word from the input stream, also keep track of current line number.
7189 * words are separated by whitespace.
7191 static char *dgap_getword(char **in)
7193 char *ret_ptr = *in;
7195 char *ptr = dgap_sindex(*in, " \t\n");
7197 /* If no word found, return null */
7198 if (!ptr)
7199 return NULL;
7201 /* Mark new location for our buffer */
7202 *ptr = '\0';
7203 *in = ptr + 1;
7205 /* Eat any extra spaces/tabs/newlines that might be present */
7206 while (*in && **in && ((**in == ' ') ||
7207 (**in == '\t') ||
7208 (**in == '\n'))) {
7209 **in = '\0';
7210 *in = *in + 1;
7213 return ret_ptr;
7217 * print an error message, giving the line number in the file where
7218 * the error occurred.
7220 static void dgap_err(char *s)
7222 pr_err("dgap: parse: %s\n", s);
7226 * allocate a new configuration node of type t
7228 static struct cnode *dgap_newnode(int t)
7230 struct cnode *n;
7232 n = kmalloc(sizeof(struct cnode), GFP_KERNEL);
7233 if (n) {
7234 memset((char *)n, 0, sizeof(struct cnode));
7235 n->type = t;
7237 return n;
7241 * dgap_checknode: see if all the necessary info has been supplied for a node
7242 * before creating the next node.
7244 static int dgap_checknode(struct cnode *p)
7246 switch (p->type) {
7247 case BNODE:
7248 if (p->u.board.v_type == 0) {
7249 dgap_err("board type !not specified");
7250 return 1;
7253 return 0;
7255 case LNODE:
7256 if (p->u.line.v_speed == 0) {
7257 dgap_err("line speed not specified");
7258 return 1;
7260 return 0;
7262 case CNODE:
7263 if (p->u.conc.v_type == 0) {
7264 dgap_err("concentrator type not specified");
7265 return 1;
7267 if (p->u.conc.v_speed == 0) {
7268 dgap_err("concentrator line speed not specified");
7269 return 1;
7271 if (p->u.conc.v_nport == 0) {
7272 dgap_err("number of ports on concentrator not specified");
7273 return 1;
7275 if (p->u.conc.v_id == 0) {
7276 dgap_err("concentrator id letter not specified");
7277 return 1;
7279 return 0;
7281 case MNODE:
7282 if (p->u.module.v_type == 0) {
7283 dgap_err("EBI module type not specified");
7284 return 1;
7286 if (p->u.module.v_nport == 0) {
7287 dgap_err("number of ports on EBI module not specified");
7288 return 1;
7290 if (p->u.module.v_id == 0) {
7291 dgap_err("EBI module id letter not specified");
7292 return 1;
7294 return 0;
7296 return 0;
7300 * Given a board pointer, returns whether we should use interrupts or not.
7302 static uint dgap_config_get_useintr(struct board_t *bd)
7304 struct cnode *p;
7306 if (!bd)
7307 return 0;
7309 for (p = bd->bd_config; p; p = p->next) {
7310 if (p->type == INTRNODE) {
7312 * check for pcxr types.
7314 return p->u.useintr;
7318 /* If not found, then don't turn on interrupts. */
7319 return 0;
7323 * Given a board pointer, returns whether we turn on altpin or not.
7325 static uint dgap_config_get_altpin(struct board_t *bd)
7327 struct cnode *p;
7329 if (!bd)
7330 return 0;
7332 for (p = bd->bd_config; p; p = p->next) {
7333 if (p->type == ANODE) {
7335 * check for pcxr types.
7337 return p->u.altpin;
7341 /* If not found, then don't turn on interrupts. */
7342 return 0;
7346 * Given a specific type of board, if found, detached link and
7347 * returns the first occurrence in the list.
7349 static struct cnode *dgap_find_config(int type, int bus, int slot)
7351 struct cnode *p, *prev, *prev2, *found;
7353 p = &dgap_head;
7355 while (p->next) {
7356 prev = p;
7357 p = p->next;
7359 if (p->type != BNODE)
7360 continue;
7362 if (p->u.board.type != type)
7363 continue;
7365 if (p->u.board.v_pcibus &&
7366 p->u.board.pcibus != bus)
7367 continue;
7369 if (p->u.board.v_pcislot &&
7370 p->u.board.pcislot != slot)
7371 continue;
7373 found = p;
7375 * Keep walking thru the list till we
7376 * find the next board.
7378 while (p->next) {
7379 prev2 = p;
7380 p = p->next;
7382 if (p->type != BNODE)
7383 continue;
7386 * Mark the end of our 1 board
7387 * chain of configs.
7389 prev2->next = NULL;
7392 * Link the "next" board to the
7393 * previous board, effectively
7394 * "unlinking" our board from
7395 * the main config.
7397 prev->next = p;
7399 return found;
7402 * It must be the last board in the list.
7404 prev->next = NULL;
7405 return found;
7407 return NULL;
7411 * Given a board pointer, walks the config link, counting up
7412 * all ports user specified should be on the board.
7413 * (This does NOT mean they are all actually present right now tho)
7415 static uint dgap_config_get_num_prts(struct board_t *bd)
7417 int count = 0;
7418 struct cnode *p;
7420 if (!bd)
7421 return 0;
7423 for (p = bd->bd_config; p; p = p->next) {
7425 switch (p->type) {
7426 case BNODE:
7428 * check for pcxr types.
7430 if (p->u.board.type > EPCFE)
7431 count += p->u.board.nport;
7432 break;
7433 case CNODE:
7434 count += p->u.conc.nport;
7435 break;
7436 case MNODE:
7437 count += p->u.module.nport;
7438 break;
7441 return count;
7444 static char *dgap_create_config_string(struct board_t *bd, char *string)
7446 char *ptr = string;
7447 struct cnode *p;
7448 struct cnode *q;
7449 int speed;
7451 if (!bd) {
7452 *ptr = 0xff;
7453 return string;
7456 for (p = bd->bd_config; p; p = p->next) {
7458 switch (p->type) {
7459 case LNODE:
7460 *ptr = '\0';
7461 ptr++;
7462 *ptr = p->u.line.speed;
7463 ptr++;
7464 break;
7465 case CNODE:
7467 * Because the EPC/con concentrators can have EM modules
7468 * hanging off of them, we have to walk ahead in the
7469 * list and keep adding the number of ports on each EM
7470 * to the config. UGH!
7472 speed = p->u.conc.speed;
7473 q = p->next;
7474 if (q && (q->type == MNODE)) {
7475 *ptr = (p->u.conc.nport + 0x80);
7476 ptr++;
7477 p = q;
7478 while (q->next && (q->next->type) == MNODE) {
7479 *ptr = (q->u.module.nport + 0x80);
7480 ptr++;
7481 p = q;
7482 q = q->next;
7484 *ptr = q->u.module.nport;
7485 ptr++;
7486 } else {
7487 *ptr = p->u.conc.nport;
7488 ptr++;
7491 *ptr = speed;
7492 ptr++;
7493 break;
7497 *ptr = 0xff;
7498 return string;