projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
staging: dgap: implement proper error handling in dgap_start()
[deliverable/linux.git] / drivers / staging / dgap / dgap.c
1 /*
2 * Copyright 2003 Digi International (www.digi.com)
3 * Scott H Kilau <Scott_Kilau at digi dot com>
4 *
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.
9 *
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.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
18 *
19 *
20 * NOTE TO LINUX KERNEL HACKERS: DO NOT REFORMAT THIS CODE!
21 *
22 * This is shared code between Digi's CVS archive and the
23 * Linux Kernel sources.
24 * Changing the source just for reformatting needlessly breaks
25 * our CVS diff history.
26 *
27 * Send any bug fixes/changes to: Eng.Linux at digi dot com.
28 * Thank you.
29 *
30 */
31
32 /*
33 * In the original out of kernel Digi dgap driver, firmware
34 * loading was done via user land to driver handshaking.
35 *
36 * For cards that support a concentrator (port expander),
37 * I believe the concentrator its self told the card which
38 * concentrator is actually attached and then that info
39 * was used to tell user land which concentrator firmware
40 * image was to be downloaded. I think even the BIOS or
41 * FEP images required could change with the connection
42 * of a particular concentrator.
43 *
44 * Since I have no access to any of these cards or
45 * concentrators, I cannot put the correct concentrator
46 * firmware file names into the firmware_info structure
47 * as is now done for the BIOS and FEP images.
48 *
49 * I think, but am not certain, that the cards supporting
50 * concentrators will function without them. So support
51 * of these cards has been left in this driver.
52 *
53 * In order to fully support those cards, they would
54 * either have to be acquired for dissection or maybe
55 * Digi International could provide some assistance.
56 */
57 #undef DIGI_CONCENTRATORS_SUPPORTED
58
59 #include <linux/kernel.h>
60 #include <linux/module.h>
61 #include <linux/pci.h>
62 #include <linux/delay.h> /* For udelay */
63 #include <linux/slab.h>
64 #include <linux/uaccess.h>
65 #include <linux/sched.h>
66
67 #include <linux/interrupt.h> /* For tasklet and interrupt structs/defines */
68 #include <linux/ctype.h>
69 #include <linux/tty.h>
70 #include <linux/tty_flip.h>
71 #include <linux/serial_reg.h>
72 #include <linux/io.h> /* For read[bwl]/write[bwl] */
73
74 #include <linux/string.h>
75 #include <linux/device.h>
76 #include <linux/kdev_t.h>
77 #include <linux/firmware.h>
78
79 #include "dgap.h"
80
81 #define init_MUTEX(sem) sema_init(sem, 1)
82 #define DECLARE_MUTEX(name) \
83 struct semaphore name = __SEMAPHORE_INITIALIZER(name, 1)
84
85 MODULE_LICENSE("GPL");
86 MODULE_AUTHOR("Digi International, http://www.digi.com");
87 MODULE_DESCRIPTION("Driver for the Digi International EPCA PCI based product line");
88 MODULE_SUPPORTED_DEVICE("dgap");
89
90 /**************************************************************************
91 *
92 * protos for this file
93 *
94 */
95
96 static int dgap_start(void);
97 static void dgap_init_globals(void);
98 static int dgap_found_board(struct pci_dev *pdev, int id);
99 static void dgap_cleanup_board(struct board_t *brd);
100 static void dgap_poll_handler(ulong dummy);
101 static int dgap_init_pci(void);
102 static int dgap_init_one(struct pci_dev *pdev, const struct pci_device_id *ent);
103 static void dgap_remove_one(struct pci_dev *dev);
104 static int dgap_probe1(struct pci_dev *pdev, int card_type);
105 static int dgap_do_remap(struct board_t *brd);
106 static irqreturn_t dgap_intr(int irq, void *voidbrd);
107
108 /* Our function prototypes */
109 static int dgap_tty_open(struct tty_struct *tty, struct file *file);
110 static void dgap_tty_close(struct tty_struct *tty, struct file *file);
111 static int dgap_block_til_ready(struct tty_struct *tty, struct file *file,
112 struct channel_t *ch);
113 static int dgap_tty_ioctl(struct tty_struct *tty, unsigned int cmd,
114 unsigned long arg);
115 static int dgap_tty_digigeta(struct tty_struct *tty,
116 struct digi_t __user *retinfo);
117 static int dgap_tty_digiseta(struct tty_struct *tty,
118 struct digi_t __user *new_info);
119 static int dgap_tty_digigetedelay(struct tty_struct *tty, int __user *retinfo);
120 static int dgap_tty_digisetedelay(struct tty_struct *tty, int __user *new_info);
121 static int dgap_tty_write_room(struct tty_struct *tty);
122 static int dgap_tty_chars_in_buffer(struct tty_struct *tty);
123 static void dgap_tty_start(struct tty_struct *tty);
124 static void dgap_tty_stop(struct tty_struct *tty);
125 static void dgap_tty_throttle(struct tty_struct *tty);
126 static void dgap_tty_unthrottle(struct tty_struct *tty);
127 static void dgap_tty_flush_chars(struct tty_struct *tty);
128 static void dgap_tty_flush_buffer(struct tty_struct *tty);
129 static void dgap_tty_hangup(struct tty_struct *tty);
130 static int dgap_wait_for_drain(struct tty_struct *tty);
131 static int dgap_set_modem_info(struct tty_struct *tty, unsigned int command,
132 unsigned int __user *value);
133 static int dgap_get_modem_info(struct channel_t *ch,
134 unsigned int __user *value);
135 static int dgap_tty_digisetcustombaud(struct tty_struct *tty,
136 int __user *new_info);
137 static int dgap_tty_digigetcustombaud(struct tty_struct *tty,
138 int __user *retinfo);
139 static int dgap_tty_tiocmget(struct tty_struct *tty);
140 static int dgap_tty_tiocmset(struct tty_struct *tty, unsigned int set,
141 unsigned int clear);
142 static int dgap_tty_send_break(struct tty_struct *tty, int msec);
143 static void dgap_tty_wait_until_sent(struct tty_struct *tty, int timeout);
144 static int dgap_tty_write(struct tty_struct *tty, const unsigned char *buf,
145 int count);
146 static void dgap_tty_set_termios(struct tty_struct *tty,
147 struct ktermios *old_termios);
148 static int dgap_tty_put_char(struct tty_struct *tty, unsigned char c);
149 static void dgap_tty_send_xchar(struct tty_struct *tty, char ch);
150
151 static int dgap_tty_register(struct board_t *brd);
152 static int dgap_tty_init(struct board_t *);
153 static void dgap_tty_uninit(struct board_t *);
154 static void dgap_carrier(struct channel_t *ch);
155 static void dgap_input(struct channel_t *ch);
156
157 /*
158 * Our function prototypes from dgap_fep5
159 */
160 static void dgap_cmdw_ext(struct channel_t *ch, u16 cmd, u16 word, uint ncmds);
161 static int dgap_event(struct board_t *bd);
162
163 static void dgap_poll_tasklet(unsigned long data);
164 static void dgap_cmdb(struct channel_t *ch, uchar cmd, uchar byte1,
165 uchar byte2, uint ncmds);
166 static void dgap_cmdw(struct channel_t *ch, uchar cmd, u16 word, uint ncmds);
167 static void dgap_wmove(struct channel_t *ch, char *buf, uint cnt);
168 static int dgap_param(struct tty_struct *tty);
169 static void dgap_parity_scan(struct channel_t *ch, unsigned char *cbuf,
170 unsigned char *fbuf, int *len);
171 static uint dgap_get_custom_baud(struct channel_t *ch);
172 static void dgap_firmware_reset_port(struct channel_t *ch);
173
174 /*
175 * Function prototypes from dgap_parse.c.
176 */
177 static int dgap_gettok(char **in, struct cnode *p);
178 static char *dgap_getword(char **in);
179 static char *dgap_savestring(char *s);
180 static struct cnode *dgap_newnode(int t);
181 static int dgap_checknode(struct cnode *p);
182 static void dgap_err(char *s);
183
184 /*
185 * Function prototypes from dgap_sysfs.h
186 */
187 struct board_t;
188 struct channel_t;
189 struct un_t;
190 struct pci_driver;
191 struct class_device;
192
193 static void dgap_create_ports_sysfiles(struct board_t *bd);
194 static void dgap_remove_ports_sysfiles(struct board_t *bd);
195
196 static int dgap_create_driver_sysfiles(struct pci_driver *);
197 static void dgap_remove_driver_sysfiles(struct pci_driver *);
198
199 static void dgap_create_tty_sysfs(struct un_t *un, struct device *c);
200 static void dgap_remove_tty_sysfs(struct device *c);
201
202 /*
203 * Function prototypes from dgap_parse.h
204 */
205 static int dgap_parsefile(char **in, int Remove);
206 static struct cnode *dgap_find_config(int type, int bus, int slot);
207 static uint dgap_config_get_number_of_ports(struct board_t *bd);
208 static char *dgap_create_config_string(struct board_t *bd, char *string);
209 static uint dgap_config_get_useintr(struct board_t *bd);
210 static uint dgap_config_get_altpin(struct board_t *bd);
211
212 static int dgap_ms_sleep(ulong ms);
213 static void dgap_do_bios_load(struct board_t *brd, uchar __user *ubios,
214 int len);
215 static void dgap_do_fep_load(struct board_t *brd, uchar __user *ufep, int len);
216 #ifdef DIGI_CONCENTRATORS_SUPPORTED
217 static void dgap_do_conc_load(struct board_t *brd, uchar *uaddr, int len);
218 #endif
219 static int dgap_after_config_loaded(int board);
220 static int dgap_finalize_board_init(struct board_t *brd);
221
222 static void dgap_get_vpd(struct board_t *brd);
223 static void dgap_do_reset_board(struct board_t *brd);
224 static void dgap_do_wait_for_bios(struct board_t *brd);
225 static void dgap_do_wait_for_fep(struct board_t *brd);
226 static int dgap_tty_register_ports(struct board_t *brd);
227 static int dgap_firmware_load(struct pci_dev *pdev, int card_type);
228
229 /* Driver unload function */
230 static void dgap_cleanup_module(void);
231
232 module_exit(dgap_cleanup_module);
233
234 /*
235 * File operations permitted on Control/Management major.
236 */
237 static const struct file_operations DgapBoardFops = {
238 .owner = THIS_MODULE,
239 };
240
241 /*
242 * Globals
243 */
244 static uint dgap_NumBoards;
245 static struct board_t *dgap_Board[MAXBOARDS];
246 static ulong dgap_poll_counter;
247 static char *dgap_config_buf;
248 static int dgap_driver_state = DRIVER_INITIALIZED;
249 DEFINE_SPINLOCK(dgap_dl_lock);
250 static wait_queue_head_t dgap_dl_wait;
251 static int dgap_dl_action;
252 static int dgap_poll_tick = 20; /* Poll interval - 20 ms */
253
254 /*
255 * Static vars.
256 */
257 static struct class *dgap_class;
258
259 static struct board_t *dgap_BoardsByMajor[256];
260 static uint dgap_count = 500;
261
262 /*
263 * Poller stuff
264 */
265 DEFINE_SPINLOCK(dgap_poll_lock); /* Poll scheduling lock */
266 static ulong dgap_poll_time; /* Time of next poll */
267 static uint dgap_poll_stop; /* Used to tell poller to stop */
268 static struct timer_list dgap_poll_timer;
269
270 /*
271 SUPPORTED PRODUCTS
272
273 Card Model Number of Ports Interface
274 ----------------------------------------------------------------
275 Acceleport Xem 4 - 64 (EIA232 & EIA422)
276 Acceleport Xr 4 & 8 (EIA232)
277 Acceleport Xr 920 4 & 8 (EIA232)
278 Acceleport C/X 8 - 128 (EIA232)
279 Acceleport EPC/X 8 - 224 (EIA232)
280 Acceleport Xr/422 4 & 8 (EIA422)
281 Acceleport 2r/920 2 (EIA232)
282 Acceleport 4r/920 4 (EIA232)
283 Acceleport 8r/920 8 (EIA232)
284
285 IBM 8-Port Asynchronous PCI Adapter (EIA232)
286 IBM 128-Port Asynchronous PCI Adapter (EIA232 & EIA422)
287 */
288
289 static struct pci_device_id dgap_pci_tbl[] = {
290 { DIGI_VID, PCI_DEV_XEM_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
291 { DIGI_VID, PCI_DEV_CX_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
292 { DIGI_VID, PCI_DEV_CX_IBM_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2 },
293 { DIGI_VID, PCI_DEV_EPCJ_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 3 },
294 { DIGI_VID, PCI_DEV_920_2_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 4 },
295 { DIGI_VID, PCI_DEV_920_4_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 5 },
296 { DIGI_VID, PCI_DEV_920_8_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 6 },
297 { DIGI_VID, PCI_DEV_XR_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 7 },
298 { DIGI_VID, PCI_DEV_XRJ_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 8 },
299 { DIGI_VID, PCI_DEV_XR_422_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 9 },
300 { DIGI_VID, PCI_DEV_XR_IBM_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 10 },
301 { DIGI_VID, PCI_DEV_XR_SAIP_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 11 },
302 { DIGI_VID, PCI_DEV_XR_BULL_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 12 },
303 { DIGI_VID, PCI_DEV_920_8_HP_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 13 },
304 { DIGI_VID, PCI_DEV_XEM_HP_DID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 14 },
305 {0,} /* 0 terminated list. */
306 };
307 MODULE_DEVICE_TABLE(pci, dgap_pci_tbl);
308
309 /*
310 * A generic list of Product names, PCI Vendor ID, and PCI Device ID.
311 */
312 struct board_id {
313 uint config_type;
314 uchar *name;
315 uint maxports;
316 uint dpatype;
317 };
318
319 static struct board_id dgap_Ids[] = {
320 { PPCM, PCI_DEV_XEM_NAME, 64, (T_PCXM|T_PCLITE|T_PCIBUS) },
321 { PCX, PCI_DEV_CX_NAME, 128, (T_CX|T_PCIBUS) },
322 { PCX, PCI_DEV_CX_IBM_NAME, 128, (T_CX|T_PCIBUS) },
323 { PEPC, PCI_DEV_EPCJ_NAME, 224, (T_EPC|T_PCIBUS) },
324 { APORT2_920P, PCI_DEV_920_2_NAME, 2, (T_PCXR|T_PCLITE|T_PCIBUS) },
325 { APORT4_920P, PCI_DEV_920_4_NAME, 4, (T_PCXR|T_PCLITE|T_PCIBUS) },
326 { APORT8_920P, PCI_DEV_920_8_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
327 { PAPORT8, PCI_DEV_XR_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
328 { PAPORT8, PCI_DEV_XRJ_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
329 { PAPORT8, PCI_DEV_XR_422_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
330 { PAPORT8, PCI_DEV_XR_IBM_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
331 { PAPORT8, PCI_DEV_XR_SAIP_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
332 { PAPORT8, PCI_DEV_XR_BULL_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
333 { APORT8_920P, PCI_DEV_920_8_HP_NAME, 8, (T_PCXR|T_PCLITE|T_PCIBUS) },
334 { PPCM, PCI_DEV_XEM_HP_NAME, 64, (T_PCXM|T_PCLITE|T_PCIBUS) },
335 {0,} /* 0 terminated list. */
336 };
337
338 static struct pci_driver dgap_driver = {
339 .name = "dgap",
340 .probe = dgap_init_one,
341 .id_table = dgap_pci_tbl,
342 .remove = dgap_remove_one,
343 };
344
345 struct firmware_info {
346 uchar *conf_name; /* dgap.conf */
347 uchar *bios_name; /* BIOS filename */
348 uchar *fep_name; /* FEP filename */
349 uchar *con_name; /* Concentrator filename FIXME*/
350 int num; /* sequence number */
351 };
352
353 /*
354 * Firmware - BIOS, FEP, and CONC filenames
355 */
356 static struct firmware_info fw_info[] = {
357 { "dgap/dgap.conf", "dgap/sxbios.bin", "dgap/sxfep.bin", 0, 0 },
358 { "dgap/dgap.conf", "dgap/cxpbios.bin", "dgap/cxpfep.bin", 0, 1 },
359 { "dgap/dgap.conf", "dgap/cxpbios.bin", "dgap/cxpfep.bin", 0, 2 },
360 { "dgap/dgap.conf", "dgap/pcibios.bin", "dgap/pcifep.bin", 0, 3 },
361 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 4 },
362 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 5 },
363 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 6 },
364 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 7 },
365 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 8 },
366 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 9 },
367 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 10 },
368 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 11 },
369 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 12 },
370 { "dgap/dgap.conf", "dgap/xrbios.bin", "dgap/xrfep.bin", 0, 13 },
371 { "dgap/dgap.conf", "dgap/sxbios.bin", "dgap/sxfep.bin", 0, 14 },
372 {0,}
373 };
374
375 static char *dgap_driver_state_text[] = {
376 "Driver Initialized",
377 "Driver needs configuration load.",
378 "Driver requested configuration from download daemon.",
379 "Driver Ready."
380 };
381
382 /*
383 * Default transparent print information.
384 */
385 static struct digi_t dgap_digi_init = {
386 .digi_flags = DIGI_COOK, /* Flags */
387 .digi_maxcps = 100, /* Max CPS */
388 .digi_maxchar = 50, /* Max chars in print queue */
389 .digi_bufsize = 100, /* Printer buffer size */
390 .digi_onlen = 4, /* size of printer on string */
391 .digi_offlen = 4, /* size of printer off string */
392 .digi_onstr = "\033[5i", /* ANSI printer on string ] */
393 .digi_offstr = "\033[4i", /* ANSI printer off string ] */
394 .digi_term = "ansi" /* default terminal type */
395 };
396
397 /*
398 * Define a local default termios struct. All ports will be created
399 * with this termios initially.
400 *
401 * This defines a raw port at 9600 baud, 8 data bits, no parity,
402 * 1 stop bit.
403 */
404
405 static struct ktermios DgapDefaultTermios = {
406 .c_iflag = (DEFAULT_IFLAGS), /* iflags */
407 .c_oflag = (DEFAULT_OFLAGS), /* oflags */
408 .c_cflag = (DEFAULT_CFLAGS), /* cflags */
409 .c_lflag = (DEFAULT_LFLAGS), /* lflags */
410 .c_cc = INIT_C_CC,
411 .c_line = 0,
412 };
413
414 static const struct tty_operations dgap_tty_ops = {
415 .open = dgap_tty_open,
416 .close = dgap_tty_close,
417 .write = dgap_tty_write,
418 .write_room = dgap_tty_write_room,
419 .flush_buffer = dgap_tty_flush_buffer,
420 .chars_in_buffer = dgap_tty_chars_in_buffer,
421 .flush_chars = dgap_tty_flush_chars,
422 .ioctl = dgap_tty_ioctl,
423 .set_termios = dgap_tty_set_termios,
424 .stop = dgap_tty_stop,
425 .start = dgap_tty_start,
426 .throttle = dgap_tty_throttle,
427 .unthrottle = dgap_tty_unthrottle,
428 .hangup = dgap_tty_hangup,
429 .put_char = dgap_tty_put_char,
430 .tiocmget = dgap_tty_tiocmget,
431 .tiocmset = dgap_tty_tiocmset,
432 .break_ctl = dgap_tty_send_break,
433 .wait_until_sent = dgap_tty_wait_until_sent,
434 .send_xchar = dgap_tty_send_xchar
435 };
436
437 /*
438 * Our needed internal static variables from dgap_parse.c
439 */
440 static struct cnode dgap_head;
441 #define MAXCWORD 200
442 static char dgap_cword[MAXCWORD];
443
444 struct toklist {
445 int token;
446 char *string;
447 };
448
449 static struct toklist dgap_tlist[] = {
450 { BEGIN, "config_begin" },
451 { END, "config_end" },
452 { BOARD, "board" },
453 { PCX, "Digi_AccelePort_C/X_PCI" },
454 { PEPC, "Digi_AccelePort_EPC/X_PCI" },
455 { PPCM, "Digi_AccelePort_Xem_PCI" },
456 { APORT2_920P, "Digi_AccelePort_2r_920_PCI" },
457 { APORT4_920P, "Digi_AccelePort_4r_920_PCI" },
458 { APORT8_920P, "Digi_AccelePort_8r_920_PCI" },
459 { PAPORT4, "Digi_AccelePort_4r_PCI(EIA-232/RS-422)" },
460 { PAPORT8, "Digi_AccelePort_8r_PCI(EIA-232/RS-422)" },
461 { IO, "io" },
462 { PCIINFO, "pciinfo" },
463 { LINE, "line" },
464 { CONC, "conc" },
465 { CONC, "concentrator" },
466 { CX, "cx" },
467 { CX, "ccon" },
468 { EPC, "epccon" },
469 { EPC, "epc" },
470 { MOD, "module" },
471 { ID, "id" },
472 { STARTO, "start" },
473 { SPEED, "speed" },
474 { CABLE, "cable" },
475 { CONNECT, "connect" },
476 { METHOD, "method" },
477 { STATUS, "status" },
478 { CUSTOM, "Custom" },
479 { BASIC, "Basic" },
480 { MEM, "mem" },
481 { MEM, "memory" },
482 { PORTS, "ports" },
483 { MODEM, "modem" },
484 { NPORTS, "nports" },
485 { TTYN, "ttyname" },
486 { CU, "cuname" },
487 { PRINT, "prname" },
488 { CMAJOR, "major" },
489 { ALTPIN, "altpin" },
490 { USEINTR, "useintr" },
491 { TTSIZ, "ttysize" },
492 { CHSIZ, "chsize" },
493 { BSSIZ, "boardsize" },
494 { UNTSIZ, "schedsize" },
495 { F2SIZ, "f2200size" },
496 { VPSIZ, "vpixsize" },
497 { 0, NULL }
498 };
499
500 /************************************************************************
501 *
502 * Driver load/unload functions
503 *
504 ************************************************************************/
505
506 /*
507 * init_module()
508 *
509 * Module load. This is where it all starts.
510 */
511 static int dgap_init_module(void)
512 {
513 int rc = 0;
514
515 pr_info("%s, Digi International Part Number %s\n", DG_NAME, DG_PART);
516
517 dgap_driver_state = DRIVER_NEED_CONFIG_LOAD;
518
519 rc = dgap_start();
520 if (rc)
521 return rc;
522
523 rc = dgap_init_pci();
524 if (rc)
525 goto err_cleanup;
526
527 rc = dgap_create_driver_sysfiles(&dgap_driver);
528 if (rc)
529 goto err_cleanup;
530
531 dgap_driver_state = DRIVER_READY;
532
533 return 0;
534
535 err_cleanup:
536
537 dgap_cleanup_module();
538
539 return rc;
540 }
541 module_init(dgap_init_module);
542
543 /*
544 * Start of driver.
545 */
546 static int dgap_start(void)
547 {
548 int rc = 0;
549 unsigned long flags;
550 struct device *device;
551
552 /*
553 * make sure that the globals are
554 * init'd before we do anything else
555 */
556 dgap_init_globals();
557
558 dgap_NumBoards = 0;
559
560 pr_info("For the tools package please visit http://www.digi.com\n");
561
562 /*
563 * Register our base character device into the kernel.
564 */
565
566 /*
567 * Register management/dpa devices
568 */
569 rc = register_chrdev(DIGI_DGAP_MAJOR, "dgap", &DgapBoardFops);
570 if (rc < 0)
571 return rc;
572
573 dgap_class = class_create(THIS_MODULE, "dgap_mgmt");
574 if (IS_ERR(dgap_class)) {
575 rc = PTR_ERR(dgap_class);
576 goto failed_class;
577 }
578
579 device = device_create(dgap_class, NULL,
580 MKDEV(DIGI_DGAP_MAJOR, 0),
581 NULL, "dgap_mgmt");
582 if (IS_ERR(device)) {
583 rc = PTR_ERR(device);
584 goto failed_device;
585 }
586
587 /* Start the poller */
588 DGAP_LOCK(dgap_poll_lock, flags);
589 init_timer(&dgap_poll_timer);
590 dgap_poll_timer.function = dgap_poll_handler;
591 dgap_poll_timer.data = 0;
592 dgap_poll_time = jiffies + dgap_jiffies_from_ms(dgap_poll_tick);
593 dgap_poll_timer.expires = dgap_poll_time;
594 DGAP_UNLOCK(dgap_poll_lock, flags);
595
596 add_timer(&dgap_poll_timer);
597
598 dgap_driver_state = DRIVER_NEED_CONFIG_LOAD;
599
600 return rc;
601
602 failed_device:
603 class_destroy(dgap_class);
604 failed_class:
605 unregister_chrdev(DIGI_DGAP_MAJOR, "dgap");
606 return rc;
607 }
608
609 /*
610 * Register pci driver, and return how many boards we have.
611 */
612 static int dgap_init_pci(void)
613 {
614 return pci_register_driver(&dgap_driver);
615 }
616
617 /* returns count (>= 0), or negative on error */
618 static int dgap_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
619 {
620 int rc;
621
622 /* wake up and enable device */
623 rc = pci_enable_device(pdev);
624
625 if (rc < 0) {
626 rc = -EIO;
627 } else {
628 rc = dgap_probe1(pdev, ent->driver_data);
629 if (rc == 0) {
630 dgap_NumBoards++;
631 rc = dgap_firmware_load(pdev, ent->driver_data);
632 }
633 }
634 return rc;
635 }
636
637 static int dgap_probe1(struct pci_dev *pdev, int card_type)
638 {
639 return dgap_found_board(pdev, card_type);
640 }
641
642 static void dgap_remove_one(struct pci_dev *dev)
643 {
644 /* Do Nothing */
645 }
646
647 /*
648 * dgap_cleanup_module()
649 *
650 * Module unload. This is where it all ends.
651 */
652 static void dgap_cleanup_module(void)
653 {
654 int i;
655 ulong lock_flags;
656
657 DGAP_LOCK(dgap_poll_lock, lock_flags);
658 dgap_poll_stop = 1;
659 DGAP_UNLOCK(dgap_poll_lock, lock_flags);
660
661 /* Turn off poller right away. */
662 del_timer_sync(&dgap_poll_timer);
663
664 dgap_remove_driver_sysfiles(&dgap_driver);
665
666 device_destroy(dgap_class, MKDEV(DIGI_DGAP_MAJOR, 0));
667 class_destroy(dgap_class);
668 unregister_chrdev(DIGI_DGAP_MAJOR, "dgap");
669
670 kfree(dgap_config_buf);
671
672 for (i = 0; i < dgap_NumBoards; ++i) {
673 dgap_remove_ports_sysfiles(dgap_Board[i]);
674 dgap_tty_uninit(dgap_Board[i]);
675 dgap_cleanup_board(dgap_Board[i]);
676 }
677
678 if (dgap_NumBoards)
679 pci_unregister_driver(&dgap_driver);
680 }
681
682 /*
683 * dgap_cleanup_board()
684 *
685 * Free all the memory associated with a board
686 */
687 static void dgap_cleanup_board(struct board_t *brd)
688 {
689 int i = 0;
690
691 if (!brd || brd->magic != DGAP_BOARD_MAGIC)
692 return;
693
694 if (brd->intr_used && brd->irq)
695 free_irq(brd->irq, brd);
696
697 tasklet_kill(&brd->helper_tasklet);
698
699 if (brd->re_map_port) {
700 release_mem_region(brd->membase + 0x200000, 0x200000);
701 iounmap(brd->re_map_port);
702 brd->re_map_port = NULL;
703 }
704
705 if (brd->re_map_membase) {
706 release_mem_region(brd->membase, 0x200000);
707 iounmap(brd->re_map_membase);
708 brd->re_map_membase = NULL;
709 }
710
711 /* Free all allocated channels structs */
712 for (i = 0; i < MAXPORTS ; i++)
713 kfree(brd->channels[i]);
714
715 kfree(brd->flipbuf);
716 kfree(brd->flipflagbuf);
717
718 dgap_Board[brd->boardnum] = NULL;
719
720 kfree(brd);
721 }
722
723 /*
724 * dgap_found_board()
725 *
726 * A board has been found, init it.
727 */
728 static int dgap_found_board(struct pci_dev *pdev, int id)
729 {
730 struct board_t *brd;
731 unsigned int pci_irq;
732 int i = 0;
733
734 /* get the board structure and prep it */
735 brd = kzalloc(sizeof(struct board_t), GFP_KERNEL);
736 if (!brd)
737 return -ENOMEM;
738
739 dgap_Board[dgap_NumBoards] = brd;
740
741 /* store the info for the board we've found */
742 brd->magic = DGAP_BOARD_MAGIC;
743 brd->boardnum = dgap_NumBoards;
744 brd->firstminor = 0;
745 brd->vendor = dgap_pci_tbl[id].vendor;
746 brd->device = dgap_pci_tbl[id].device;
747 brd->pdev = pdev;
748 brd->pci_bus = pdev->bus->number;
749 brd->pci_slot = PCI_SLOT(pdev->devfn);
750 brd->name = dgap_Ids[id].name;
751 brd->maxports = dgap_Ids[id].maxports;
752 brd->type = dgap_Ids[id].config_type;
753 brd->dpatype = dgap_Ids[id].dpatype;
754 brd->dpastatus = BD_NOFEP;
755 init_waitqueue_head(&brd->state_wait);
756
757 DGAP_SPINLOCK_INIT(brd->bd_lock);
758
759 brd->state = BOARD_FOUND;
760 brd->runwait = 0;
761 brd->inhibit_poller = FALSE;
762 brd->wait_for_bios = 0;
763 brd->wait_for_fep = 0;
764
765 for (i = 0; i < MAXPORTS; i++)
766 brd->channels[i] = NULL;
767
768 /* store which card & revision we have */
769 pci_read_config_word(pdev, PCI_SUBSYSTEM_VENDOR_ID, &brd->subvendor);
770 pci_read_config_word(pdev, PCI_SUBSYSTEM_ID, &brd->subdevice);
771 pci_read_config_byte(pdev, PCI_REVISION_ID, &brd->rev);
772
773 pci_irq = pdev->irq;
774 brd->irq = pci_irq;
775
776 /* get the PCI Base Address Registers */
777
778 /* Xr Jupiter and EPC use BAR 2 */
779 if (brd->device == PCI_DEV_XRJ_DID || brd->device == PCI_DEV_EPCJ_DID) {
780 brd->membase = pci_resource_start(pdev, 2);
781 brd->membase_end = pci_resource_end(pdev, 2);
782 }
783 /* Everyone else uses BAR 0 */
784 else {
785 brd->membase = pci_resource_start(pdev, 0);
786 brd->membase_end = pci_resource_end(pdev, 0);
787 }
788
789 if (!brd->membase)
790 return -ENODEV;
791
792 if (brd->membase & 1)
793 brd->membase &= ~3;
794 else
795 brd->membase &= ~15;
796
797 /*
798 * On the PCI boards, there is no IO space allocated
799 * The I/O registers will be in the first 3 bytes of the
800 * upper 2MB of the 4MB memory space. The board memory
801 * will be mapped into the low 2MB of the 4MB memory space
802 */
803 brd->port = brd->membase + PCI_IO_OFFSET;
804 brd->port_end = brd->port + PCI_IO_SIZE;
805
806 /*
807 * Special initialization for non-PLX boards
808 */
809 if (brd->device != PCI_DEV_XRJ_DID && brd->device != PCI_DEV_EPCJ_DID) {
810 unsigned short cmd;
811
812 pci_write_config_byte(pdev, 0x40, 0);
813 pci_write_config_byte(pdev, 0x46, 0);
814
815 /* Limit burst length to 2 doubleword transactions */
816 pci_write_config_byte(pdev, 0x42, 1);
817
818 /*
819 * Enable IO and mem if not already done.
820 * This was needed for support on Itanium.
821 */
822 pci_read_config_word(pdev, PCI_COMMAND, &cmd);
823 cmd |= (PCI_COMMAND_IO | PCI_COMMAND_MEMORY);
824 pci_write_config_word(pdev, PCI_COMMAND, cmd);
825 }
826
827 /* init our poll helper tasklet */
828 tasklet_init(&brd->helper_tasklet, dgap_poll_tasklet,
829 (unsigned long) brd);
830
831 i = dgap_do_remap(brd);
832 if (i)
833 brd->state = BOARD_FAILED;
834 else
835 brd->state = NEED_RESET;
836
837 return 0;
838 }
839
840
841 static int dgap_finalize_board_init(struct board_t *brd)
842 {
843 int rc;
844
845 if (!brd || brd->magic != DGAP_BOARD_MAGIC)
846 return -ENODEV;
847
848 brd->use_interrupts = dgap_config_get_useintr(brd);
849
850 /*
851 * Set up our interrupt handler if we are set to do interrupts.
852 */
853 if (brd->use_interrupts && brd->irq) {
854
855 rc = request_irq(brd->irq, dgap_intr, IRQF_SHARED, "DGAP", brd);
856
857 if (rc)
858 brd->intr_used = 0;
859 else
860 brd->intr_used = 1;
861 } else {
862 brd->intr_used = 0;
863 }
864
865 return 0;
866 }
867
868 static int dgap_firmware_load(struct pci_dev *pdev, int card_type)
869 {
870 struct board_t *brd = dgap_Board[dgap_NumBoards - 1];
871 const struct firmware *fw;
872 int ret;
873
874 dgap_get_vpd(brd);
875 dgap_do_reset_board(brd);
876
877 if ((fw_info[card_type].conf_name) &&
878 (dgap_driver_state == DRIVER_NEED_CONFIG_LOAD)) {
879 ret = request_firmware(&fw, fw_info[card_type].conf_name,
880 &pdev->dev);
881 if (ret) {
882 pr_err("dgap: config file %s not found\n",
883 fw_info[card_type].conf_name);
884 return ret;
885 }
886 if (!dgap_config_buf) {
887 dgap_config_buf = kmalloc(fw->size + 1, GFP_ATOMIC);
888 if (!dgap_config_buf) {
889 release_firmware(fw);
890 return -ENOMEM;
891 }
892 }
893
894 memcpy(dgap_config_buf, fw->data, fw->size);
895 release_firmware(fw);
896 dgap_config_buf[fw->size + 1] = '\0';
897
898 if (dgap_parsefile(&dgap_config_buf, TRUE) != 0)
899 return -EINVAL;
900
901 dgap_driver_state = -1;
902 }
903
904 ret = dgap_after_config_loaded(brd->boardnum);
905 if (ret)
906 return ret;
907 /*
908 * Match this board to a config the user created for us.
909 */
910 brd->bd_config =
911 dgap_find_config(brd->type, brd->pci_bus, brd->pci_slot);
912
913 /*
914 * Because the 4 port Xr products share the same PCI ID
915 * as the 8 port Xr products, if we receive a NULL config
916 * back, and this is a PAPORT8 board, retry with a
917 * PAPORT4 attempt as well.
918 */
919 if (brd->type == PAPORT8 && !brd->bd_config)
920 brd->bd_config =
921 dgap_find_config(PAPORT4, brd->pci_bus, brd->pci_slot);
922
923 if (!brd->bd_config) {
924 pr_err("dgap: No valid configuration found\n");
925 return -EINVAL;
926 }
927
928 dgap_tty_register(brd);
929 dgap_finalize_board_init(brd);
930
931 if (fw_info[card_type].bios_name) {
932 ret = request_firmware(&fw, fw_info[card_type].bios_name,
933 &pdev->dev);
934 if (ret) {
935 pr_err("dgap: bios file %s not found\n",
936 fw_info[card_type].bios_name);
937 return ret;
938 }
939 dgap_do_bios_load(brd, (char *)fw->data, fw->size);
940 release_firmware(fw);
941
942 /* Wait for BIOS to test board... */
943 dgap_do_wait_for_bios(brd);
944
945 if (brd->state != FINISHED_BIOS_LOAD)
946 return -ENXIO;
947 }
948
949 if (fw_info[card_type].fep_name) {
950 ret = request_firmware(&fw, fw_info[card_type].fep_name,
951 &pdev->dev);
952 if (ret) {
953 pr_err("dgap: fep file %s not found\n",
954 fw_info[card_type].fep_name);
955 return ret;
956 }
957 dgap_do_fep_load(brd, (char *)fw->data, fw->size);
958 release_firmware(fw);
959
960 /* Wait for FEP to load on board... */
961 dgap_do_wait_for_fep(brd);
962
963 if (brd->state != FINISHED_FEP_LOAD)
964 return -ENXIO;
965 }
966
967 #ifdef DIGI_CONCENTRATORS_SUPPORTED
968 /*
969 * If this is a CX or EPCX, we need to see if the firmware
970 * is requesting a concentrator image from us.
971 */
972 if ((bd->type == PCX) || (bd->type == PEPC)) {
973 chk_addr = (u16 *) (vaddr + DOWNREQ);
974 /* Nonzero if FEP is requesting concentrator image. */
975 check = readw(chk_addr);
976 vaddr = brd->re_map_membase;
977 }
978
979 if (fw_info[card_type].con_name && check && vaddr) {
980 ret = request_firmware(&fw, fw_info[card_type].con_name,
981 &pdev->dev);
982 if (ret) {
983 pr_err("dgap: conc file %s not found\n",
984 fw_info[card_type].con_name);
985 return ret;
986 }
987 /* Put concentrator firmware loading code here */
988 offset = readw((u16 *) (vaddr + DOWNREQ));
989 memcpy_toio(offset, fw->data, fw->size);
990
991 dgap_do_conc_load(brd, (char *)fw->data, fw->size)
992 release_firmware(fw);
993 }
994 #endif
995 /*
996 * Do tty device initialization.
997 */
998 ret = dgap_tty_init(brd);
999 if (ret < 0) {
1000 dgap_tty_uninit(brd);
1001 return ret;
1002 }
1003
1004 ret = dgap_tty_register_ports(brd);
1005 if (ret)
1006 return ret;
1007
1008 brd->state = BOARD_READY;
1009 brd->dpastatus = BD_RUNNING;
1010
1011 return 0;
1012 }
1013
1014 /*
1015 * Remap PCI memory.
1016 */
1017 static int dgap_do_remap(struct board_t *brd)
1018 {
1019 if (!brd || brd->magic != DGAP_BOARD_MAGIC)
1020 return -ENXIO;
1021
1022 if (!request_mem_region(brd->membase, 0x200000, "dgap"))
1023 return -ENOMEM;
1024
1025 if (!request_mem_region(brd->membase + PCI_IO_OFFSET, 0x200000,
1026 "dgap")) {
1027 release_mem_region(brd->membase, 0x200000);
1028 return -ENOMEM;
1029 }
1030
1031 brd->re_map_membase = ioremap(brd->membase, 0x200000);
1032 if (!brd->re_map_membase) {
1033 release_mem_region(brd->membase, 0x200000);
1034 release_mem_region(brd->membase + PCI_IO_OFFSET, 0x200000);
1035 return -ENOMEM;
1036 }
1037
1038 brd->re_map_port = ioremap((brd->membase + PCI_IO_OFFSET), 0x200000);
1039 if (!brd->re_map_port) {
1040 release_mem_region(brd->membase, 0x200000);
1041 release_mem_region(brd->membase + PCI_IO_OFFSET, 0x200000);
1042 iounmap(brd->re_map_membase);
1043 return -ENOMEM;
1044 }
1045
1046 return 0;
1047 }
1048
1049 /*****************************************************************************
1050 *
1051 * Function:
1052 *
1053 * dgap_poll_handler
1054 *
1055 * Author:
1056 *
1057 * Scott H Kilau
1058 *
1059 * Parameters:
1060 *
1061 * dummy -- ignored
1062 *
1063 * Return Values:
1064 *
1065 * none
1066 *
1067 * Description:
1068 *
1069 * As each timer expires, it determines (a) whether the "transmit"
1070 * waiter needs to be woken up, and (b) whether the poller needs to
1071 * be rescheduled.
1072 *
1073 ******************************************************************************/
1074
1075 static void dgap_poll_handler(ulong dummy)
1076 {
1077 int i;
1078 struct board_t *brd;
1079 unsigned long lock_flags;
1080 ulong new_time;
1081
1082 dgap_poll_counter++;
1083
1084 /*
1085 * Do not start the board state machine until
1086 * driver tells us its up and running, and has
1087 * everything it needs.
1088 */
1089 if (dgap_driver_state != DRIVER_READY)
1090 goto schedule_poller;
1091
1092 /*
1093 * If we have just 1 board, or the system is not SMP,
1094 * then use the typical old style poller.
1095 * Otherwise, use our new tasklet based poller, which should
1096 * speed things up for multiple boards.
1097 */
1098 if ((dgap_NumBoards == 1) || (num_online_cpus() <= 1)) {
1099 for (i = 0; i < dgap_NumBoards; i++) {
1100
1101 brd = dgap_Board[i];
1102
1103 if (brd->state == BOARD_FAILED)
1104 continue;
1105 if (!brd->intr_running)
1106 /* Call the real board poller directly */
1107 dgap_poll_tasklet((unsigned long) brd);
1108 }
1109 } else {
1110 /*
1111 * Go thru each board, kicking off a
1112 * tasklet for each if needed
1113 */
1114 for (i = 0; i < dgap_NumBoards; i++) {
1115 brd = dgap_Board[i];
1116
1117 /*
1118 * Attempt to grab the board lock.
1119 *
1120 * If we can't get it, no big deal, the next poll
1121 * will get it. Basically, I just really don't want
1122 * to spin in here, because I want to kick off my
1123 * tasklets as fast as I can, and then get out the
1124 * poller.
1125 */
1126 if (!spin_trylock(&brd->bd_lock))
1127 continue;
1128
1129 /*
1130 * If board is in a failed state, don't bother
1131 * scheduling a tasklet
1132 */
1133 if (brd->state == BOARD_FAILED) {
1134 spin_unlock(&brd->bd_lock);
1135 continue;
1136 }
1137
1138 /* Schedule a poll helper task */
1139 if (!brd->intr_running)
1140 tasklet_schedule(&brd->helper_tasklet);
1141
1142 /*
1143 * Can't do DGAP_UNLOCK here, as we don't have
1144 * lock_flags because we did a trylock above.
1145 */
1146 spin_unlock(&brd->bd_lock);
1147 }
1148 }
1149
1150 schedule_poller:
1151
1152 /*
1153 * Schedule ourself back at the nominal wakeup interval.
1154 */
1155 DGAP_LOCK(dgap_poll_lock, lock_flags);
1156 dgap_poll_time += dgap_jiffies_from_ms(dgap_poll_tick);
1157
1158 new_time = dgap_poll_time - jiffies;
1159
1160 if ((ulong) new_time >= 2 * dgap_poll_tick) {
1161 dgap_poll_time =
1162 jiffies + dgap_jiffies_from_ms(dgap_poll_tick);
1163 }
1164
1165 dgap_poll_timer.function = dgap_poll_handler;
1166 dgap_poll_timer.data = 0;
1167 dgap_poll_timer.expires = dgap_poll_time;
1168 DGAP_UNLOCK(dgap_poll_lock, lock_flags);
1169
1170 if (!dgap_poll_stop)
1171 add_timer(&dgap_poll_timer);
1172 }
1173
1174 /*
1175 * dgap_intr()
1176 *
1177 * Driver interrupt handler.
1178 */
1179 static irqreturn_t dgap_intr(int irq, void *voidbrd)
1180 {
1181 struct board_t *brd = (struct board_t *) voidbrd;
1182
1183 if (!brd)
1184 return IRQ_NONE;
1185
1186 /*
1187 * Check to make sure its for us.
1188 */
1189 if (brd->magic != DGAP_BOARD_MAGIC)
1190 return IRQ_NONE;
1191
1192 brd->intr_count++;
1193
1194 /*
1195 * Schedule tasklet to run at a better time.
1196 */
1197 tasklet_schedule(&brd->helper_tasklet);
1198 return IRQ_HANDLED;
1199 }
1200
1201 /*
1202 * dgap_init_globals()
1203 *
1204 * This is where we initialize the globals from the static insmod
1205 * configuration variables. These are declared near the head of
1206 * this file.
1207 */
1208 static void dgap_init_globals(void)
1209 {
1210 int i = 0;
1211
1212 for (i = 0; i < MAXBOARDS; i++)
1213 dgap_Board[i] = NULL;
1214
1215 init_timer(&dgap_poll_timer);
1216
1217 init_waitqueue_head(&dgap_dl_wait);
1218 dgap_dl_action = 0;
1219 }
1220
1221 /************************************************************************
1222 *
1223 * Utility functions
1224 *
1225 ************************************************************************/
1226
1227 /*
1228 * dgap_ms_sleep()
1229 *
1230 * Put the driver to sleep for x ms's
1231 *
1232 * Returns 0 if timed out, !0 (showing signal) if interrupted by a signal.
1233 */
1234 static int dgap_ms_sleep(ulong ms)
1235 {
1236 current->state = TASK_INTERRUPTIBLE;
1237 schedule_timeout((ms * HZ) / 1000);
1238 return signal_pending(current);
1239 }
1240
1241 /************************************************************************
1242 *
1243 * TTY Initialization/Cleanup Functions
1244 *
1245 ************************************************************************/
1246
1247 /*
1248 * dgap_tty_register()
1249 *
1250 * Init the tty subsystem for this board.
1251 */
1252 static int dgap_tty_register(struct board_t *brd)
1253 {
1254 int rc = 0;
1255
1256 brd->SerialDriver = alloc_tty_driver(MAXPORTS);
1257
1258 snprintf(brd->SerialName, MAXTTYNAMELEN, "tty_dgap_%d_", brd->boardnum);
1259 brd->SerialDriver->name = brd->SerialName;
1260 brd->SerialDriver->name_base = 0;
1261 brd->SerialDriver->major = 0;
1262 brd->SerialDriver->minor_start = 0;
1263 brd->SerialDriver->type = TTY_DRIVER_TYPE_SERIAL;
1264 brd->SerialDriver->subtype = SERIAL_TYPE_NORMAL;
1265 brd->SerialDriver->init_termios = DgapDefaultTermios;
1266 brd->SerialDriver->driver_name = DRVSTR;
1267 brd->SerialDriver->flags = (TTY_DRIVER_REAL_RAW |
1268 TTY_DRIVER_DYNAMIC_DEV |
1269 TTY_DRIVER_HARDWARE_BREAK);
1270
1271 /* The kernel wants space to store pointers to tty_structs */
1272 brd->SerialDriver->ttys =
1273 kzalloc(MAXPORTS * sizeof(struct tty_struct *), GFP_KERNEL);
1274 if (!brd->SerialDriver->ttys)
1275 return -ENOMEM;
1276
1277 /*
1278 * Entry points for driver. Called by the kernel from
1279 * tty_io.c and n_tty.c.
1280 */
1281 tty_set_operations(brd->SerialDriver, &dgap_tty_ops);
1282
1283 /*
1284 * If we're doing transparent print, we have to do all of the above
1285 * again, separately so we don't get the LD confused about what major
1286 * we are when we get into the dgap_tty_open() routine.
1287 */
1288 brd->PrintDriver = alloc_tty_driver(MAXPORTS);
1289
1290 snprintf(brd->PrintName, MAXTTYNAMELEN, "pr_dgap_%d_", brd->boardnum);
1291 brd->PrintDriver->name = brd->PrintName;
1292 brd->PrintDriver->name_base = 0;
1293 brd->PrintDriver->major = 0;
1294 brd->PrintDriver->minor_start = 0;
1295 brd->PrintDriver->type = TTY_DRIVER_TYPE_SERIAL;
1296 brd->PrintDriver->subtype = SERIAL_TYPE_NORMAL;
1297 brd->PrintDriver->init_termios = DgapDefaultTermios;
1298 brd->PrintDriver->driver_name = DRVSTR;
1299 brd->PrintDriver->flags = (TTY_DRIVER_REAL_RAW |
1300 TTY_DRIVER_DYNAMIC_DEV |
1301 TTY_DRIVER_HARDWARE_BREAK);
1302
1303 /* The kernel wants space to store pointers to tty_structs */
1304 brd->PrintDriver->ttys =
1305 kzalloc(MAXPORTS * sizeof(struct tty_struct *), GFP_KERNEL);
1306 if (!brd->PrintDriver->ttys)
1307 return -ENOMEM;
1308
1309 /*
1310 * Entry points for driver. Called by the kernel from
1311 * tty_io.c and n_tty.c.
1312 */
1313 tty_set_operations(brd->PrintDriver, &dgap_tty_ops);
1314
1315 if (!brd->dgap_Major_Serial_Registered) {
1316 /* Register tty devices */
1317 rc = tty_register_driver(brd->SerialDriver);
1318 if (rc < 0)
1319 return rc;
1320 brd->dgap_Major_Serial_Registered = TRUE;
1321 dgap_BoardsByMajor[brd->SerialDriver->major] = brd;
1322 brd->dgap_Serial_Major = brd->SerialDriver->major;
1323 }
1324
1325 if (!brd->dgap_Major_TransparentPrint_Registered) {
1326 /* Register Transparent Print devices */
1327 rc = tty_register_driver(brd->PrintDriver);
1328 if (rc < 0)
1329 return rc;
1330 brd->dgap_Major_TransparentPrint_Registered = TRUE;
1331 dgap_BoardsByMajor[brd->PrintDriver->major] = brd;
1332 brd->dgap_TransparentPrint_Major = brd->PrintDriver->major;
1333 }
1334
1335 return rc;
1336 }
1337
1338 /*
1339 * dgap_tty_init()
1340 *
1341 * Init the tty subsystem. Called once per board after board has been
1342 * downloaded and init'ed.
1343 */
1344 static int dgap_tty_init(struct board_t *brd)
1345 {
1346 int i;
1347 int tlw;
1348 uint true_count = 0;
1349 uchar *vaddr;
1350 uchar modem = 0;
1351 struct channel_t *ch;
1352 struct bs_t *bs;
1353 struct cm_t *cm;
1354
1355 if (!brd)
1356 return -ENXIO;
1357
1358 /*
1359 * Initialize board structure elements.
1360 */
1361
1362 vaddr = brd->re_map_membase;
1363 true_count = readw((vaddr + NCHAN));
1364
1365 brd->nasync = dgap_config_get_number_of_ports(brd);
1366
1367 if (!brd->nasync)
1368 brd->nasync = brd->maxports;
1369
1370 if (brd->nasync > brd->maxports)
1371 brd->nasync = brd->maxports;
1372
1373 if (true_count != brd->nasync) {
1374 if ((brd->type == PPCM) && (true_count == 64)) {
1375 pr_warn("dgap: %s configured for %d ports, has %d ports.\n",
1376 brd->name, brd->nasync, true_count);
1377 pr_warn("dgap: Please make SURE the EBI cable running from the card\n");
1378 pr_warn("dgap: to each EM module is plugged into EBI IN!\n");
1379 } else if ((brd->type == PPCM) && (true_count == 0)) {
1380 pr_warn("dgap: %s configured for %d ports, has %d ports.\n",
1381 brd->name, brd->nasync, true_count);
1382 pr_warn("dgap: Please make SURE the EBI cable running from the card\n");
1383 pr_warn("dgap: to each EM module is plugged into EBI IN!\n");
1384 } else
1385 pr_warn("dgap: %s configured for %d ports, has %d ports.\n",
1386 brd->name, brd->nasync, true_count);
1387
1388 brd->nasync = true_count;
1389
1390 /* If no ports, don't bother going any further */
1391 if (!brd->nasync) {
1392 brd->state = BOARD_FAILED;
1393 brd->dpastatus = BD_NOFEP;
1394 return -ENXIO;
1395 }
1396 }
1397
1398 /*
1399 * Allocate channel memory that might not have been allocated
1400 * when the driver was first loaded.
1401 */
1402 for (i = 0; i < brd->nasync; i++) {
1403 if (!brd->channels[i]) {
1404 brd->channels[i] =
1405 kzalloc(sizeof(struct channel_t), GFP_ATOMIC);
1406 if (!brd->channels[i])
1407 return -ENOMEM;
1408 }
1409 }
1410
1411 ch = brd->channels[0];
1412 vaddr = brd->re_map_membase;
1413
1414 bs = (struct bs_t *) ((ulong) vaddr + CHANBUF);
1415 cm = (struct cm_t *) ((ulong) vaddr + CMDBUF);
1416
1417 brd->bd_bs = bs;
1418
1419 /* Set up channel variables */
1420 for (i = 0; i < brd->nasync; i++, ch = brd->channels[i], bs++) {
1421
1422 if (!brd->channels[i])
1423 continue;
1424
1425 DGAP_SPINLOCK_INIT(ch->ch_lock);
1426
1427 /* Store all our magic numbers */
1428 ch->magic = DGAP_CHANNEL_MAGIC;
1429 ch->ch_tun.magic = DGAP_UNIT_MAGIC;
1430 ch->ch_tun.un_type = DGAP_SERIAL;
1431 ch->ch_tun.un_ch = ch;
1432 ch->ch_tun.un_dev = i;
1433
1434 ch->ch_pun.magic = DGAP_UNIT_MAGIC;
1435 ch->ch_pun.un_type = DGAP_PRINT;
1436 ch->ch_pun.un_ch = ch;
1437 ch->ch_pun.un_dev = i;
1438
1439 ch->ch_vaddr = vaddr;
1440 ch->ch_bs = bs;
1441 ch->ch_cm = cm;
1442 ch->ch_bd = brd;
1443 ch->ch_portnum = i;
1444 ch->ch_digi = dgap_digi_init;
1445
1446 /*
1447 * Set up digi dsr and dcd bits based on altpin flag.
1448 */
1449 if (dgap_config_get_altpin(brd)) {
1450 ch->ch_dsr = DM_CD;
1451 ch->ch_cd = DM_DSR;
1452 ch->ch_digi.digi_flags |= DIGI_ALTPIN;
1453 } else {
1454 ch->ch_cd = DM_CD;
1455 ch->ch_dsr = DM_DSR;
1456 }
1457
1458 ch->ch_taddr = vaddr + ((ch->ch_bs->tx_seg) << 4);
1459 ch->ch_raddr = vaddr + ((ch->ch_bs->rx_seg) << 4);
1460 ch->ch_tx_win = 0;
1461 ch->ch_rx_win = 0;
1462 ch->ch_tsize = readw(&(ch->ch_bs->tx_max)) + 1;
1463 ch->ch_rsize = readw(&(ch->ch_bs->rx_max)) + 1;
1464 ch->ch_tstart = 0;
1465 ch->ch_rstart = 0;
1466
1467 /* .25 second delay */
1468 ch->ch_close_delay = 250;
1469
1470 /*
1471 * Set queue water marks, interrupt mask,
1472 * and general tty parameters.
1473 */
1474 tlw = ch->ch_tsize >= 2000 ? ((ch->ch_tsize * 5) / 8) :
1475 ch->ch_tsize / 2;
1476 ch->ch_tlw = tlw;
1477
1478 dgap_cmdw(ch, STLOW, tlw, 0);
1479
1480 dgap_cmdw(ch, SRLOW, ch->ch_rsize / 2, 0);
1481
1482 dgap_cmdw(ch, SRHIGH, 7 * ch->ch_rsize / 8, 0);
1483
1484 ch->ch_mistat = readb(&(ch->ch_bs->m_stat));
1485
1486 init_waitqueue_head(&ch->ch_flags_wait);
1487 init_waitqueue_head(&ch->ch_tun.un_flags_wait);
1488 init_waitqueue_head(&ch->ch_pun.un_flags_wait);
1489 init_waitqueue_head(&ch->ch_sniff_wait);
1490
1491 /* Turn on all modem interrupts for now */
1492 modem = (DM_CD | DM_DSR | DM_CTS | DM_RI);
1493 writeb(modem, &(ch->ch_bs->m_int));
1494
1495 /*
1496 * Set edelay to 0 if interrupts are turned on,
1497 * otherwise set edelay to the usual 100.
1498 */
1499 if (brd->intr_used)
1500 writew(0, &(ch->ch_bs->edelay));
1501 else
1502 writew(100, &(ch->ch_bs->edelay));
1503
1504 writeb(1, &(ch->ch_bs->idata));
1505 }
1506
1507 return 0;
1508 }
1509
1510 /*
1511 * dgap_tty_uninit()
1512 *
1513 * Uninitialize the TTY portion of this driver. Free all memory and
1514 * resources.
1515 */
1516 static void dgap_tty_uninit(struct board_t *brd)
1517 {
1518 struct device *dev;
1519 int i = 0;
1520
1521 if (brd->dgap_Major_Serial_Registered) {
1522 dgap_BoardsByMajor[brd->SerialDriver->major] = NULL;
1523 brd->dgap_Serial_Major = 0;
1524 for (i = 0; i < brd->nasync; i++) {
1525 tty_port_destroy(&brd->SerialPorts[i]);
1526 dev = brd->channels[i]->ch_tun.un_sysfs;
1527 dgap_remove_tty_sysfs(dev);
1528 tty_unregister_device(brd->SerialDriver, i);
1529 }
1530 tty_unregister_driver(brd->SerialDriver);
1531 kfree(brd->SerialDriver->ttys);
1532 brd->SerialDriver->ttys = NULL;
1533 put_tty_driver(brd->SerialDriver);
1534 kfree(brd->SerialPorts);
1535 brd->dgap_Major_Serial_Registered = FALSE;
1536 }
1537
1538 if (brd->dgap_Major_TransparentPrint_Registered) {
1539 dgap_BoardsByMajor[brd->PrintDriver->major] = NULL;
1540 brd->dgap_TransparentPrint_Major = 0;
1541 for (i = 0; i < brd->nasync; i++) {
1542 tty_port_destroy(&brd->PrinterPorts[i]);
1543 dev = brd->channels[i]->ch_pun.un_sysfs;
1544 dgap_remove_tty_sysfs(dev);
1545 tty_unregister_device(brd->PrintDriver, i);
1546 }
1547 tty_unregister_driver(brd->PrintDriver);
1548 kfree(brd->PrintDriver->ttys);
1549 brd->PrintDriver->ttys = NULL;
1550 put_tty_driver(brd->PrintDriver);
1551 kfree(brd->PrinterPorts);
1552 brd->dgap_Major_TransparentPrint_Registered = FALSE;
1553 }
1554 }
1555
1556 #define TMPBUFLEN (1024)
1557 /*
1558 * dgap_sniff - Dump data out to the "sniff" buffer if the
1559 * proc sniff file is opened...
1560 */
1561 static void dgap_sniff_nowait_nolock(struct channel_t *ch, uchar *text,
1562 uchar *buf, int len)
1563 {
1564 struct timeval tv;
1565 int n;
1566 int r;
1567 int nbuf;
1568 int i;
1569 int tmpbuflen;
1570 char tmpbuf[TMPBUFLEN];
1571 char *p = tmpbuf;
1572 int too_much_data;
1573
1574 /* Leave if sniff not open */
1575 if (!(ch->ch_sniff_flags & SNIFF_OPEN))
1576 return;
1577
1578 do_gettimeofday(&tv);
1579
1580 /* Create our header for data dump */
1581 p += sprintf(p, "<%ld %ld><%s><", tv.tv_sec, tv.tv_usec, text);
1582 tmpbuflen = p - tmpbuf;
1583
1584 do {
1585 too_much_data = 0;
1586
1587 for (i = 0; i < len && tmpbuflen < (TMPBUFLEN - 4); i++) {
1588 p += sprintf(p, "%02x ", *buf);
1589 buf++;
1590 tmpbuflen = p - tmpbuf;
1591 }
1592
1593 if (tmpbuflen < (TMPBUFLEN - 4)) {
1594 if (i > 0)
1595 p += sprintf(p - 1, "%s\n", ">");
1596 else
1597 p += sprintf(p, "%s\n", ">");
1598 } else {
1599 too_much_data = 1;
1600 len -= i;
1601 }
1602
1603 nbuf = strlen(tmpbuf);
1604 p = tmpbuf;
1605
1606 /*
1607 * Loop while data remains.
1608 */
1609 while (nbuf > 0 && ch->ch_sniff_buf) {
1610 /*
1611 * Determine the amount of available space left in the
1612 * buffer. If there's none, wait until some appears.
1613 */
1614 n = (ch->ch_sniff_out - ch->ch_sniff_in - 1) &
1615 SNIFF_MASK;
1616
1617 /*
1618 * If there is no space left to write to in our sniff
1619 * buffer, we have no choice but to drop the data.
1620 * We *cannot* sleep here waiting for space, because
1621 * this function was probably called by the
1622 * interrupt/timer routines!
1623 */
1624 if (n == 0)
1625 return;
1626
1627 /*
1628 * Copy as much data as will fit.
1629 */
1630
1631 if (n > nbuf)
1632 n = nbuf;
1633
1634 r = SNIFF_MAX - ch->ch_sniff_in;
1635
1636 if (r <= n) {
1637 memcpy(ch->ch_sniff_buf + ch->ch_sniff_in, p, r);
1638
1639 n -= r;
1640 ch->ch_sniff_in = 0;
1641 p += r;
1642 nbuf -= r;
1643 }
1644
1645 memcpy(ch->ch_sniff_buf + ch->ch_sniff_in, p, n);
1646
1647 ch->ch_sniff_in += n;
1648 p += n;
1649 nbuf -= n;
1650
1651 /*
1652 * Wakeup any thread waiting for data
1653 */
1654 if (ch->ch_sniff_flags & SNIFF_WAIT_DATA) {
1655 ch->ch_sniff_flags &= ~SNIFF_WAIT_DATA;
1656 wake_up_interruptible(&ch->ch_sniff_wait);
1657 }
1658 }
1659
1660 /*
1661 * If the user sent us too much data to push into our tmpbuf,
1662 * we need to keep looping around on all the data.
1663 */
1664 if (too_much_data) {
1665 p = tmpbuf;
1666 tmpbuflen = 0;
1667 }
1668
1669 } while (too_much_data);
1670 }
1671
1672 /*=======================================================================
1673 *
1674 * dgap_input - Process received data.
1675 *
1676 * ch - Pointer to channel structure.
1677 *
1678 *=======================================================================*/
1679
1680 static void dgap_input(struct channel_t *ch)
1681 {
1682 struct board_t *bd;
1683 struct bs_t *bs;
1684 struct tty_struct *tp;
1685 struct tty_ldisc *ld;
1686 uint rmask;
1687 uint head;
1688 uint tail;
1689 int data_len;
1690 ulong lock_flags;
1691 ulong lock_flags2;
1692 int flip_len;
1693 int len = 0;
1694 int n = 0;
1695 uchar *buf;
1696 uchar tmpchar;
1697 int s = 0;
1698
1699 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
1700 return;
1701
1702 tp = ch->ch_tun.un_tty;
1703
1704 bs = ch->ch_bs;
1705 if (!bs)
1706 return;
1707
1708 bd = ch->ch_bd;
1709 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
1710 return;
1711
1712 DGAP_LOCK(bd->bd_lock, lock_flags);
1713 DGAP_LOCK(ch->ch_lock, lock_flags2);
1714
1715 /*
1716 * Figure the number of characters in the buffer.
1717 * Exit immediately if none.
1718 */
1719
1720 rmask = ch->ch_rsize - 1;
1721
1722 head = readw(&(bs->rx_head));
1723 head &= rmask;
1724 tail = readw(&(bs->rx_tail));
1725 tail &= rmask;
1726
1727 data_len = (head - tail) & rmask;
1728
1729 if (data_len == 0) {
1730 writeb(1, &(bs->idata));
1731 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
1732 DGAP_UNLOCK(bd->bd_lock, lock_flags);
1733 return;
1734 }
1735
1736 /*
1737 * If the device is not open, or CREAD is off, flush
1738 * input data and return immediately.
1739 */
1740 if ((bd->state != BOARD_READY) || !tp ||
1741 (tp->magic != TTY_MAGIC) ||
1742 !(ch->ch_tun.un_flags & UN_ISOPEN) ||
1743 !(tp->termios.c_cflag & CREAD) ||
1744 (ch->ch_tun.un_flags & UN_CLOSING)) {
1745
1746 writew(head, &(bs->rx_tail));
1747 writeb(1, &(bs->idata));
1748 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
1749 DGAP_UNLOCK(bd->bd_lock, lock_flags);
1750 return;
1751 }
1752
1753 /*
1754 * If we are throttled, simply don't read any data.
1755 */
1756 if (ch->ch_flags & CH_RXBLOCK) {
1757 writeb(1, &(bs->idata));
1758 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
1759 DGAP_UNLOCK(bd->bd_lock, lock_flags);
1760 return;
1761 }
1762
1763 /*
1764 * Ignore oruns.
1765 */
1766 tmpchar = readb(&(bs->orun));
1767 if (tmpchar) {
1768 ch->ch_err_overrun++;
1769 writeb(0, &(bs->orun));
1770 }
1771
1772 /* Decide how much data we can send into the tty layer */
1773 flip_len = TTY_FLIPBUF_SIZE;
1774
1775 /* Chop down the length, if needed */
1776 len = min(data_len, flip_len);
1777 len = min(len, (N_TTY_BUF_SIZE - 1));
1778
1779 ld = tty_ldisc_ref(tp);
1780
1781 #ifdef TTY_DONT_FLIP
1782 /*
1783 * If the DONT_FLIP flag is on, don't flush our buffer, and act
1784 * like the ld doesn't have any space to put the data right now.
1785 */
1786 if (test_bit(TTY_DONT_FLIP, &tp->flags))
1787 len = 0;
1788 #endif
1789
1790 /*
1791 * If we were unable to get a reference to the ld,
1792 * don't flush our buffer, and act like the ld doesn't
1793 * have any space to put the data right now.
1794 */
1795 if (!ld) {
1796 len = 0;
1797 } else {
1798 /*
1799 * If ld doesn't have a pointer to a receive_buf function,
1800 * flush the data, then act like the ld doesn't have any
1801 * space to put the data right now.
1802 */
1803 if (!ld->ops->receive_buf) {
1804 writew(head, &(bs->rx_tail));
1805 len = 0;
1806 }
1807 }
1808
1809 if (len <= 0) {
1810 writeb(1, &(bs->idata));
1811 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
1812 DGAP_UNLOCK(bd->bd_lock, lock_flags);
1813 if (ld)
1814 tty_ldisc_deref(ld);
1815 return;
1816 }
1817
1818 buf = ch->ch_bd->flipbuf;
1819 n = len;
1820
1821 /*
1822 * n now contains the most amount of data we can copy,
1823 * bounded either by our buffer size or the amount
1824 * of data the card actually has pending...
1825 */
1826 while (n) {
1827
1828 s = ((head >= tail) ? head : ch->ch_rsize) - tail;
1829 s = min(s, n);
1830
1831 if (s <= 0)
1832 break;
1833
1834 memcpy_fromio(buf, (char *) ch->ch_raddr + tail, s);
1835 dgap_sniff_nowait_nolock(ch, "USER READ", buf, s);
1836
1837 tail += s;
1838 buf += s;
1839
1840 n -= s;
1841 /* Flip queue if needed */
1842 tail &= rmask;
1843 }
1844
1845 writew(tail, &(bs->rx_tail));
1846 writeb(1, &(bs->idata));
1847 ch->ch_rxcount += len;
1848
1849 /*
1850 * If we are completely raw, we don't need to go through a lot
1851 * of the tty layers that exist.
1852 * In this case, we take the shortest and fastest route we
1853 * can to relay the data to the user.
1854 *
1855 * On the other hand, if we are not raw, we need to go through
1856 * the tty layer, which has its API more well defined.
1857 */
1858 if (I_PARMRK(tp) || I_BRKINT(tp) || I_INPCK(tp)) {
1859 dgap_parity_scan(ch, ch->ch_bd->flipbuf,
1860 ch->ch_bd->flipflagbuf, &len);
1861
1862 len = tty_buffer_request_room(tp->port, len);
1863 tty_insert_flip_string_flags(tp->port, ch->ch_bd->flipbuf,
1864 ch->ch_bd->flipflagbuf, len);
1865 } else {
1866 len = tty_buffer_request_room(tp->port, len);
1867 tty_insert_flip_string(tp->port, ch->ch_bd->flipbuf, len);
1868 }
1869
1870 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
1871 DGAP_UNLOCK(bd->bd_lock, lock_flags);
1872
1873 /* Tell the tty layer its okay to "eat" the data now */
1874 tty_flip_buffer_push(tp->port);
1875
1876 if (ld)
1877 tty_ldisc_deref(ld);
1878
1879 }
1880
1881 /************************************************************************
1882 * Determines when CARRIER changes state and takes appropriate
1883 * action.
1884 ************************************************************************/
1885 static void dgap_carrier(struct channel_t *ch)
1886 {
1887 struct board_t *bd;
1888
1889 int virt_carrier = 0;
1890 int phys_carrier = 0;
1891
1892 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
1893 return;
1894
1895 bd = ch->ch_bd;
1896
1897 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
1898 return;
1899
1900 /* Make sure altpin is always set correctly */
1901 if (ch->ch_digi.digi_flags & DIGI_ALTPIN) {
1902 ch->ch_dsr = DM_CD;
1903 ch->ch_cd = DM_DSR;
1904 } else {
1905 ch->ch_dsr = DM_DSR;
1906 ch->ch_cd = DM_CD;
1907 }
1908
1909 if (ch->ch_mistat & D_CD(ch))
1910 phys_carrier = 1;
1911
1912 if (ch->ch_digi.digi_flags & DIGI_FORCEDCD)
1913 virt_carrier = 1;
1914
1915 if (ch->ch_c_cflag & CLOCAL)
1916 virt_carrier = 1;
1917
1918 /*
1919 * Test for a VIRTUAL carrier transition to HIGH.
1920 */
1921 if (((ch->ch_flags & CH_FCAR) == 0) && (virt_carrier == 1)) {
1922
1923 /*
1924 * When carrier rises, wake any threads waiting
1925 * for carrier in the open routine.
1926 */
1927
1928 if (waitqueue_active(&(ch->ch_flags_wait)))
1929 wake_up_interruptible(&ch->ch_flags_wait);
1930 }
1931
1932 /*
1933 * Test for a PHYSICAL carrier transition to HIGH.
1934 */
1935 if (((ch->ch_flags & CH_CD) == 0) && (phys_carrier == 1)) {
1936
1937 /*
1938 * When carrier rises, wake any threads waiting
1939 * for carrier in the open routine.
1940 */
1941
1942 if (waitqueue_active(&(ch->ch_flags_wait)))
1943 wake_up_interruptible(&ch->ch_flags_wait);
1944 }
1945
1946 /*
1947 * Test for a PHYSICAL transition to low, so long as we aren't
1948 * currently ignoring physical transitions (which is what "virtual
1949 * carrier" indicates).
1950 *
1951 * The transition of the virtual carrier to low really doesn't
1952 * matter... it really only means "ignore carrier state", not
1953 * "make pretend that carrier is there".
1954 */
1955 if ((virt_carrier == 0) &&
1956 ((ch->ch_flags & CH_CD) != 0) &&
1957 (phys_carrier == 0)) {
1958
1959 /*
1960 * When carrier drops:
1961 *
1962 * Drop carrier on all open units.
1963 *
1964 * Flush queues, waking up any task waiting in the
1965 * line discipline.
1966 *
1967 * Send a hangup to the control terminal.
1968 *
1969 * Enable all select calls.
1970 */
1971 if (waitqueue_active(&(ch->ch_flags_wait)))
1972 wake_up_interruptible(&ch->ch_flags_wait);
1973
1974 if (ch->ch_tun.un_open_count > 0)
1975 tty_hangup(ch->ch_tun.un_tty);
1976
1977 if (ch->ch_pun.un_open_count > 0)
1978 tty_hangup(ch->ch_pun.un_tty);
1979 }
1980
1981 /*
1982 * Make sure that our cached values reflect the current reality.
1983 */
1984 if (virt_carrier == 1)
1985 ch->ch_flags |= CH_FCAR;
1986 else
1987 ch->ch_flags &= ~CH_FCAR;
1988
1989 if (phys_carrier == 1)
1990 ch->ch_flags |= CH_CD;
1991 else
1992 ch->ch_flags &= ~CH_CD;
1993 }
1994
1995 /************************************************************************
1996 *
1997 * TTY Entry points and helper functions
1998 *
1999 ************************************************************************/
2000
2001 /*
2002 * dgap_tty_open()
2003 *
2004 */
2005 static int dgap_tty_open(struct tty_struct *tty, struct file *file)
2006 {
2007 struct board_t *brd;
2008 struct channel_t *ch;
2009 struct un_t *un;
2010 struct bs_t *bs;
2011 uint major = 0;
2012 uint minor = 0;
2013 int rc = 0;
2014 ulong lock_flags;
2015 ulong lock_flags2;
2016 u16 head;
2017
2018 rc = 0;
2019
2020 major = MAJOR(tty_devnum(tty));
2021 minor = MINOR(tty_devnum(tty));
2022
2023 if (major > 255)
2024 return -ENXIO;
2025
2026 /* Get board pointer from our array of majors we have allocated */
2027 brd = dgap_BoardsByMajor[major];
2028 if (!brd)
2029 return -ENXIO;
2030
2031 /*
2032 * If board is not yet up to a state of READY, go to
2033 * sleep waiting for it to happen or they cancel the open.
2034 */
2035 rc = wait_event_interruptible(brd->state_wait,
2036 (brd->state & BOARD_READY));
2037
2038 if (rc)
2039 return rc;
2040
2041 DGAP_LOCK(brd->bd_lock, lock_flags);
2042
2043 /* The wait above should guarantee this cannot happen */
2044 if (brd->state != BOARD_READY) {
2045 DGAP_UNLOCK(brd->bd_lock, lock_flags);
2046 return -ENXIO;
2047 }
2048
2049 /* If opened device is greater than our number of ports, bail. */
2050 if (MINOR(tty_devnum(tty)) > brd->nasync) {
2051 DGAP_UNLOCK(brd->bd_lock, lock_flags);
2052 return -ENXIO;
2053 }
2054
2055 ch = brd->channels[minor];
2056 if (!ch) {
2057 DGAP_UNLOCK(brd->bd_lock, lock_flags);
2058 return -ENXIO;
2059 }
2060
2061 /* Grab channel lock */
2062 DGAP_LOCK(ch->ch_lock, lock_flags2);
2063
2064 /* Figure out our type */
2065 if (major == brd->dgap_Serial_Major) {
2066 un = &brd->channels[minor]->ch_tun;
2067 un->un_type = DGAP_SERIAL;
2068 } else if (major == brd->dgap_TransparentPrint_Major) {
2069 un = &brd->channels[minor]->ch_pun;
2070 un->un_type = DGAP_PRINT;
2071 } else {
2072 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
2073 DGAP_UNLOCK(brd->bd_lock, lock_flags);
2074 return -ENXIO;
2075 }
2076
2077 /* Store our unit into driver_data, so we always have it available. */
2078 tty->driver_data = un;
2079
2080 /*
2081 * Error if channel info pointer is NULL.
2082 */
2083 bs = ch->ch_bs;
2084 if (!bs) {
2085 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
2086 DGAP_UNLOCK(brd->bd_lock, lock_flags);
2087 return -ENXIO;
2088 }
2089
2090 /*
2091 * Initialize tty's
2092 */
2093 if (!(un->un_flags & UN_ISOPEN)) {
2094 /* Store important variables. */
2095 un->un_tty = tty;
2096
2097 /* Maybe do something here to the TTY struct as well? */
2098 }
2099
2100 /*
2101 * Initialize if neither terminal or printer is open.
2102 */
2103 if (!((ch->ch_tun.un_flags | ch->ch_pun.un_flags) & UN_ISOPEN)) {
2104
2105 ch->ch_mforce = 0;
2106 ch->ch_mval = 0;
2107
2108 /*
2109 * Flush input queue.
2110 */
2111 head = readw(&(bs->rx_head));
2112 writew(head, &(bs->rx_tail));
2113
2114 ch->ch_flags = 0;
2115 ch->pscan_state = 0;
2116 ch->pscan_savechar = 0;
2117
2118 ch->ch_c_cflag = tty->termios.c_cflag;
2119 ch->ch_c_iflag = tty->termios.c_iflag;
2120 ch->ch_c_oflag = tty->termios.c_oflag;
2121 ch->ch_c_lflag = tty->termios.c_lflag;
2122 ch->ch_startc = tty->termios.c_cc[VSTART];
2123 ch->ch_stopc = tty->termios.c_cc[VSTOP];
2124
2125 /* TODO: flush our TTY struct here? */
2126 }
2127
2128 dgap_carrier(ch);
2129 /*
2130 * Run param in case we changed anything
2131 */
2132 dgap_param(tty);
2133
2134 /*
2135 * follow protocol for opening port
2136 */
2137
2138 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
2139 DGAP_UNLOCK(brd->bd_lock, lock_flags);
2140
2141 rc = dgap_block_til_ready(tty, file, ch);
2142
2143 if (!un->un_tty)
2144 return -ENODEV;
2145
2146 /* No going back now, increment our unit and channel counters */
2147 DGAP_LOCK(ch->ch_lock, lock_flags);
2148 ch->ch_open_count++;
2149 un->un_open_count++;
2150 un->un_flags |= (UN_ISOPEN);
2151 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2152
2153 return rc;
2154 }
2155
2156 /*
2157 * dgap_block_til_ready()
2158 *
2159 * Wait for DCD, if needed.
2160 */
2161 static int dgap_block_til_ready(struct tty_struct *tty, struct file *file,
2162 struct channel_t *ch)
2163 {
2164 int retval = 0;
2165 struct un_t *un = NULL;
2166 ulong lock_flags;
2167 uint old_flags = 0;
2168 int sleep_on_un_flags = 0;
2169
2170 if (!tty || tty->magic != TTY_MAGIC || !file || !ch ||
2171 ch->magic != DGAP_CHANNEL_MAGIC)
2172 return -ENXIO;
2173
2174 un = tty->driver_data;
2175 if (!un || un->magic != DGAP_UNIT_MAGIC)
2176 return -ENXIO;
2177
2178 DGAP_LOCK(ch->ch_lock, lock_flags);
2179
2180 ch->ch_wopen++;
2181
2182 /* Loop forever */
2183 while (1) {
2184
2185 sleep_on_un_flags = 0;
2186
2187 /*
2188 * If board has failed somehow during our sleep,
2189 * bail with error.
2190 */
2191 if (ch->ch_bd->state == BOARD_FAILED) {
2192 retval = -ENXIO;
2193 break;
2194 }
2195
2196 /* If tty was hung up, break out of loop and set error. */
2197 if (tty_hung_up_p(file)) {
2198 retval = -EAGAIN;
2199 break;
2200 }
2201
2202 /*
2203 * If either unit is in the middle of the fragile part of close,
2204 * we just cannot touch the channel safely.
2205 * Go back to sleep, knowing that when the channel can be
2206 * touched safely, the close routine will signal the
2207 * ch_wait_flags to wake us back up.
2208 */
2209 if (!((ch->ch_tun.un_flags | ch->ch_pun.un_flags) &
2210 UN_CLOSING)) {
2211
2212 /*
2213 * Our conditions to leave cleanly and happily:
2214 * 1) NONBLOCKING on the tty is set.
2215 * 2) CLOCAL is set.
2216 * 3) DCD (fake or real) is active.
2217 */
2218
2219 if (file->f_flags & O_NONBLOCK)
2220 break;
2221
2222 if (tty->flags & (1 << TTY_IO_ERROR))
2223 break;
2224
2225 if (ch->ch_flags & CH_CD)
2226 break;
2227
2228 if (ch->ch_flags & CH_FCAR)
2229 break;
2230 } else {
2231 sleep_on_un_flags = 1;
2232 }
2233
2234 /*
2235 * If there is a signal pending, the user probably
2236 * interrupted (ctrl-c) us.
2237 * Leave loop with error set.
2238 */
2239 if (signal_pending(current)) {
2240 retval = -ERESTARTSYS;
2241 break;
2242 }
2243
2244 /*
2245 * Store the flags before we let go of channel lock
2246 */
2247 if (sleep_on_un_flags)
2248 old_flags = ch->ch_tun.un_flags | ch->ch_pun.un_flags;
2249 else
2250 old_flags = ch->ch_flags;
2251
2252 /*
2253 * Let go of channel lock before calling schedule.
2254 * Our poller will get any FEP events and wake us up when DCD
2255 * eventually goes active.
2256 */
2257
2258 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2259
2260 /*
2261 * Wait for something in the flags to change
2262 * from the current value.
2263 */
2264 if (sleep_on_un_flags) {
2265 retval = wait_event_interruptible(un->un_flags_wait,
2266 (old_flags != (ch->ch_tun.un_flags |
2267 ch->ch_pun.un_flags)));
2268 } else {
2269 retval = wait_event_interruptible(ch->ch_flags_wait,
2270 (old_flags != ch->ch_flags));
2271 }
2272
2273 /*
2274 * We got woken up for some reason.
2275 * Before looping around, grab our channel lock.
2276 */
2277 DGAP_LOCK(ch->ch_lock, lock_flags);
2278 }
2279
2280 ch->ch_wopen--;
2281
2282 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2283
2284 if (retval)
2285 return retval;
2286
2287 return 0;
2288 }
2289
2290 /*
2291 * dgap_tty_hangup()
2292 *
2293 * Hangup the port. Like a close, but don't wait for output to drain.
2294 */
2295 static void dgap_tty_hangup(struct tty_struct *tty)
2296 {
2297 struct board_t *bd;
2298 struct channel_t *ch;
2299 struct un_t *un;
2300
2301 if (!tty || tty->magic != TTY_MAGIC)
2302 return;
2303
2304 un = tty->driver_data;
2305 if (!un || un->magic != DGAP_UNIT_MAGIC)
2306 return;
2307
2308 ch = un->un_ch;
2309 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2310 return;
2311
2312 bd = ch->ch_bd;
2313 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
2314 return;
2315
2316 /* flush the transmit queues */
2317 dgap_tty_flush_buffer(tty);
2318
2319 }
2320
2321 /*
2322 * dgap_tty_close()
2323 *
2324 */
2325 static void dgap_tty_close(struct tty_struct *tty, struct file *file)
2326 {
2327 struct ktermios *ts;
2328 struct board_t *bd;
2329 struct channel_t *ch;
2330 struct un_t *un;
2331 ulong lock_flags;
2332 int rc = 0;
2333
2334 if (!tty || tty->magic != TTY_MAGIC)
2335 return;
2336
2337 un = tty->driver_data;
2338 if (!un || un->magic != DGAP_UNIT_MAGIC)
2339 return;
2340
2341 ch = un->un_ch;
2342 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2343 return;
2344
2345 bd = ch->ch_bd;
2346 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
2347 return;
2348
2349 ts = &tty->termios;
2350
2351 DGAP_LOCK(ch->ch_lock, lock_flags);
2352
2353 /*
2354 * Determine if this is the last close or not - and if we agree about
2355 * which type of close it is with the Line Discipline
2356 */
2357 if ((tty->count == 1) && (un->un_open_count != 1)) {
2358 /*
2359 * Uh, oh. tty->count is 1, which means that the tty
2360 * structure will be freed. un_open_count should always
2361 * be one in these conditions. If it's greater than
2362 * one, we've got real problems, since it means the
2363 * serial port won't be shutdown.
2364 */
2365 un->un_open_count = 1;
2366 }
2367
2368 if (--un->un_open_count < 0)
2369 un->un_open_count = 0;
2370
2371 ch->ch_open_count--;
2372
2373 if (ch->ch_open_count && un->un_open_count) {
2374 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2375 return;
2376 }
2377
2378 /* OK, its the last close on the unit */
2379
2380 un->un_flags |= UN_CLOSING;
2381
2382 tty->closing = 1;
2383
2384 /*
2385 * Only officially close channel if count is 0 and
2386 * DIGI_PRINTER bit is not set.
2387 */
2388 if ((ch->ch_open_count == 0) &&
2389 !(ch->ch_digi.digi_flags & DIGI_PRINTER)) {
2390
2391 ch->ch_flags &= ~(CH_RXBLOCK);
2392
2393 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2394
2395 /* wait for output to drain */
2396 /* This will also return if we take an interrupt */
2397
2398 rc = dgap_wait_for_drain(tty);
2399
2400 dgap_tty_flush_buffer(tty);
2401 tty_ldisc_flush(tty);
2402
2403 DGAP_LOCK(ch->ch_lock, lock_flags);
2404
2405 tty->closing = 0;
2406
2407 /*
2408 * If we have HUPCL set, lower DTR and RTS
2409 */
2410 if (ch->ch_c_cflag & HUPCL) {
2411 ch->ch_mostat &= ~(D_RTS(ch)|D_DTR(ch));
2412 dgap_cmdb(ch, SMODEM, 0, D_DTR(ch)|D_RTS(ch), 0);
2413
2414 /*
2415 * Go to sleep to ensure RTS/DTR
2416 * have been dropped for modems to see it.
2417 */
2418 if (ch->ch_close_delay) {
2419 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2420 dgap_ms_sleep(ch->ch_close_delay);
2421 DGAP_LOCK(ch->ch_lock, lock_flags);
2422 }
2423 }
2424
2425 ch->pscan_state = 0;
2426 ch->pscan_savechar = 0;
2427 ch->ch_baud_info = 0;
2428
2429 }
2430
2431 /*
2432 * turn off print device when closing print device.
2433 */
2434 if ((un->un_type == DGAP_PRINT) && (ch->ch_flags & CH_PRON)) {
2435 dgap_wmove(ch, ch->ch_digi.digi_offstr,
2436 (int) ch->ch_digi.digi_offlen);
2437 ch->ch_flags &= ~CH_PRON;
2438 }
2439
2440 un->un_tty = NULL;
2441 un->un_flags &= ~(UN_ISOPEN | UN_CLOSING);
2442 tty->driver_data = NULL;
2443
2444 wake_up_interruptible(&ch->ch_flags_wait);
2445 wake_up_interruptible(&un->un_flags_wait);
2446
2447 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2448 }
2449
2450 /*
2451 * dgap_tty_chars_in_buffer()
2452 *
2453 * Return number of characters that have not been transmitted yet.
2454 *
2455 * This routine is used by the line discipline to determine if there
2456 * is data waiting to be transmitted/drained/flushed or not.
2457 */
2458 static int dgap_tty_chars_in_buffer(struct tty_struct *tty)
2459 {
2460 struct board_t *bd = NULL;
2461 struct channel_t *ch = NULL;
2462 struct un_t *un = NULL;
2463 struct bs_t *bs = NULL;
2464 uchar tbusy;
2465 uint chars = 0;
2466 u16 thead, ttail, tmask, chead, ctail;
2467 ulong lock_flags = 0;
2468 ulong lock_flags2 = 0;
2469
2470 if (tty == NULL)
2471 return 0;
2472
2473 un = tty->driver_data;
2474 if (!un || un->magic != DGAP_UNIT_MAGIC)
2475 return 0;
2476
2477 ch = un->un_ch;
2478 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2479 return 0;
2480
2481 bd = ch->ch_bd;
2482 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
2483 return 0;
2484
2485 bs = ch->ch_bs;
2486 if (!bs)
2487 return 0;
2488
2489 DGAP_LOCK(bd->bd_lock, lock_flags);
2490 DGAP_LOCK(ch->ch_lock, lock_flags2);
2491
2492 tmask = (ch->ch_tsize - 1);
2493
2494 /* Get Transmit queue pointers */
2495 thead = readw(&(bs->tx_head)) & tmask;
2496 ttail = readw(&(bs->tx_tail)) & tmask;
2497
2498 /* Get tbusy flag */
2499 tbusy = readb(&(bs->tbusy));
2500
2501 /* Get Command queue pointers */
2502 chead = readw(&(ch->ch_cm->cm_head));
2503 ctail = readw(&(ch->ch_cm->cm_tail));
2504
2505 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
2506 DGAP_UNLOCK(bd->bd_lock, lock_flags);
2507
2508 /*
2509 * The only way we know for sure if there is no pending
2510 * data left to be transferred, is if:
2511 * 1) Transmit head and tail are equal (empty).
2512 * 2) Command queue head and tail are equal (empty).
2513 * 3) The "TBUSY" flag is 0. (Transmitter not busy).
2514 */
2515
2516 if ((ttail == thead) && (tbusy == 0) && (chead == ctail)) {
2517 chars = 0;
2518 } else {
2519 if (thead >= ttail)
2520 chars = thead - ttail;
2521 else
2522 chars = thead - ttail + ch->ch_tsize;
2523 /*
2524 * Fudge factor here.
2525 * If chars is zero, we know that the command queue had
2526 * something in it or tbusy was set. Because we cannot
2527 * be sure if there is still some data to be transmitted,
2528 * lets lie, and tell ld we have 1 byte left.
2529 */
2530 if (chars == 0) {
2531 /*
2532 * If TBUSY is still set, and our tx buffers are empty,
2533 * force the firmware to send me another wakeup after
2534 * TBUSY has been cleared.
2535 */
2536 if (tbusy != 0) {
2537 DGAP_LOCK(ch->ch_lock, lock_flags);
2538 un->un_flags |= UN_EMPTY;
2539 writeb(1, &(bs->iempty));
2540 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2541 }
2542 chars = 1;
2543 }
2544 }
2545
2546 return chars;
2547 }
2548
2549 static int dgap_wait_for_drain(struct tty_struct *tty)
2550 {
2551 struct channel_t *ch;
2552 struct un_t *un;
2553 struct bs_t *bs;
2554 int ret = -EIO;
2555 uint count = 1;
2556 ulong lock_flags = 0;
2557
2558 if (!tty || tty->magic != TTY_MAGIC)
2559 return ret;
2560
2561 un = tty->driver_data;
2562 if (!un || un->magic != DGAP_UNIT_MAGIC)
2563 return ret;
2564
2565 ch = un->un_ch;
2566 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2567 return ret;
2568
2569 bs = ch->ch_bs;
2570 if (!bs)
2571 return ret;
2572
2573 ret = 0;
2574
2575 /* Loop until data is drained */
2576 while (count != 0) {
2577
2578 count = dgap_tty_chars_in_buffer(tty);
2579
2580 if (count == 0)
2581 break;
2582
2583 /* Set flag waiting for drain */
2584 DGAP_LOCK(ch->ch_lock, lock_flags);
2585 un->un_flags |= UN_EMPTY;
2586 writeb(1, &(bs->iempty));
2587 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2588
2589 /* Go to sleep till we get woken up */
2590 ret = wait_event_interruptible(un->un_flags_wait,
2591 ((un->un_flags & UN_EMPTY) == 0));
2592 /* If ret is non-zero, user ctrl-c'ed us */
2593 if (ret)
2594 break;
2595 }
2596
2597 DGAP_LOCK(ch->ch_lock, lock_flags);
2598 un->un_flags &= ~(UN_EMPTY);
2599 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2600
2601 return ret;
2602 }
2603
2604 /*
2605 * dgap_maxcps_room
2606 *
2607 * Reduces bytes_available to the max number of characters
2608 * that can be sent currently given the maxcps value, and
2609 * returns the new bytes_available. This only affects printer
2610 * output.
2611 */
2612 static int dgap_maxcps_room(struct tty_struct *tty, int bytes_available)
2613 {
2614 struct channel_t *ch = NULL;
2615 struct un_t *un = NULL;
2616
2617 if (tty == NULL)
2618 return bytes_available;
2619
2620 un = tty->driver_data;
2621 if (!un || un->magic != DGAP_UNIT_MAGIC)
2622 return bytes_available;
2623
2624 ch = un->un_ch;
2625 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2626 return bytes_available;
2627
2628 /*
2629 * If its not the Transparent print device, return
2630 * the full data amount.
2631 */
2632 if (un->un_type != DGAP_PRINT)
2633 return bytes_available;
2634
2635 if (ch->ch_digi.digi_maxcps > 0 && ch->ch_digi.digi_bufsize > 0) {
2636 int cps_limit = 0;
2637 unsigned long current_time = jiffies;
2638 unsigned long buffer_time = current_time +
2639 (HZ * ch->ch_digi.digi_bufsize) /
2640 ch->ch_digi.digi_maxcps;
2641
2642 if (ch->ch_cpstime < current_time) {
2643 /* buffer is empty */
2644 ch->ch_cpstime = current_time; /* reset ch_cpstime */
2645 cps_limit = ch->ch_digi.digi_bufsize;
2646 } else if (ch->ch_cpstime < buffer_time) {
2647 /* still room in the buffer */
2648 cps_limit = ((buffer_time - ch->ch_cpstime) *
2649 ch->ch_digi.digi_maxcps) / HZ;
2650 } else {
2651 /* no room in the buffer */
2652 cps_limit = 0;
2653 }
2654
2655 bytes_available = min(cps_limit, bytes_available);
2656 }
2657
2658 return bytes_available;
2659 }
2660
2661 static inline void dgap_set_firmware_event(struct un_t *un, unsigned int event)
2662 {
2663 struct channel_t *ch = NULL;
2664 struct bs_t *bs = NULL;
2665
2666 if (!un || un->magic != DGAP_UNIT_MAGIC)
2667 return;
2668 ch = un->un_ch;
2669 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2670 return;
2671 bs = ch->ch_bs;
2672 if (!bs)
2673 return;
2674
2675 if ((event & UN_LOW) != 0) {
2676 if ((un->un_flags & UN_LOW) == 0) {
2677 un->un_flags |= UN_LOW;
2678 writeb(1, &(bs->ilow));
2679 }
2680 }
2681 if ((event & UN_LOW) != 0) {
2682 if ((un->un_flags & UN_EMPTY) == 0) {
2683 un->un_flags |= UN_EMPTY;
2684 writeb(1, &(bs->iempty));
2685 }
2686 }
2687 }
2688
2689 /*
2690 * dgap_tty_write_room()
2691 *
2692 * Return space available in Tx buffer
2693 */
2694 static int dgap_tty_write_room(struct tty_struct *tty)
2695 {
2696 struct channel_t *ch = NULL;
2697 struct un_t *un = NULL;
2698 struct bs_t *bs = NULL;
2699 u16 head, tail, tmask;
2700 int ret = 0;
2701 ulong lock_flags = 0;
2702
2703 if (!tty)
2704 return 0;
2705
2706 un = tty->driver_data;
2707 if (!un || un->magic != DGAP_UNIT_MAGIC)
2708 return 0;
2709
2710 ch = un->un_ch;
2711 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2712 return 0;
2713
2714 bs = ch->ch_bs;
2715 if (!bs)
2716 return 0;
2717
2718 DGAP_LOCK(ch->ch_lock, lock_flags);
2719
2720 tmask = ch->ch_tsize - 1;
2721 head = readw(&(bs->tx_head)) & tmask;
2722 tail = readw(&(bs->tx_tail)) & tmask;
2723
2724 ret = tail - head - 1;
2725 if (ret < 0)
2726 ret += ch->ch_tsize;
2727
2728 /* Limit printer to maxcps */
2729 ret = dgap_maxcps_room(tty, ret);
2730
2731 /*
2732 * If we are printer device, leave space for
2733 * possibly both the on and off strings.
2734 */
2735 if (un->un_type == DGAP_PRINT) {
2736 if (!(ch->ch_flags & CH_PRON))
2737 ret -= ch->ch_digi.digi_onlen;
2738 ret -= ch->ch_digi.digi_offlen;
2739 } else {
2740 if (ch->ch_flags & CH_PRON)
2741 ret -= ch->ch_digi.digi_offlen;
2742 }
2743
2744 if (ret < 0)
2745 ret = 0;
2746
2747 /*
2748 * Schedule FEP to wake us up if needed.
2749 *
2750 * TODO: This might be overkill...
2751 * Do we really need to schedule callbacks from the FEP
2752 * in every case? Can we get smarter based on ret?
2753 */
2754 dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
2755 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2756
2757 return ret;
2758 }
2759
2760 /*
2761 * dgap_tty_put_char()
2762 *
2763 * Put a character into ch->ch_buf
2764 *
2765 * - used by the line discipline for OPOST processing
2766 */
2767 static int dgap_tty_put_char(struct tty_struct *tty, unsigned char c)
2768 {
2769 /*
2770 * Simply call tty_write.
2771 */
2772 dgap_tty_write(tty, &c, 1);
2773 return 1;
2774 }
2775
2776 /*
2777 * dgap_tty_write()
2778 *
2779 * Take data from the user or kernel and send it out to the FEP.
2780 * In here exists all the Transparent Print magic as well.
2781 */
2782 static int dgap_tty_write(struct tty_struct *tty, const unsigned char *buf,
2783 int count)
2784 {
2785 struct channel_t *ch = NULL;
2786 struct un_t *un = NULL;
2787 struct bs_t *bs = NULL;
2788 char *vaddr = NULL;
2789 u16 head, tail, tmask, remain;
2790 int bufcount = 0, n = 0;
2791 int orig_count = 0;
2792 ulong lock_flags;
2793
2794 if (!tty)
2795 return 0;
2796
2797 un = tty->driver_data;
2798 if (!un || un->magic != DGAP_UNIT_MAGIC)
2799 return 0;
2800
2801 ch = un->un_ch;
2802 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2803 return 0;
2804
2805 bs = ch->ch_bs;
2806 if (!bs)
2807 return 0;
2808
2809 if (!count)
2810 return 0;
2811
2812 /*
2813 * Store original amount of characters passed in.
2814 * This helps to figure out if we should ask the FEP
2815 * to send us an event when it has more space available.
2816 */
2817 orig_count = count;
2818
2819 DGAP_LOCK(ch->ch_lock, lock_flags);
2820
2821 /* Get our space available for the channel from the board */
2822 tmask = ch->ch_tsize - 1;
2823 head = readw(&(bs->tx_head)) & tmask;
2824 tail = readw(&(bs->tx_tail)) & tmask;
2825
2826 bufcount = tail - head - 1;
2827 if (bufcount < 0)
2828 bufcount += ch->ch_tsize;
2829
2830 /*
2831 * Limit printer output to maxcps overall, with bursts allowed
2832 * up to bufsize characters.
2833 */
2834 bufcount = dgap_maxcps_room(tty, bufcount);
2835
2836 /*
2837 * Take minimum of what the user wants to send, and the
2838 * space available in the FEP buffer.
2839 */
2840 count = min(count, bufcount);
2841
2842 /*
2843 * Bail if no space left.
2844 */
2845 if (count <= 0) {
2846 dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
2847 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2848 return 0;
2849 }
2850
2851 /*
2852 * Output the printer ON string, if we are in terminal mode, but
2853 * need to be in printer mode.
2854 */
2855 if ((un->un_type == DGAP_PRINT) && !(ch->ch_flags & CH_PRON)) {
2856 dgap_wmove(ch, ch->ch_digi.digi_onstr,
2857 (int) ch->ch_digi.digi_onlen);
2858 head = readw(&(bs->tx_head)) & tmask;
2859 ch->ch_flags |= CH_PRON;
2860 }
2861
2862 /*
2863 * On the other hand, output the printer OFF string, if we are
2864 * currently in printer mode, but need to output to the terminal.
2865 */
2866 if ((un->un_type != DGAP_PRINT) && (ch->ch_flags & CH_PRON)) {
2867 dgap_wmove(ch, ch->ch_digi.digi_offstr,
2868 (int) ch->ch_digi.digi_offlen);
2869 head = readw(&(bs->tx_head)) & tmask;
2870 ch->ch_flags &= ~CH_PRON;
2871 }
2872
2873 /*
2874 * If there is nothing left to copy, or
2875 * I can't handle any more data, leave.
2876 */
2877 if (count <= 0) {
2878 dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
2879 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2880 return 0;
2881 }
2882
2883 n = count;
2884
2885 /*
2886 * If the write wraps over the top of the circular buffer,
2887 * move the portion up to the wrap point, and reset the
2888 * pointers to the bottom.
2889 */
2890 remain = ch->ch_tstart + ch->ch_tsize - head;
2891
2892 if (n >= remain) {
2893 n -= remain;
2894 vaddr = ch->ch_taddr + head;
2895
2896 memcpy_toio(vaddr, (uchar *) buf, remain);
2897 dgap_sniff_nowait_nolock(ch, "USER WRITE", (uchar *) buf,
2898 remain);
2899
2900 head = ch->ch_tstart;
2901 buf += remain;
2902 }
2903
2904 if (n > 0) {
2905
2906 /*
2907 * Move rest of data.
2908 */
2909 vaddr = ch->ch_taddr + head;
2910 remain = n;
2911
2912 memcpy_toio(vaddr, (uchar *) buf, remain);
2913 dgap_sniff_nowait_nolock(ch, "USER WRITE", (uchar *)buf,
2914 remain);
2915
2916 head += remain;
2917
2918 }
2919
2920 if (count) {
2921 ch->ch_txcount += count;
2922 head &= tmask;
2923 writew(head, &(bs->tx_head));
2924 }
2925
2926 dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
2927
2928 /*
2929 * If this is the print device, and the
2930 * printer is still on, we need to turn it
2931 * off before going idle. If the buffer is
2932 * non-empty, wait until it goes empty.
2933 * Otherwise turn it off right now.
2934 */
2935 if ((un->un_type == DGAP_PRINT) && (ch->ch_flags & CH_PRON)) {
2936 tail = readw(&(bs->tx_tail)) & tmask;
2937
2938 if (tail != head) {
2939 un->un_flags |= UN_EMPTY;
2940 writeb(1, &(bs->iempty));
2941 } else {
2942 dgap_wmove(ch, ch->ch_digi.digi_offstr,
2943 (int) ch->ch_digi.digi_offlen);
2944 head = readw(&(bs->tx_head)) & tmask;
2945 ch->ch_flags &= ~CH_PRON;
2946 }
2947 }
2948
2949 /* Update printer buffer empty time. */
2950 if ((un->un_type == DGAP_PRINT) && (ch->ch_digi.digi_maxcps > 0)
2951 && (ch->ch_digi.digi_bufsize > 0)) {
2952 ch->ch_cpstime += (HZ * count) / ch->ch_digi.digi_maxcps;
2953 }
2954
2955 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2956
2957 return count;
2958 }
2959
2960 /*
2961 * Return modem signals to ld.
2962 */
2963 static int dgap_tty_tiocmget(struct tty_struct *tty)
2964 {
2965 struct channel_t *ch;
2966 struct un_t *un;
2967 int result = -EIO;
2968 uchar mstat = 0;
2969 ulong lock_flags;
2970
2971 if (!tty || tty->magic != TTY_MAGIC)
2972 return result;
2973
2974 un = tty->driver_data;
2975 if (!un || un->magic != DGAP_UNIT_MAGIC)
2976 return result;
2977
2978 ch = un->un_ch;
2979 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
2980 return result;
2981
2982 DGAP_LOCK(ch->ch_lock, lock_flags);
2983
2984 mstat = readb(&(ch->ch_bs->m_stat));
2985 /* Append any outbound signals that might be pending... */
2986 mstat |= ch->ch_mostat;
2987
2988 DGAP_UNLOCK(ch->ch_lock, lock_flags);
2989
2990 result = 0;
2991
2992 if (mstat & D_DTR(ch))
2993 result |= TIOCM_DTR;
2994 if (mstat & D_RTS(ch))
2995 result |= TIOCM_RTS;
2996 if (mstat & D_CTS(ch))
2997 result |= TIOCM_CTS;
2998 if (mstat & D_DSR(ch))
2999 result |= TIOCM_DSR;
3000 if (mstat & D_RI(ch))
3001 result |= TIOCM_RI;
3002 if (mstat & D_CD(ch))
3003 result |= TIOCM_CD;
3004
3005 return result;
3006 }
3007
3008 /*
3009 * dgap_tty_tiocmset()
3010 *
3011 * Set modem signals, called by ld.
3012 */
3013 static int dgap_tty_tiocmset(struct tty_struct *tty,
3014 unsigned int set, unsigned int clear)
3015 {
3016 struct board_t *bd;
3017 struct channel_t *ch;
3018 struct un_t *un;
3019 int ret = -EIO;
3020 ulong lock_flags;
3021 ulong lock_flags2;
3022
3023 if (!tty || tty->magic != TTY_MAGIC)
3024 return ret;
3025
3026 un = tty->driver_data;
3027 if (!un || un->magic != DGAP_UNIT_MAGIC)
3028 return ret;
3029
3030 ch = un->un_ch;
3031 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3032 return ret;
3033
3034 bd = ch->ch_bd;
3035 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3036 return ret;
3037
3038 DGAP_LOCK(bd->bd_lock, lock_flags);
3039 DGAP_LOCK(ch->ch_lock, lock_flags2);
3040
3041 if (set & TIOCM_RTS) {
3042 ch->ch_mforce |= D_RTS(ch);
3043 ch->ch_mval |= D_RTS(ch);
3044 }
3045
3046 if (set & TIOCM_DTR) {
3047 ch->ch_mforce |= D_DTR(ch);
3048 ch->ch_mval |= D_DTR(ch);
3049 }
3050
3051 if (clear & TIOCM_RTS) {
3052 ch->ch_mforce |= D_RTS(ch);
3053 ch->ch_mval &= ~(D_RTS(ch));
3054 }
3055
3056 if (clear & TIOCM_DTR) {
3057 ch->ch_mforce |= D_DTR(ch);
3058 ch->ch_mval &= ~(D_DTR(ch));
3059 }
3060
3061 dgap_param(tty);
3062
3063 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3064 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3065
3066 return 0;
3067 }
3068
3069 /*
3070 * dgap_tty_send_break()
3071 *
3072 * Send a Break, called by ld.
3073 */
3074 static int dgap_tty_send_break(struct tty_struct *tty, int msec)
3075 {
3076 struct board_t *bd;
3077 struct channel_t *ch;
3078 struct un_t *un;
3079 int ret = -EIO;
3080 ulong lock_flags;
3081 ulong lock_flags2;
3082
3083 if (!tty || tty->magic != TTY_MAGIC)
3084 return ret;
3085
3086 un = tty->driver_data;
3087 if (!un || un->magic != DGAP_UNIT_MAGIC)
3088 return ret;
3089
3090 ch = un->un_ch;
3091 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3092 return ret;
3093
3094 bd = ch->ch_bd;
3095 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3096 return ret;
3097
3098 switch (msec) {
3099 case -1:
3100 msec = 0xFFFF;
3101 break;
3102 case 0:
3103 msec = 1;
3104 break;
3105 default:
3106 msec /= 10;
3107 break;
3108 }
3109
3110 DGAP_LOCK(bd->bd_lock, lock_flags);
3111 DGAP_LOCK(ch->ch_lock, lock_flags2);
3112 #if 0
3113 dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
3114 #endif
3115 dgap_cmdw(ch, SBREAK, (u16) msec, 0);
3116
3117 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3118 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3119
3120 return 0;
3121 }
3122
3123 /*
3124 * dgap_tty_wait_until_sent()
3125 *
3126 * wait until data has been transmitted, called by ld.
3127 */
3128 static void dgap_tty_wait_until_sent(struct tty_struct *tty, int timeout)
3129 {
3130 dgap_wait_for_drain(tty);
3131 }
3132
3133 /*
3134 * dgap_send_xchar()
3135 *
3136 * send a high priority character, called by ld.
3137 */
3138 static void dgap_tty_send_xchar(struct tty_struct *tty, char c)
3139 {
3140 struct board_t *bd;
3141 struct channel_t *ch;
3142 struct un_t *un;
3143 ulong lock_flags;
3144 ulong lock_flags2;
3145
3146 if (!tty || tty->magic != TTY_MAGIC)
3147 return;
3148
3149 un = tty->driver_data;
3150 if (!un || un->magic != DGAP_UNIT_MAGIC)
3151 return;
3152
3153 ch = un->un_ch;
3154 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3155 return;
3156
3157 bd = ch->ch_bd;
3158 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3159 return;
3160
3161 DGAP_LOCK(bd->bd_lock, lock_flags);
3162 DGAP_LOCK(ch->ch_lock, lock_flags2);
3163
3164 /*
3165 * This is technically what we should do.
3166 * However, the NIST tests specifically want
3167 * to see each XON or XOFF character that it
3168 * sends, so lets just send each character
3169 * by hand...
3170 */
3171 #if 0
3172 if (c == STOP_CHAR(tty))
3173 dgap_cmdw(ch, RPAUSE, 0, 0);
3174 else if (c == START_CHAR(tty))
3175 dgap_cmdw(ch, RRESUME, 0, 0);
3176 else
3177 dgap_wmove(ch, &c, 1);
3178 #else
3179 dgap_wmove(ch, &c, 1);
3180 #endif
3181
3182 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3183 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3184
3185 return;
3186 }
3187
3188 /*
3189 * Return modem signals to ld.
3190 */
3191 static int dgap_get_modem_info(struct channel_t *ch, unsigned int __user *value)
3192 {
3193 int result = 0;
3194 uchar mstat = 0;
3195 ulong lock_flags;
3196 int rc = 0;
3197
3198 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3199 return -ENXIO;
3200
3201 DGAP_LOCK(ch->ch_lock, lock_flags);
3202
3203 mstat = readb(&(ch->ch_bs->m_stat));
3204 /* Append any outbound signals that might be pending... */
3205 mstat |= ch->ch_mostat;
3206
3207 DGAP_UNLOCK(ch->ch_lock, lock_flags);
3208
3209 result = 0;
3210
3211 if (mstat & D_DTR(ch))
3212 result |= TIOCM_DTR;
3213 if (mstat & D_RTS(ch))
3214 result |= TIOCM_RTS;
3215 if (mstat & D_CTS(ch))
3216 result |= TIOCM_CTS;
3217 if (mstat & D_DSR(ch))
3218 result |= TIOCM_DSR;
3219 if (mstat & D_RI(ch))
3220 result |= TIOCM_RI;
3221 if (mstat & D_CD(ch))
3222 result |= TIOCM_CD;
3223
3224 rc = put_user(result, value);
3225
3226 return rc;
3227 }
3228
3229 /*
3230 * dgap_set_modem_info()
3231 *
3232 * Set modem signals, called by ld.
3233 */
3234 static int dgap_set_modem_info(struct tty_struct *tty, unsigned int command,
3235 unsigned int __user *value)
3236 {
3237 struct board_t *bd;
3238 struct channel_t *ch;
3239 struct un_t *un;
3240 int ret = -ENXIO;
3241 unsigned int arg = 0;
3242 ulong lock_flags;
3243 ulong lock_flags2;
3244
3245 if (!tty || tty->magic != TTY_MAGIC)
3246 return ret;
3247
3248 un = tty->driver_data;
3249 if (!un || un->magic != DGAP_UNIT_MAGIC)
3250 return ret;
3251
3252 ch = un->un_ch;
3253 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3254 return ret;
3255
3256 bd = ch->ch_bd;
3257 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3258 return ret;
3259
3260 ret = get_user(arg, value);
3261 if (ret)
3262 return ret;
3263
3264 switch (command) {
3265 case TIOCMBIS:
3266 if (arg & TIOCM_RTS) {
3267 ch->ch_mforce |= D_RTS(ch);
3268 ch->ch_mval |= D_RTS(ch);
3269 }
3270
3271 if (arg & TIOCM_DTR) {
3272 ch->ch_mforce |= D_DTR(ch);
3273 ch->ch_mval |= D_DTR(ch);
3274 }
3275
3276 break;
3277
3278 case TIOCMBIC:
3279 if (arg & TIOCM_RTS) {
3280 ch->ch_mforce |= D_RTS(ch);
3281 ch->ch_mval &= ~(D_RTS(ch));
3282 }
3283
3284 if (arg & TIOCM_DTR) {
3285 ch->ch_mforce |= D_DTR(ch);
3286 ch->ch_mval &= ~(D_DTR(ch));
3287 }
3288
3289 break;
3290
3291 case TIOCMSET:
3292 ch->ch_mforce = D_DTR(ch)|D_RTS(ch);
3293
3294 if (arg & TIOCM_RTS)
3295 ch->ch_mval |= D_RTS(ch);
3296 else
3297 ch->ch_mval &= ~(D_RTS(ch));
3298
3299 if (arg & TIOCM_DTR)
3300 ch->ch_mval |= (D_DTR(ch));
3301 else
3302 ch->ch_mval &= ~(D_DTR(ch));
3303
3304 break;
3305
3306 default:
3307 return -EINVAL;
3308 }
3309
3310 DGAP_LOCK(bd->bd_lock, lock_flags);
3311 DGAP_LOCK(ch->ch_lock, lock_flags2);
3312
3313 dgap_param(tty);
3314
3315 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3316 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3317
3318 return 0;
3319 }
3320
3321 /*
3322 * dgap_tty_digigeta()
3323 *
3324 * Ioctl to get the information for ditty.
3325 *
3326 *
3327 *
3328 */
3329 static int dgap_tty_digigeta(struct tty_struct *tty,
3330 struct digi_t __user *retinfo)
3331 {
3332 struct channel_t *ch;
3333 struct un_t *un;
3334 struct digi_t tmp;
3335 ulong lock_flags;
3336
3337 if (!retinfo)
3338 return -EFAULT;
3339
3340 if (!tty || tty->magic != TTY_MAGIC)
3341 return -EFAULT;
3342
3343 un = tty->driver_data;
3344 if (!un || un->magic != DGAP_UNIT_MAGIC)
3345 return -EFAULT;
3346
3347 ch = un->un_ch;
3348 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3349 return -EFAULT;
3350
3351 memset(&tmp, 0, sizeof(tmp));
3352
3353 DGAP_LOCK(ch->ch_lock, lock_flags);
3354 memcpy(&tmp, &ch->ch_digi, sizeof(tmp));
3355 DGAP_UNLOCK(ch->ch_lock, lock_flags);
3356
3357 if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
3358 return -EFAULT;
3359
3360 return 0;
3361 }
3362
3363 /*
3364 * dgap_tty_digiseta()
3365 *
3366 * Ioctl to set the information for ditty.
3367 *
3368 *
3369 *
3370 */
3371 static int dgap_tty_digiseta(struct tty_struct *tty,
3372 struct digi_t __user *new_info)
3373 {
3374 struct board_t *bd;
3375 struct channel_t *ch;
3376 struct un_t *un;
3377 struct digi_t new_digi;
3378 ulong lock_flags = 0;
3379 unsigned long lock_flags2;
3380
3381 if (!tty || tty->magic != TTY_MAGIC)
3382 return -EFAULT;
3383
3384 un = tty->driver_data;
3385 if (!un || un->magic != DGAP_UNIT_MAGIC)
3386 return -EFAULT;
3387
3388 ch = un->un_ch;
3389 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3390 return -EFAULT;
3391
3392 bd = ch->ch_bd;
3393 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3394 return -EFAULT;
3395
3396 if (copy_from_user(&new_digi, new_info, sizeof(struct digi_t)))
3397 return -EFAULT;
3398
3399 DGAP_LOCK(bd->bd_lock, lock_flags);
3400 DGAP_LOCK(ch->ch_lock, lock_flags2);
3401
3402 memcpy(&ch->ch_digi, &new_digi, sizeof(struct digi_t));
3403
3404 if (ch->ch_digi.digi_maxcps < 1)
3405 ch->ch_digi.digi_maxcps = 1;
3406
3407 if (ch->ch_digi.digi_maxcps > 10000)
3408 ch->ch_digi.digi_maxcps = 10000;
3409
3410 if (ch->ch_digi.digi_bufsize < 10)
3411 ch->ch_digi.digi_bufsize = 10;
3412
3413 if (ch->ch_digi.digi_maxchar < 1)
3414 ch->ch_digi.digi_maxchar = 1;
3415
3416 if (ch->ch_digi.digi_maxchar > ch->ch_digi.digi_bufsize)
3417 ch->ch_digi.digi_maxchar = ch->ch_digi.digi_bufsize;
3418
3419 if (ch->ch_digi.digi_onlen > DIGI_PLEN)
3420 ch->ch_digi.digi_onlen = DIGI_PLEN;
3421
3422 if (ch->ch_digi.digi_offlen > DIGI_PLEN)
3423 ch->ch_digi.digi_offlen = DIGI_PLEN;
3424
3425 dgap_param(tty);
3426
3427 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3428 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3429
3430 return 0;
3431 }
3432
3433 /*
3434 * dgap_tty_digigetedelay()
3435 *
3436 * Ioctl to get the current edelay setting.
3437 *
3438 *
3439 *
3440 */
3441 static int dgap_tty_digigetedelay(struct tty_struct *tty, int __user *retinfo)
3442 {
3443 struct channel_t *ch;
3444 struct un_t *un;
3445 int tmp;
3446 ulong lock_flags;
3447
3448 if (!retinfo)
3449 return -EFAULT;
3450
3451 if (!tty || tty->magic != TTY_MAGIC)
3452 return -EFAULT;
3453
3454 un = tty->driver_data;
3455 if (!un || un->magic != DGAP_UNIT_MAGIC)
3456 return -EFAULT;
3457
3458 ch = un->un_ch;
3459 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3460 return -EFAULT;
3461
3462 memset(&tmp, 0, sizeof(tmp));
3463
3464 DGAP_LOCK(ch->ch_lock, lock_flags);
3465 tmp = readw(&(ch->ch_bs->edelay));
3466 DGAP_UNLOCK(ch->ch_lock, lock_flags);
3467
3468 if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
3469 return -EFAULT;
3470
3471 return 0;
3472 }
3473
3474 /*
3475 * dgap_tty_digisetedelay()
3476 *
3477 * Ioctl to set the EDELAY setting
3478 *
3479 */
3480 static int dgap_tty_digisetedelay(struct tty_struct *tty, int __user *new_info)
3481 {
3482 struct board_t *bd;
3483 struct channel_t *ch;
3484 struct un_t *un;
3485 int new_digi;
3486 ulong lock_flags;
3487 ulong lock_flags2;
3488
3489 if (!tty || tty->magic != TTY_MAGIC)
3490 return -EFAULT;
3491
3492 un = tty->driver_data;
3493 if (!un || un->magic != DGAP_UNIT_MAGIC)
3494 return -EFAULT;
3495
3496 ch = un->un_ch;
3497 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3498 return -EFAULT;
3499
3500 bd = ch->ch_bd;
3501 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3502 return -EFAULT;
3503
3504 if (copy_from_user(&new_digi, new_info, sizeof(int)))
3505 return -EFAULT;
3506
3507 DGAP_LOCK(bd->bd_lock, lock_flags);
3508 DGAP_LOCK(ch->ch_lock, lock_flags2);
3509
3510 writew((u16) new_digi, &(ch->ch_bs->edelay));
3511
3512 dgap_param(tty);
3513
3514 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3515 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3516
3517 return 0;
3518 }
3519
3520 /*
3521 * dgap_tty_digigetcustombaud()
3522 *
3523 * Ioctl to get the current custom baud rate setting.
3524 */
3525 static int dgap_tty_digigetcustombaud(struct tty_struct *tty,
3526 int __user *retinfo)
3527 {
3528 struct channel_t *ch;
3529 struct un_t *un;
3530 int tmp;
3531 ulong lock_flags;
3532
3533 if (!retinfo)
3534 return -EFAULT;
3535
3536 if (!tty || tty->magic != TTY_MAGIC)
3537 return -EFAULT;
3538
3539 un = tty->driver_data;
3540 if (!un || un->magic != DGAP_UNIT_MAGIC)
3541 return -EFAULT;
3542
3543 ch = un->un_ch;
3544 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3545 return -EFAULT;
3546
3547 memset(&tmp, 0, sizeof(tmp));
3548
3549 DGAP_LOCK(ch->ch_lock, lock_flags);
3550 tmp = dgap_get_custom_baud(ch);
3551 DGAP_UNLOCK(ch->ch_lock, lock_flags);
3552
3553 if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
3554 return -EFAULT;
3555
3556 return 0;
3557 }
3558
3559 /*
3560 * dgap_tty_digisetcustombaud()
3561 *
3562 * Ioctl to set the custom baud rate setting
3563 */
3564 static int dgap_tty_digisetcustombaud(struct tty_struct *tty,
3565 int __user *new_info)
3566 {
3567 struct board_t *bd;
3568 struct channel_t *ch;
3569 struct un_t *un;
3570 uint new_rate;
3571 ulong lock_flags;
3572 ulong lock_flags2;
3573
3574 if (!tty || tty->magic != TTY_MAGIC)
3575 return -EFAULT;
3576
3577 un = tty->driver_data;
3578 if (!un || un->magic != DGAP_UNIT_MAGIC)
3579 return -EFAULT;
3580
3581 ch = un->un_ch;
3582 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3583 return -EFAULT;
3584
3585 bd = ch->ch_bd;
3586 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3587 return -EFAULT;
3588
3589
3590 if (copy_from_user(&new_rate, new_info, sizeof(unsigned int)))
3591 return -EFAULT;
3592
3593 if (bd->bd_flags & BD_FEP5PLUS) {
3594
3595 DGAP_LOCK(bd->bd_lock, lock_flags);
3596 DGAP_LOCK(ch->ch_lock, lock_flags2);
3597
3598 ch->ch_custom_speed = new_rate;
3599
3600 dgap_param(tty);
3601
3602 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3603 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3604 }
3605
3606 return 0;
3607 }
3608
3609 /*
3610 * dgap_set_termios()
3611 */
3612 static void dgap_tty_set_termios(struct tty_struct *tty,
3613 struct ktermios *old_termios)
3614 {
3615 struct board_t *bd;
3616 struct channel_t *ch;
3617 struct un_t *un;
3618 unsigned long lock_flags;
3619 unsigned long lock_flags2;
3620
3621 if (!tty || tty->magic != TTY_MAGIC)
3622 return;
3623
3624 un = tty->driver_data;
3625 if (!un || un->magic != DGAP_UNIT_MAGIC)
3626 return;
3627
3628 ch = un->un_ch;
3629 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3630 return;
3631
3632 bd = ch->ch_bd;
3633 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3634 return;
3635
3636 DGAP_LOCK(bd->bd_lock, lock_flags);
3637 DGAP_LOCK(ch->ch_lock, lock_flags2);
3638
3639 ch->ch_c_cflag = tty->termios.c_cflag;
3640 ch->ch_c_iflag = tty->termios.c_iflag;
3641 ch->ch_c_oflag = tty->termios.c_oflag;
3642 ch->ch_c_lflag = tty->termios.c_lflag;
3643 ch->ch_startc = tty->termios.c_cc[VSTART];
3644 ch->ch_stopc = tty->termios.c_cc[VSTOP];
3645
3646 dgap_carrier(ch);
3647 dgap_param(tty);
3648
3649 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3650 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3651 }
3652
3653 static void dgap_tty_throttle(struct tty_struct *tty)
3654 {
3655 struct board_t *bd;
3656 struct channel_t *ch;
3657 struct un_t *un;
3658 ulong lock_flags;
3659 ulong lock_flags2;
3660
3661 if (!tty || tty->magic != TTY_MAGIC)
3662 return;
3663
3664 un = tty->driver_data;
3665 if (!un || un->magic != DGAP_UNIT_MAGIC)
3666 return;
3667
3668 ch = un->un_ch;
3669 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3670 return;
3671
3672 bd = ch->ch_bd;
3673 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3674 return;
3675
3676 DGAP_LOCK(bd->bd_lock, lock_flags);
3677 DGAP_LOCK(ch->ch_lock, lock_flags2);
3678
3679 ch->ch_flags |= (CH_RXBLOCK);
3680 #if 1
3681 dgap_cmdw(ch, RPAUSE, 0, 0);
3682 #endif
3683
3684 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3685 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3686
3687 }
3688
3689 static void dgap_tty_unthrottle(struct tty_struct *tty)
3690 {
3691 struct board_t *bd;
3692 struct channel_t *ch;
3693 struct un_t *un;
3694 ulong lock_flags;
3695 ulong lock_flags2;
3696
3697 if (!tty || tty->magic != TTY_MAGIC)
3698 return;
3699
3700 un = tty->driver_data;
3701 if (!un || un->magic != DGAP_UNIT_MAGIC)
3702 return;
3703
3704 ch = un->un_ch;
3705 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3706 return;
3707
3708 bd = ch->ch_bd;
3709 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3710 return;
3711
3712 DGAP_LOCK(bd->bd_lock, lock_flags);
3713 DGAP_LOCK(ch->ch_lock, lock_flags2);
3714
3715 ch->ch_flags &= ~(CH_RXBLOCK);
3716
3717 #if 1
3718 dgap_cmdw(ch, RRESUME, 0, 0);
3719 #endif
3720
3721 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3722 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3723 }
3724
3725 static void dgap_tty_start(struct tty_struct *tty)
3726 {
3727 struct board_t *bd;
3728 struct channel_t *ch;
3729 struct un_t *un;
3730 ulong lock_flags;
3731 ulong lock_flags2;
3732
3733 if (!tty || tty->magic != TTY_MAGIC)
3734 return;
3735
3736 un = tty->driver_data;
3737 if (!un || un->magic != DGAP_UNIT_MAGIC)
3738 return;
3739
3740 ch = un->un_ch;
3741 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3742 return;
3743
3744 bd = ch->ch_bd;
3745 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3746 return;
3747
3748 DGAP_LOCK(bd->bd_lock, lock_flags);
3749 DGAP_LOCK(ch->ch_lock, lock_flags2);
3750
3751 dgap_cmdw(ch, RESUMETX, 0, 0);
3752
3753 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3754 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3755
3756 }
3757
3758 static void dgap_tty_stop(struct tty_struct *tty)
3759 {
3760 struct board_t *bd;
3761 struct channel_t *ch;
3762 struct un_t *un;
3763 ulong lock_flags;
3764 ulong lock_flags2;
3765
3766 if (!tty || tty->magic != TTY_MAGIC)
3767 return;
3768
3769 un = tty->driver_data;
3770 if (!un || un->magic != DGAP_UNIT_MAGIC)
3771 return;
3772
3773 ch = un->un_ch;
3774 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3775 return;
3776
3777 bd = ch->ch_bd;
3778 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3779 return;
3780
3781 DGAP_LOCK(bd->bd_lock, lock_flags);
3782 DGAP_LOCK(ch->ch_lock, lock_flags2);
3783
3784 dgap_cmdw(ch, PAUSETX, 0, 0);
3785
3786 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3787 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3788
3789 }
3790
3791 /*
3792 * dgap_tty_flush_chars()
3793 *
3794 * Flush the cook buffer
3795 *
3796 * Note to self, and any other poor souls who venture here:
3797 *
3798 * flush in this case DOES NOT mean dispose of the data.
3799 * instead, it means "stop buffering and send it if you
3800 * haven't already." Just guess how I figured that out... SRW 2-Jun-98
3801 *
3802 * It is also always called in interrupt context - JAR 8-Sept-99
3803 */
3804 static void dgap_tty_flush_chars(struct tty_struct *tty)
3805 {
3806 struct board_t *bd;
3807 struct channel_t *ch;
3808 struct un_t *un;
3809 ulong lock_flags;
3810 ulong lock_flags2;
3811
3812 if (!tty || tty->magic != TTY_MAGIC)
3813 return;
3814
3815 un = tty->driver_data;
3816 if (!un || un->magic != DGAP_UNIT_MAGIC)
3817 return;
3818
3819 ch = un->un_ch;
3820 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3821 return;
3822
3823 bd = ch->ch_bd;
3824 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3825 return;
3826
3827 DGAP_LOCK(bd->bd_lock, lock_flags);
3828 DGAP_LOCK(ch->ch_lock, lock_flags2);
3829
3830 /* TODO: Do something here */
3831
3832 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3833 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3834 }
3835
3836 /*
3837 * dgap_tty_flush_buffer()
3838 *
3839 * Flush Tx buffer (make in == out)
3840 */
3841 static void dgap_tty_flush_buffer(struct tty_struct *tty)
3842 {
3843 struct board_t *bd;
3844 struct channel_t *ch;
3845 struct un_t *un;
3846 ulong lock_flags;
3847 ulong lock_flags2;
3848 u16 head = 0;
3849
3850 if (!tty || tty->magic != TTY_MAGIC)
3851 return;
3852
3853 un = tty->driver_data;
3854 if (!un || un->magic != DGAP_UNIT_MAGIC)
3855 return;
3856
3857 ch = un->un_ch;
3858 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3859 return;
3860
3861 bd = ch->ch_bd;
3862 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3863 return;
3864
3865 DGAP_LOCK(bd->bd_lock, lock_flags);
3866 DGAP_LOCK(ch->ch_lock, lock_flags2);
3867
3868 ch->ch_flags &= ~CH_STOP;
3869 head = readw(&(ch->ch_bs->tx_head));
3870 dgap_cmdw(ch, FLUSHTX, (u16) head, 0);
3871 dgap_cmdw(ch, RESUMETX, 0, 0);
3872 if (ch->ch_tun.un_flags & (UN_LOW|UN_EMPTY)) {
3873 ch->ch_tun.un_flags &= ~(UN_LOW|UN_EMPTY);
3874 wake_up_interruptible(&ch->ch_tun.un_flags_wait);
3875 }
3876 if (ch->ch_pun.un_flags & (UN_LOW|UN_EMPTY)) {
3877 ch->ch_pun.un_flags &= ~(UN_LOW|UN_EMPTY);
3878 wake_up_interruptible(&ch->ch_pun.un_flags_wait);
3879 }
3880
3881 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3882 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3883 if (waitqueue_active(&tty->write_wait))
3884 wake_up_interruptible(&tty->write_wait);
3885 tty_wakeup(tty);
3886 }
3887
3888 /*****************************************************************************
3889 *
3890 * The IOCTL function and all of its helpers
3891 *
3892 *****************************************************************************/
3893
3894 /*
3895 * dgap_tty_ioctl()
3896 *
3897 * The usual assortment of ioctl's
3898 */
3899 static int dgap_tty_ioctl(struct tty_struct *tty, unsigned int cmd,
3900 unsigned long arg)
3901 {
3902 struct board_t *bd;
3903 struct channel_t *ch;
3904 struct un_t *un;
3905 int rc;
3906 u16 head = 0;
3907 ulong lock_flags = 0;
3908 ulong lock_flags2 = 0;
3909 void __user *uarg = (void __user *) arg;
3910
3911 if (!tty || tty->magic != TTY_MAGIC)
3912 return -ENODEV;
3913
3914 un = tty->driver_data;
3915 if (!un || un->magic != DGAP_UNIT_MAGIC)
3916 return -ENODEV;
3917
3918 ch = un->un_ch;
3919 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
3920 return -ENODEV;
3921
3922 bd = ch->ch_bd;
3923 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
3924 return -ENODEV;
3925
3926 DGAP_LOCK(bd->bd_lock, lock_flags);
3927 DGAP_LOCK(ch->ch_lock, lock_flags2);
3928
3929 if (un->un_open_count <= 0) {
3930 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3931 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3932 return -EIO;
3933 }
3934
3935 switch (cmd) {
3936
3937 /* Here are all the standard ioctl's that we MUST implement */
3938
3939 case TCSBRK:
3940 /*
3941 * TCSBRK is SVID version: non-zero arg --> no break
3942 * this behaviour is exploited by tcdrain().
3943 *
3944 * According to POSIX.1 spec (7.2.2.1.2) breaks should be
3945 * between 0.25 and 0.5 seconds so we'll ask for something
3946 * in the middle: 0.375 seconds.
3947 */
3948 rc = tty_check_change(tty);
3949 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3950 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3951 if (rc)
3952 return rc;
3953
3954 rc = dgap_wait_for_drain(tty);
3955
3956 if (rc)
3957 return -EINTR;
3958
3959 DGAP_LOCK(bd->bd_lock, lock_flags);
3960 DGAP_LOCK(ch->ch_lock, lock_flags2);
3961
3962 if (((cmd == TCSBRK) && (!arg)) || (cmd == TCSBRKP))
3963 dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
3964
3965 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3966 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3967
3968 return 0;
3969
3970 case TCSBRKP:
3971 /* support for POSIX tcsendbreak()
3972
3973 * According to POSIX.1 spec (7.2.2.1.2) breaks should be
3974 * between 0.25 and 0.5 seconds so we'll ask for something
3975 * in the middle: 0.375 seconds.
3976 */
3977 rc = tty_check_change(tty);
3978 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3979 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3980 if (rc)
3981 return rc;
3982
3983 rc = dgap_wait_for_drain(tty);
3984 if (rc)
3985 return -EINTR;
3986
3987 DGAP_LOCK(bd->bd_lock, lock_flags);
3988 DGAP_LOCK(ch->ch_lock, lock_flags2);
3989
3990 dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
3991
3992 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
3993 DGAP_UNLOCK(bd->bd_lock, lock_flags);
3994
3995 return 0;
3996
3997 case TIOCSBRK:
3998 /*
3999 * FEP5 doesn't support turning on a break unconditionally.
4000 * The FEP5 device will stop sending a break automatically
4001 * after the specified time value that was sent when turning on
4002 * the break.
4003 */
4004 rc = tty_check_change(tty);
4005 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4006 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4007 if (rc)
4008 return rc;
4009
4010 rc = dgap_wait_for_drain(tty);
4011 if (rc)
4012 return -EINTR;
4013
4014 DGAP_LOCK(bd->bd_lock, lock_flags);
4015 DGAP_LOCK(ch->ch_lock, lock_flags2);
4016
4017 dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
4018
4019 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4020 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4021
4022 return 0;
4023
4024 case TIOCCBRK:
4025 /*
4026 * FEP5 doesn't support turning off a break unconditionally.
4027 * The FEP5 device will stop sending a break automatically
4028 * after the specified time value that was sent when turning on
4029 * the break.
4030 */
4031 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4032 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4033 return 0;
4034
4035 case TIOCGSOFTCAR:
4036
4037 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4038 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4039
4040 rc = put_user(C_CLOCAL(tty) ? 1 : 0,
4041 (unsigned long __user *) arg);
4042 return rc;
4043
4044 case TIOCSSOFTCAR:
4045 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4046 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4047
4048 rc = get_user(arg, (unsigned long __user *) arg);
4049 if (rc)
4050 return rc;
4051
4052 DGAP_LOCK(bd->bd_lock, lock_flags);
4053 DGAP_LOCK(ch->ch_lock, lock_flags2);
4054 tty->termios.c_cflag = ((tty->termios.c_cflag & ~CLOCAL) |
4055 (arg ? CLOCAL : 0));
4056 dgap_param(tty);
4057 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4058 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4059
4060 return 0;
4061
4062 case TIOCMGET:
4063 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4064 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4065 return dgap_get_modem_info(ch, uarg);
4066
4067 case TIOCMBIS:
4068 case TIOCMBIC:
4069 case TIOCMSET:
4070 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4071 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4072 return dgap_set_modem_info(tty, cmd, uarg);
4073
4074 /*
4075 * Here are any additional ioctl's that we want to implement
4076 */
4077
4078 case TCFLSH:
4079 /*
4080 * The linux tty driver doesn't have a flush
4081 * input routine for the driver, assuming all backed
4082 * up data is in the line disc. buffers. However,
4083 * we all know that's not the case. Here, we
4084 * act on the ioctl, but then lie and say we didn't
4085 * so the line discipline will process the flush
4086 * also.
4087 */
4088 rc = tty_check_change(tty);
4089 if (rc) {
4090 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4091 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4092 return rc;
4093 }
4094
4095 if ((arg == TCIFLUSH) || (arg == TCIOFLUSH)) {
4096 if (!(un->un_type == DGAP_PRINT)) {
4097 head = readw(&(ch->ch_bs->rx_head));
4098 writew(head, &(ch->ch_bs->rx_tail));
4099 writeb(0, &(ch->ch_bs->orun));
4100 }
4101 }
4102
4103 if ((arg == TCOFLUSH) || (arg == TCIOFLUSH)) {
4104 ch->ch_flags &= ~CH_STOP;
4105 head = readw(&(ch->ch_bs->tx_head));
4106 dgap_cmdw(ch, FLUSHTX, (u16) head, 0);
4107 dgap_cmdw(ch, RESUMETX, 0, 0);
4108 if (ch->ch_tun.un_flags & (UN_LOW|UN_EMPTY)) {
4109 ch->ch_tun.un_flags &= ~(UN_LOW|UN_EMPTY);
4110 wake_up_interruptible(&ch->ch_tun.un_flags_wait);
4111 }
4112 if (ch->ch_pun.un_flags & (UN_LOW|UN_EMPTY)) {
4113 ch->ch_pun.un_flags &= ~(UN_LOW|UN_EMPTY);
4114 wake_up_interruptible(&ch->ch_pun.un_flags_wait);
4115 }
4116 if (waitqueue_active(&tty->write_wait))
4117 wake_up_interruptible(&tty->write_wait);
4118
4119 /* Can't hold any locks when calling tty_wakeup! */
4120 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4121 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4122 tty_wakeup(tty);
4123 DGAP_LOCK(bd->bd_lock, lock_flags);
4124 DGAP_LOCK(ch->ch_lock, lock_flags2);
4125 }
4126
4127 /* pretend we didn't recognize this IOCTL */
4128 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4129 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4130
4131 return -ENOIOCTLCMD;
4132
4133 case TCSETSF:
4134 case TCSETSW:
4135 /*
4136 * The linux tty driver doesn't have a flush
4137 * input routine for the driver, assuming all backed
4138 * up data is in the line disc. buffers. However,
4139 * we all know that's not the case. Here, we
4140 * act on the ioctl, but then lie and say we didn't
4141 * so the line discipline will process the flush
4142 * also.
4143 */
4144 if (cmd == TCSETSF) {
4145 /* flush rx */
4146 ch->ch_flags &= ~CH_STOP;
4147 head = readw(&(ch->ch_bs->rx_head));
4148 writew(head, &(ch->ch_bs->rx_tail));
4149 }
4150
4151 /* now wait for all the output to drain */
4152 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4153 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4154 rc = dgap_wait_for_drain(tty);
4155 if (rc)
4156 return -EINTR;
4157
4158 /* pretend we didn't recognize this */
4159 return -ENOIOCTLCMD;
4160
4161 case TCSETAW:
4162
4163 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4164 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4165 rc = dgap_wait_for_drain(tty);
4166 if (rc)
4167 return -EINTR;
4168
4169 /* pretend we didn't recognize this */
4170 return -ENOIOCTLCMD;
4171
4172 case TCXONC:
4173 /*
4174 * The Linux Line Discipline (LD) would do this for us if we
4175 * let it, but we have the special firmware options to do this
4176 * the "right way" regardless of hardware or software flow
4177 * control so we'll do it outselves instead of letting the LD
4178 * do it.
4179 */
4180 rc = tty_check_change(tty);
4181 if (rc) {
4182 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4183 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4184 return rc;
4185 }
4186
4187 switch (arg) {
4188
4189 case TCOON:
4190 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4191 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4192 dgap_tty_start(tty);
4193 return 0;
4194 case TCOOFF:
4195 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4196 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4197 dgap_tty_stop(tty);
4198 return 0;
4199 case TCION:
4200 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4201 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4202 /* Make the ld do it */
4203 return -ENOIOCTLCMD;
4204 case TCIOFF:
4205 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4206 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4207 /* Make the ld do it */
4208 return -ENOIOCTLCMD;
4209 default:
4210 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4211 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4212 return -EINVAL;
4213 }
4214
4215 case DIGI_GETA:
4216 /* get information for ditty */
4217 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4218 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4219 return dgap_tty_digigeta(tty, uarg);
4220
4221 case DIGI_SETAW:
4222 case DIGI_SETAF:
4223
4224 /* set information for ditty */
4225 if (cmd == (DIGI_SETAW)) {
4226
4227 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4228 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4229 rc = dgap_wait_for_drain(tty);
4230 if (rc)
4231 return -EINTR;
4232 DGAP_LOCK(bd->bd_lock, lock_flags);
4233 DGAP_LOCK(ch->ch_lock, lock_flags2);
4234 } else
4235 tty_ldisc_flush(tty);
4236 /* fall thru */
4237
4238 case DIGI_SETA:
4239 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4240 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4241 return dgap_tty_digiseta(tty, uarg);
4242
4243 case DIGI_GEDELAY:
4244 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4245 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4246 return dgap_tty_digigetedelay(tty, uarg);
4247
4248 case DIGI_SEDELAY:
4249 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4250 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4251 return dgap_tty_digisetedelay(tty, uarg);
4252
4253 case DIGI_GETCUSTOMBAUD:
4254 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4255 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4256 return dgap_tty_digigetcustombaud(tty, uarg);
4257
4258 case DIGI_SETCUSTOMBAUD:
4259 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4260 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4261 return dgap_tty_digisetcustombaud(tty, uarg);
4262
4263 case DIGI_RESET_PORT:
4264 dgap_firmware_reset_port(ch);
4265 dgap_param(tty);
4266 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4267 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4268 return 0;
4269
4270 default:
4271 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
4272 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4273
4274 return -ENOIOCTLCMD;
4275 }
4276 }
4277
4278 static int dgap_after_config_loaded(int board)
4279 {
4280 /*
4281 * Initialize KME waitqueues...
4282 */
4283 init_waitqueue_head(&(dgap_Board[board]->kme_wait));
4284
4285 /*
4286 * allocate flip buffer for board.
4287 */
4288 dgap_Board[board]->flipbuf = kmalloc(MYFLIPLEN, GFP_ATOMIC);
4289 if (!dgap_Board[board]->flipbuf)
4290 return -ENOMEM;
4291
4292 dgap_Board[board]->flipflagbuf = kmalloc(MYFLIPLEN, GFP_ATOMIC);
4293 if (!dgap_Board[board]->flipflagbuf) {
4294 kfree(dgap_Board[board]->flipbuf);
4295 return -ENOMEM;
4296 }
4297
4298 return 0;
4299 }
4300
4301 /*
4302 * Create pr and tty device entries
4303 */
4304 static int dgap_tty_register_ports(struct board_t *brd)
4305 {
4306 struct channel_t *ch;
4307 int i;
4308
4309 brd->SerialPorts = kcalloc(brd->nasync, sizeof(*brd->SerialPorts),
4310 GFP_KERNEL);
4311 if (brd->SerialPorts == NULL)
4312 return -ENOMEM;
4313 for (i = 0; i < brd->nasync; i++)
4314 tty_port_init(&brd->SerialPorts[i]);
4315
4316 brd->PrinterPorts = kcalloc(brd->nasync, sizeof(*brd->PrinterPorts),
4317 GFP_KERNEL);
4318 if (brd->PrinterPorts == NULL) {
4319 kfree(brd->SerialPorts);
4320 return -ENOMEM;
4321 }
4322 for (i = 0; i < brd->nasync; i++)
4323 tty_port_init(&brd->PrinterPorts[i]);
4324
4325 ch = brd->channels[0];
4326 for (i = 0; i < brd->nasync; i++, ch = brd->channels[i]) {
4327
4328 struct device *classp;
4329
4330 classp = tty_port_register_device(&brd->SerialPorts[i],
4331 brd->SerialDriver,
4332 brd->firstminor + i, NULL);
4333
4334 dgap_create_tty_sysfs(&ch->ch_tun, classp);
4335 ch->ch_tun.un_sysfs = classp;
4336
4337 classp = tty_port_register_device(&brd->PrinterPorts[i],
4338 brd->PrintDriver,
4339 brd->firstminor + i, NULL);
4340
4341 dgap_create_tty_sysfs(&ch->ch_pun, classp);
4342 ch->ch_pun.un_sysfs = classp;
4343 }
4344 dgap_create_ports_sysfiles(brd);
4345
4346 return 0;
4347 }
4348
4349 /*
4350 * Copies the BIOS code from the user to the board,
4351 * and starts the BIOS running.
4352 */
4353 static void dgap_do_bios_load(struct board_t *brd, uchar __user *ubios, int len)
4354 {
4355 uchar *addr;
4356 uint offset;
4357 int i;
4358
4359 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4360 return;
4361
4362 addr = brd->re_map_membase;
4363
4364 /*
4365 * clear POST area
4366 */
4367 for (i = 0; i < 16; i++)
4368 writeb(0, addr + POSTAREA + i);
4369
4370 /*
4371 * Download bios
4372 */
4373 offset = 0x1000;
4374 memcpy_toio(addr + offset, ubios, len);
4375
4376 writel(0x0bf00401, addr);
4377 writel(0, (addr + 4));
4378
4379 /* Clear the reset, and change states. */
4380 writeb(FEPCLR, brd->re_map_port);
4381 }
4382
4383 /*
4384 * Checks to see if the BIOS completed running on the card.
4385 */
4386 static void dgap_do_wait_for_bios(struct board_t *brd)
4387 {
4388 uchar *addr;
4389 u16 word;
4390 u16 err1;
4391 u16 err2;
4392
4393 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4394 return;
4395
4396 addr = brd->re_map_membase;
4397 word = readw(addr + POSTAREA);
4398
4399 /*
4400 * It can take 5-6 seconds for a board to
4401 * pass the bios self test and post results.
4402 * Give it 10 seconds.
4403 */
4404 brd->wait_for_bios = 0;
4405 while (brd->wait_for_bios < 1000) {
4406 /* Check to see if BIOS thinks board is good. (GD). */
4407 if (word == *(u16 *) "GD") {
4408 brd->state = FINISHED_BIOS_LOAD;
4409 return;
4410 }
4411 msleep_interruptible(10);
4412 brd->wait_for_bios++;
4413 word = readw(addr + POSTAREA);
4414 }
4415
4416 /* Gave up on board after too long of time taken */
4417 err1 = readw(addr + SEQUENCE);
4418 err2 = readw(addr + ERROR);
4419 pr_warn("dgap: %s failed diagnostics. Error #(%x,%x).\n",
4420 brd->name, err1, err2);
4421 brd->state = BOARD_FAILED;
4422 brd->dpastatus = BD_NOBIOS;
4423 }
4424
4425 /*
4426 * Copies the FEP code from the user to the board,
4427 * and starts the FEP running.
4428 */
4429 static void dgap_do_fep_load(struct board_t *brd, uchar *ufep, int len)
4430 {
4431 uchar *addr;
4432 uint offset;
4433
4434 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4435 return;
4436
4437 addr = brd->re_map_membase;
4438
4439 /*
4440 * Download FEP
4441 */
4442 offset = 0x1000;
4443 memcpy_toio(addr + offset, ufep, len);
4444
4445 /*
4446 * If board is a concentrator product, we need to give
4447 * it its config string describing how the concentrators look.
4448 */
4449 if ((brd->type == PCX) || (brd->type == PEPC)) {
4450 uchar string[100];
4451 uchar *config, *xconfig;
4452 int i = 0;
4453
4454 xconfig = dgap_create_config_string(brd, string);
4455
4456 /* Write string to board memory */
4457 config = addr + CONFIG;
4458 for (; i < CONFIGSIZE; i++, config++, xconfig++) {
4459 writeb(*xconfig, config);
4460 if ((*xconfig & 0xff) == 0xff)
4461 break;
4462 }
4463 }
4464
4465 writel(0xbfc01004, (addr + 0xc34));
4466 writel(0x3, (addr + 0xc30));
4467
4468 }
4469
4470 /*
4471 * Waits for the FEP to report thats its ready for us to use.
4472 */
4473 static void dgap_do_wait_for_fep(struct board_t *brd)
4474 {
4475 uchar *addr;
4476 u16 word;
4477 u16 err1;
4478 u16 err2;
4479
4480 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4481 return;
4482
4483 addr = brd->re_map_membase;
4484 word = readw(addr + FEPSTAT);
4485
4486 /*
4487 * It can take 2-3 seconds for the FEP to
4488 * be up and running. Give it 5 secs.
4489 */
4490 brd->wait_for_fep = 0;
4491 while (brd->wait_for_fep < 500) {
4492 /* Check to see if FEP is up and running now. */
4493 if (word == *(u16 *) "OS") {
4494 brd->state = FINISHED_FEP_LOAD;
4495 /*
4496 * Check to see if the board can support FEP5+ commands.
4497 */
4498 word = readw(addr + FEP5_PLUS);
4499 if (word == *(u16 *) "5A")
4500 brd->bd_flags |= BD_FEP5PLUS;
4501
4502 return;
4503 }
4504 msleep_interruptible(10);
4505 brd->wait_for_fep++;
4506 word = readw(addr + FEPSTAT);
4507 }
4508
4509 /* Gave up on board after too long of time taken */
4510 err1 = readw(addr + SEQUENCE);
4511 err2 = readw(addr + ERROR);
4512 pr_warn("dgap: FEPOS for %s not functioning. Error #(%x,%x).\n",
4513 brd->name, err1, err2);
4514 brd->state = BOARD_FAILED;
4515 brd->dpastatus = BD_NOFEP;
4516 }
4517
4518 /*
4519 * Physically forces the FEP5 card to reset itself.
4520 */
4521 static void dgap_do_reset_board(struct board_t *brd)
4522 {
4523 uchar check;
4524 u32 check1;
4525 u32 check2;
4526 int i = 0;
4527
4528 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) ||
4529 !brd->re_map_membase || !brd->re_map_port)
4530 return;
4531
4532 /* FEPRST does not vary among supported boards */
4533 writeb(FEPRST, brd->re_map_port);
4534
4535 for (i = 0; i <= 1000; i++) {
4536 check = readb(brd->re_map_port) & 0xe;
4537 if (check == FEPRST)
4538 break;
4539 udelay(10);
4540
4541 }
4542 if (i > 1000) {
4543 pr_warn("dgap: Board not resetting... Failing board.\n");
4544 brd->state = BOARD_FAILED;
4545 brd->dpastatus = BD_NOFEP;
4546 return;
4547 }
4548
4549 /*
4550 * Make sure there really is memory out there.
4551 */
4552 writel(0xa55a3cc3, (brd->re_map_membase + LOWMEM));
4553 writel(0x5aa5c33c, (brd->re_map_membase + HIGHMEM));
4554 check1 = readl(brd->re_map_membase + LOWMEM);
4555 check2 = readl(brd->re_map_membase + HIGHMEM);
4556
4557 if ((check1 != 0xa55a3cc3) || (check2 != 0x5aa5c33c)) {
4558 pr_warn("dgap: No memory at %p for board.\n",
4559 brd->re_map_membase);
4560 brd->state = BOARD_FAILED;
4561 brd->dpastatus = BD_NOFEP;
4562 return;
4563 }
4564
4565 if (brd->state != BOARD_FAILED)
4566 brd->state = FINISHED_RESET;
4567 }
4568
4569 #ifdef DIGI_CONCENTRATORS_SUPPORTED
4570 /*
4571 * Sends a concentrator image into the FEP5 board.
4572 */
4573 static void dgap_do_conc_load(struct board_t *brd, uchar *uaddr, int len)
4574 {
4575 char *vaddr;
4576 u16 offset = 0;
4577 struct downld_t *to_dp;
4578
4579 if (!brd || (brd->magic != DGAP_BOARD_MAGIC) || !brd->re_map_membase)
4580 return;
4581
4582 vaddr = brd->re_map_membase;
4583
4584 offset = readw((u16 *) (vaddr + DOWNREQ));
4585 to_dp = (struct downld_t *) (vaddr + (int) offset);
4586 memcpy_toio(to_dp, uaddr, len);
4587
4588 /* Tell card we have data for it */
4589 writew(0, vaddr + (DOWNREQ));
4590
4591 brd->conc_dl_status = NO_PENDING_CONCENTRATOR_REQUESTS;
4592 }
4593 #endif
4594
4595 #define EXPANSION_ROM_SIZE (64 * 1024)
4596 #define FEP5_ROM_MAGIC (0xFEFFFFFF)
4597
4598 static void dgap_get_vpd(struct board_t *brd)
4599 {
4600 u32 magic;
4601 u32 base_offset;
4602 u16 rom_offset;
4603 u16 vpd_offset;
4604 u16 image_length;
4605 u16 i;
4606 uchar byte1;
4607 uchar byte2;
4608
4609 /*
4610 * Poke the magic number at the PCI Rom Address location.
4611 * If VPD is supported, the value read from that address
4612 * will be non-zero.
4613 */
4614 magic = FEP5_ROM_MAGIC;
4615 pci_write_config_dword(brd->pdev, PCI_ROM_ADDRESS, magic);
4616 pci_read_config_dword(brd->pdev, PCI_ROM_ADDRESS, &magic);
4617
4618 /* VPD not supported, bail */
4619 if (!magic)
4620 return;
4621
4622 /*
4623 * To get to the OTPROM memory, we have to send the boards base
4624 * address or'ed with 1 into the PCI Rom Address location.
4625 */
4626 magic = brd->membase | 0x01;
4627 pci_write_config_dword(brd->pdev, PCI_ROM_ADDRESS, magic);
4628 pci_read_config_dword(brd->pdev, PCI_ROM_ADDRESS, &magic);
4629
4630 byte1 = readb(brd->re_map_membase);
4631 byte2 = readb(brd->re_map_membase + 1);
4632
4633 /*
4634 * If the board correctly swapped to the OTPROM memory,
4635 * the first 2 bytes (header) should be 0x55, 0xAA
4636 */
4637 if (byte1 == 0x55 && byte2 == 0xAA) {
4638
4639 base_offset = 0;
4640
4641 /*
4642 * We have to run through all the OTPROM memory looking
4643 * for the VPD offset.
4644 */
4645 while (base_offset <= EXPANSION_ROM_SIZE) {
4646
4647 /*
4648 * Lots of magic numbers here.
4649 *
4650 * The VPD offset is located inside the ROM Data
4651 * Structure.
4652 *
4653 * We also have to remember the length of each
4654 * ROM Data Structure, so we can "hop" to the next
4655 * entry if the VPD isn't in the current
4656 * ROM Data Structure.
4657 */
4658 rom_offset = readw(brd->re_map_membase +
4659 base_offset + 0x18);
4660 image_length = readw(brd->re_map_membase +
4661 rom_offset + 0x10) * 512;
4662 vpd_offset = readw(brd->re_map_membase +
4663 rom_offset + 0x08);
4664
4665 /* Found the VPD entry */
4666 if (vpd_offset)
4667 break;
4668
4669 /* We didn't find a VPD entry, go to next ROM entry. */
4670 base_offset += image_length;
4671
4672 byte1 = readb(brd->re_map_membase + base_offset);
4673 byte2 = readb(brd->re_map_membase + base_offset + 1);
4674
4675 /*
4676 * If the new ROM offset doesn't have 0x55, 0xAA
4677 * as its header, we have run out of ROM.
4678 */
4679 if (byte1 != 0x55 || byte2 != 0xAA)
4680 break;
4681 }
4682
4683 /*
4684 * If we have a VPD offset, then mark the board
4685 * as having a valid VPD, and copy VPDSIZE (512) bytes of
4686 * that VPD to the buffer we have in our board structure.
4687 */
4688 if (vpd_offset) {
4689 brd->bd_flags |= BD_HAS_VPD;
4690 for (i = 0; i < VPDSIZE; i++) {
4691 brd->vpd[i] = readb(brd->re_map_membase +
4692 vpd_offset + i);
4693 }
4694 }
4695 }
4696
4697 /*
4698 * We MUST poke the magic number at the PCI Rom Address location again.
4699 * This makes the card report the regular board memory back to us,
4700 * rather than the OTPROM memory.
4701 */
4702 magic = FEP5_ROM_MAGIC;
4703 pci_write_config_dword(brd->pdev, PCI_ROM_ADDRESS, magic);
4704 }
4705
4706 /*
4707 * Our board poller function.
4708 */
4709 static void dgap_poll_tasklet(unsigned long data)
4710 {
4711 struct board_t *bd = (struct board_t *) data;
4712 ulong lock_flags;
4713 ulong lock_flags2;
4714 char *vaddr;
4715 u16 head, tail;
4716
4717 if (!bd || (bd->magic != DGAP_BOARD_MAGIC))
4718 return;
4719
4720 if (bd->inhibit_poller)
4721 return;
4722
4723 DGAP_LOCK(bd->bd_lock, lock_flags);
4724
4725 vaddr = bd->re_map_membase;
4726
4727 /*
4728 * If board is ready, parse deeper to see if there is anything to do.
4729 */
4730 if (bd->state == BOARD_READY) {
4731
4732 struct ev_t *eaddr = NULL;
4733
4734 if (!bd->re_map_membase) {
4735 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4736 return;
4737 }
4738 if (!bd->re_map_port) {
4739 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4740 return;
4741 }
4742
4743 if (!bd->nasync)
4744 goto out;
4745
4746 eaddr = (struct ev_t *) (vaddr + EVBUF);
4747
4748 /* Get our head and tail */
4749 head = readw(&(eaddr->ev_head));
4750 tail = readw(&(eaddr->ev_tail));
4751
4752 /*
4753 * If there is an event pending. Go service it.
4754 */
4755 if (head != tail) {
4756 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4757 dgap_event(bd);
4758 DGAP_LOCK(bd->bd_lock, lock_flags);
4759 }
4760
4761 out:
4762 /*
4763 * If board is doing interrupts, ACK the interrupt.
4764 */
4765 if (bd && bd->intr_running)
4766 readb(bd->re_map_port + 2);
4767
4768 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4769 return;
4770 }
4771
4772 /* Our state machine to get the board up and running */
4773
4774 /* Reset board */
4775 if (bd->state == NEED_RESET) {
4776
4777 /* Get VPD info */
4778 dgap_get_vpd(bd);
4779
4780 dgap_do_reset_board(bd);
4781 }
4782
4783 /* Move to next state */
4784 if (bd->state == FINISHED_RESET)
4785 bd->state = NEED_CONFIG;
4786
4787 if (bd->state == NEED_CONFIG) {
4788 /*
4789 * Match this board to a config the user created for us.
4790 */
4791 bd->bd_config = dgap_find_config(bd->type, bd->pci_bus,
4792 bd->pci_slot);
4793
4794 /*
4795 * Because the 4 port Xr products share the same PCI ID
4796 * as the 8 port Xr products, if we receive a NULL config
4797 * back, and this is a PAPORT8 board, retry with a
4798 * PAPORT4 attempt as well.
4799 */
4800 if (bd->type == PAPORT8 && !bd->bd_config)
4801 bd->bd_config = dgap_find_config(PAPORT4, bd->pci_bus,
4802 bd->pci_slot);
4803
4804 /*
4805 * Register the ttys (if any) into the kernel.
4806 */
4807 if (bd->bd_config)
4808 bd->state = FINISHED_CONFIG;
4809 else
4810 bd->state = CONFIG_NOT_FOUND;
4811 }
4812
4813 /* Move to next state */
4814 if (bd->state == FINISHED_CONFIG)
4815 bd->state = NEED_DEVICE_CREATION;
4816
4817 /* Move to next state */
4818 if (bd->state == NEED_DEVICE_CREATION) {
4819 /*
4820 * Signal downloader, its got some work to do.
4821 */
4822 DGAP_LOCK(dgap_dl_lock, lock_flags2);
4823 if (dgap_dl_action != 1) {
4824 dgap_dl_action = 1;
4825 wake_up_interruptible(&dgap_dl_wait);
4826 }
4827 DGAP_UNLOCK(dgap_dl_lock, lock_flags2);
4828 }
4829
4830 /* Move to next state */
4831 if (bd->state == FINISHED_DEVICE_CREATION)
4832 bd->state = NEED_BIOS_LOAD;
4833
4834 /* Move to next state */
4835 if (bd->state == NEED_BIOS_LOAD) {
4836 /*
4837 * Signal downloader, its got some work to do.
4838 */
4839 DGAP_LOCK(dgap_dl_lock, lock_flags2);
4840 if (dgap_dl_action != 1) {
4841 dgap_dl_action = 1;
4842 wake_up_interruptible(&dgap_dl_wait);
4843 }
4844 DGAP_UNLOCK(dgap_dl_lock, lock_flags2);
4845 }
4846
4847 /* Wait for BIOS to test board... */
4848 if (bd->state == WAIT_BIOS_LOAD)
4849 dgap_do_wait_for_bios(bd);
4850
4851 /* Move to next state */
4852 if (bd->state == FINISHED_BIOS_LOAD) {
4853 bd->state = NEED_FEP_LOAD;
4854
4855 /*
4856 * Signal downloader, its got some work to do.
4857 */
4858 DGAP_LOCK(dgap_dl_lock, lock_flags2);
4859 if (dgap_dl_action != 1) {
4860 dgap_dl_action = 1;
4861 wake_up_interruptible(&dgap_dl_wait);
4862 }
4863 DGAP_UNLOCK(dgap_dl_lock, lock_flags2);
4864 }
4865
4866 /* Wait for FEP to load on board... */
4867 if (bd->state == WAIT_FEP_LOAD)
4868 dgap_do_wait_for_fep(bd);
4869
4870 /* Move to next state */
4871 if (bd->state == FINISHED_FEP_LOAD) {
4872
4873 /*
4874 * Do tty device initialization.
4875 */
4876 int rc = dgap_tty_init(bd);
4877
4878 if (rc < 0) {
4879 dgap_tty_uninit(bd);
4880 bd->state = BOARD_FAILED;
4881 bd->dpastatus = BD_NOFEP;
4882 } else {
4883 bd->state = NEED_PROC_CREATION;
4884
4885 /*
4886 * Signal downloader, its got some work to do.
4887 */
4888 DGAP_LOCK(dgap_dl_lock, lock_flags2);
4889 if (dgap_dl_action != 1) {
4890 dgap_dl_action = 1;
4891 wake_up_interruptible(&dgap_dl_wait);
4892 }
4893 DGAP_UNLOCK(dgap_dl_lock, lock_flags2);
4894 }
4895 }
4896
4897 /* Move to next state */
4898 if (bd->state == FINISHED_PROC_CREATION) {
4899
4900 bd->state = BOARD_READY;
4901 bd->dpastatus = BD_RUNNING;
4902
4903 /*
4904 * If user requested the board to run in interrupt mode,
4905 * go and set it up on the board.
4906 */
4907 if (bd->intr_used) {
4908 writew(1, (bd->re_map_membase + ENABLE_INTR));
4909 /*
4910 * Tell the board to poll the UARTS as fast as possible.
4911 */
4912 writew(FEPPOLL_MIN, (bd->re_map_membase + FEPPOLL));
4913 bd->intr_running = 1;
4914 }
4915
4916 /* Wake up anyone waiting for board state to change to ready */
4917 wake_up_interruptible(&bd->state_wait);
4918 }
4919
4920 DGAP_UNLOCK(bd->bd_lock, lock_flags);
4921 }
4922
4923 /*=======================================================================
4924 *
4925 * dgap_cmdb - Sends a 2 byte command to the FEP.
4926 *
4927 * ch - Pointer to channel structure.
4928 * cmd - Command to be sent.
4929 * byte1 - Integer containing first byte to be sent.
4930 * byte2 - Integer containing second byte to be sent.
4931 * ncmds - Wait until ncmds or fewer cmds are left
4932 * in the cmd buffer before returning.
4933 *
4934 *=======================================================================*/
4935 static void dgap_cmdb(struct channel_t *ch, uchar cmd, uchar byte1,
4936 uchar byte2, uint ncmds)
4937 {
4938 char *vaddr = NULL;
4939 struct cm_t *cm_addr = NULL;
4940 uint count;
4941 uint n;
4942 u16 head;
4943 u16 tail;
4944
4945 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
4946 return;
4947
4948 /*
4949 * Check if board is still alive.
4950 */
4951 if (ch->ch_bd->state == BOARD_FAILED)
4952 return;
4953
4954 /*
4955 * Make sure the pointers are in range before
4956 * writing to the FEP memory.
4957 */
4958 vaddr = ch->ch_bd->re_map_membase;
4959
4960 if (!vaddr)
4961 return;
4962
4963 cm_addr = (struct cm_t *) (vaddr + CMDBUF);
4964 head = readw(&(cm_addr->cm_head));
4965
4966 /*
4967 * Forget it if pointers out of range.
4968 */
4969 if (head >= (CMDMAX - CMDSTART) || (head & 03)) {
4970 ch->ch_bd->state = BOARD_FAILED;
4971 return;
4972 }
4973
4974 /*
4975 * Put the data in the circular command buffer.
4976 */
4977 writeb(cmd, (char *) (vaddr + head + CMDSTART + 0));
4978 writeb((uchar) ch->ch_portnum, (char *) (vaddr + head + CMDSTART + 1));
4979 writeb(byte1, (char *) (vaddr + head + CMDSTART + 2));
4980 writeb(byte2, (char *) (vaddr + head + CMDSTART + 3));
4981
4982 head = (head + 4) & (CMDMAX - CMDSTART - 4);
4983
4984 writew(head, &(cm_addr->cm_head));
4985
4986 /*
4987 * Wait if necessary before updating the head
4988 * pointer to limit the number of outstanding
4989 * commands to the FEP. If the time spent waiting
4990 * is outlandish, declare the FEP dead.
4991 */
4992 for (count = dgap_count ;;) {
4993
4994 head = readw(&(cm_addr->cm_head));
4995 tail = readw(&(cm_addr->cm_tail));
4996
4997 n = (head - tail) & (CMDMAX - CMDSTART - 4);
4998
4999 if (n <= ncmds * sizeof(struct cm_t))
5000 break;
5001
5002 if (--count == 0) {
5003 ch->ch_bd->state = BOARD_FAILED;
5004 return;
5005 }
5006 udelay(10);
5007 }
5008 }
5009
5010 /*=======================================================================
5011 *
5012 * dgap_cmdw - Sends a 1 word command to the FEP.
5013 *
5014 * ch - Pointer to channel structure.
5015 * cmd - Command to be sent.
5016 * word - Integer containing word to be sent.
5017 * ncmds - Wait until ncmds or fewer cmds are left
5018 * in the cmd buffer before returning.
5019 *
5020 *=======================================================================*/
5021 static void dgap_cmdw(struct channel_t *ch, uchar cmd, u16 word, uint ncmds)
5022 {
5023 char *vaddr = NULL;
5024 struct cm_t *cm_addr = NULL;
5025 uint count;
5026 uint n;
5027 u16 head;
5028 u16 tail;
5029
5030 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5031 return;
5032
5033 /*
5034 * Check if board is still alive.
5035 */
5036 if (ch->ch_bd->state == BOARD_FAILED)
5037 return;
5038
5039 /*
5040 * Make sure the pointers are in range before
5041 * writing to the FEP memory.
5042 */
5043 vaddr = ch->ch_bd->re_map_membase;
5044 if (!vaddr)
5045 return;
5046
5047 cm_addr = (struct cm_t *) (vaddr + CMDBUF);
5048 head = readw(&(cm_addr->cm_head));
5049
5050 /*
5051 * Forget it if pointers out of range.
5052 */
5053 if (head >= (CMDMAX - CMDSTART) || (head & 03)) {
5054 ch->ch_bd->state = BOARD_FAILED;
5055 return;
5056 }
5057
5058 /*
5059 * Put the data in the circular command buffer.
5060 */
5061 writeb(cmd, (char *) (vaddr + head + CMDSTART + 0));
5062 writeb((uchar) ch->ch_portnum, (char *) (vaddr + head + CMDSTART + 1));
5063 writew((u16) word, (char *) (vaddr + head + CMDSTART + 2));
5064
5065 head = (head + 4) & (CMDMAX - CMDSTART - 4);
5066
5067 writew(head, &(cm_addr->cm_head));
5068
5069 /*
5070 * Wait if necessary before updating the head
5071 * pointer to limit the number of outstanding
5072 * commands to the FEP. If the time spent waiting
5073 * is outlandish, declare the FEP dead.
5074 */
5075 for (count = dgap_count ;;) {
5076
5077 head = readw(&(cm_addr->cm_head));
5078 tail = readw(&(cm_addr->cm_tail));
5079
5080 n = (head - tail) & (CMDMAX - CMDSTART - 4);
5081
5082 if (n <= ncmds * sizeof(struct cm_t))
5083 break;
5084
5085 if (--count == 0) {
5086 ch->ch_bd->state = BOARD_FAILED;
5087 return;
5088 }
5089 udelay(10);
5090 }
5091 }
5092
5093 /*=======================================================================
5094 *
5095 * dgap_cmdw_ext - Sends a extended word command to the FEP.
5096 *
5097 * ch - Pointer to channel structure.
5098 * cmd - Command to be sent.
5099 * word - Integer containing word to be sent.
5100 * ncmds - Wait until ncmds or fewer cmds are left
5101 * in the cmd buffer before returning.
5102 *
5103 *=======================================================================*/
5104 static void dgap_cmdw_ext(struct channel_t *ch, u16 cmd, u16 word, uint ncmds)
5105 {
5106 char *vaddr = NULL;
5107 struct cm_t *cm_addr = NULL;
5108 uint count;
5109 uint n;
5110 u16 head;
5111 u16 tail;
5112
5113 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5114 return;
5115
5116 /*
5117 * Check if board is still alive.
5118 */
5119 if (ch->ch_bd->state == BOARD_FAILED)
5120 return;
5121
5122 /*
5123 * Make sure the pointers are in range before
5124 * writing to the FEP memory.
5125 */
5126 vaddr = ch->ch_bd->re_map_membase;
5127 if (!vaddr)
5128 return;
5129
5130 cm_addr = (struct cm_t *) (vaddr + CMDBUF);
5131 head = readw(&(cm_addr->cm_head));
5132
5133 /*
5134 * Forget it if pointers out of range.
5135 */
5136 if (head >= (CMDMAX - CMDSTART) || (head & 03)) {
5137 ch->ch_bd->state = BOARD_FAILED;
5138 return;
5139 }
5140
5141 /*
5142 * Put the data in the circular command buffer.
5143 */
5144
5145 /* Write an FF to tell the FEP that we want an extended command */
5146 writeb((uchar) 0xff, (char *) (vaddr + head + CMDSTART + 0));
5147
5148 writeb((uchar) ch->ch_portnum, (uchar *) (vaddr + head + CMDSTART + 1));
5149 writew((u16) cmd, (char *) (vaddr + head + CMDSTART + 2));
5150
5151 /*
5152 * If the second part of the command won't fit,
5153 * put it at the beginning of the circular buffer.
5154 */
5155 if (((head + 4) >= ((CMDMAX - CMDSTART)) || (head & 03)))
5156 writew((u16) word, (char *) (vaddr + CMDSTART));
5157 else
5158 writew((u16) word, (char *) (vaddr + head + CMDSTART + 4));
5159
5160 head = (head + 8) & (CMDMAX - CMDSTART - 4);
5161
5162 writew(head, &(cm_addr->cm_head));
5163
5164 /*
5165 * Wait if necessary before updating the head
5166 * pointer to limit the number of outstanding
5167 * commands to the FEP. If the time spent waiting
5168 * is outlandish, declare the FEP dead.
5169 */
5170 for (count = dgap_count ;;) {
5171
5172 head = readw(&(cm_addr->cm_head));
5173 tail = readw(&(cm_addr->cm_tail));
5174
5175 n = (head - tail) & (CMDMAX - CMDSTART - 4);
5176
5177 if (n <= ncmds * sizeof(struct cm_t))
5178 break;
5179
5180 if (--count == 0) {
5181 ch->ch_bd->state = BOARD_FAILED;
5182 return;
5183 }
5184 udelay(10);
5185 }
5186 }
5187
5188 /*=======================================================================
5189 *
5190 * dgap_wmove - Write data to FEP buffer.
5191 *
5192 * ch - Pointer to channel structure.
5193 * buf - Poiter to characters to be moved.
5194 * cnt - Number of characters to move.
5195 *
5196 *=======================================================================*/
5197 static void dgap_wmove(struct channel_t *ch, char *buf, uint cnt)
5198 {
5199 int n;
5200 char *taddr;
5201 struct bs_t *bs;
5202 u16 head;
5203
5204 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5205 return;
5206
5207 /*
5208 * Check parameters.
5209 */
5210 bs = ch->ch_bs;
5211 head = readw(&(bs->tx_head));
5212
5213 /*
5214 * If pointers are out of range, just return.
5215 */
5216 if ((cnt > ch->ch_tsize) ||
5217 (unsigned)(head - ch->ch_tstart) >= ch->ch_tsize)
5218 return;
5219
5220 /*
5221 * If the write wraps over the top of the circular buffer,
5222 * move the portion up to the wrap point, and reset the
5223 * pointers to the bottom.
5224 */
5225 n = ch->ch_tstart + ch->ch_tsize - head;
5226
5227 if (cnt >= n) {
5228 cnt -= n;
5229 taddr = ch->ch_taddr + head;
5230 memcpy_toio(taddr, buf, n);
5231 head = ch->ch_tstart;
5232 buf += n;
5233 }
5234
5235 /*
5236 * Move rest of data.
5237 */
5238 taddr = ch->ch_taddr + head;
5239 n = cnt;
5240 memcpy_toio(taddr, buf, n);
5241 head += cnt;
5242
5243 writew(head, &(bs->tx_head));
5244 }
5245
5246 /*
5247 * Retrives the current custom baud rate from FEP memory,
5248 * and returns it back to the user.
5249 * Returns 0 on error.
5250 */
5251 static uint dgap_get_custom_baud(struct channel_t *ch)
5252 {
5253 uchar *vaddr;
5254 ulong offset = 0;
5255 uint value = 0;
5256
5257 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5258 return 0;
5259
5260 if (!ch->ch_bd || ch->ch_bd->magic != DGAP_BOARD_MAGIC)
5261 return 0;
5262
5263 if (!(ch->ch_bd->bd_flags & BD_FEP5PLUS))
5264 return 0;
5265
5266 vaddr = ch->ch_bd->re_map_membase;
5267
5268 if (!vaddr)
5269 return 0;
5270
5271 /*
5272 * Go get from fep mem, what the fep
5273 * believes the custom baud rate is.
5274 */
5275 offset = ((((*(unsigned short *)(vaddr + ECS_SEG)) << 4) +
5276 (ch->ch_portnum * 0x28) + LINE_SPEED));
5277
5278 value = readw(vaddr + offset);
5279 return value;
5280 }
5281
5282 /*
5283 * Calls the firmware to reset this channel.
5284 */
5285 static void dgap_firmware_reset_port(struct channel_t *ch)
5286 {
5287 dgap_cmdb(ch, CHRESET, 0, 0, 0);
5288
5289 /*
5290 * Now that the channel is reset, we need to make sure
5291 * all the current settings get reapplied to the port
5292 * in the firmware.
5293 *
5294 * So we will set the driver's cache of firmware
5295 * settings all to 0, and then call param.
5296 */
5297 ch->ch_fepiflag = 0;
5298 ch->ch_fepcflag = 0;
5299 ch->ch_fepoflag = 0;
5300 ch->ch_fepstartc = 0;
5301 ch->ch_fepstopc = 0;
5302 ch->ch_fepastartc = 0;
5303 ch->ch_fepastopc = 0;
5304 ch->ch_mostat = 0;
5305 ch->ch_hflow = 0;
5306 }
5307
5308 /*=======================================================================
5309 *
5310 * dgap_param - Set Digi parameters.
5311 *
5312 * struct tty_struct * - TTY for port.
5313 *
5314 *=======================================================================*/
5315 static int dgap_param(struct tty_struct *tty)
5316 {
5317 struct ktermios *ts;
5318 struct board_t *bd;
5319 struct channel_t *ch;
5320 struct bs_t *bs;
5321 struct un_t *un;
5322 u16 head;
5323 u16 cflag;
5324 u16 iflag;
5325 uchar mval;
5326 uchar hflow;
5327
5328 if (!tty || tty->magic != TTY_MAGIC)
5329 return -ENXIO;
5330
5331 un = (struct un_t *) tty->driver_data;
5332 if (!un || un->magic != DGAP_UNIT_MAGIC)
5333 return -ENXIO;
5334
5335 ch = un->un_ch;
5336 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5337 return -ENXIO;
5338
5339 bd = ch->ch_bd;
5340 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
5341 return -ENXIO;
5342
5343 bs = ch->ch_bs;
5344 if (!bs)
5345 return -ENXIO;
5346
5347 ts = &tty->termios;
5348
5349 /*
5350 * If baud rate is zero, flush queues, and set mval to drop DTR.
5351 */
5352 if ((ch->ch_c_cflag & (CBAUD)) == 0) {
5353
5354 /* flush rx */
5355 head = readw(&(ch->ch_bs->rx_head));
5356 writew(head, &(ch->ch_bs->rx_tail));
5357
5358 /* flush tx */
5359 head = readw(&(ch->ch_bs->tx_head));
5360 writew(head, &(ch->ch_bs->tx_tail));
5361
5362 ch->ch_flags |= (CH_BAUD0);
5363
5364 /* Drop RTS and DTR */
5365 ch->ch_mval &= ~(D_RTS(ch)|D_DTR(ch));
5366 mval = D_DTR(ch) | D_RTS(ch);
5367 ch->ch_baud_info = 0;
5368
5369 } else if (ch->ch_custom_speed && (bd->bd_flags & BD_FEP5PLUS)) {
5370 /*
5371 * Tell the fep to do the command
5372 */
5373
5374 dgap_cmdw_ext(ch, 0xff01, ch->ch_custom_speed, 0);
5375
5376 /*
5377 * Now go get from fep mem, what the fep
5378 * believes the custom baud rate is.
5379 */
5380 ch->ch_custom_speed = dgap_get_custom_baud(ch);
5381 ch->ch_baud_info = ch->ch_custom_speed;
5382
5383 /* Handle transition from B0 */
5384 if (ch->ch_flags & CH_BAUD0) {
5385 ch->ch_flags &= ~(CH_BAUD0);
5386 ch->ch_mval |= (D_RTS(ch)|D_DTR(ch));
5387 }
5388 mval = D_DTR(ch) | D_RTS(ch);
5389
5390 } else {
5391 /*
5392 * Set baud rate, character size, and parity.
5393 */
5394
5395
5396 int iindex = 0;
5397 int jindex = 0;
5398 int baud = 0;
5399
5400 ulong bauds[4][16] = {
5401 { /* slowbaud */
5402 0, 50, 75, 110,
5403 134, 150, 200, 300,
5404 600, 1200, 1800, 2400,
5405 4800, 9600, 19200, 38400 },
5406 { /* slowbaud & CBAUDEX */
5407 0, 57600, 115200, 230400,
5408 460800, 150, 200, 921600,
5409 600, 1200, 1800, 2400,
5410 4800, 9600, 19200, 38400 },
5411 { /* fastbaud */
5412 0, 57600, 76800, 115200,
5413 14400, 57600, 230400, 76800,
5414 115200, 230400, 28800, 460800,
5415 921600, 9600, 19200, 38400 },
5416 { /* fastbaud & CBAUDEX */
5417 0, 57600, 115200, 230400,
5418 460800, 150, 200, 921600,
5419 600, 1200, 1800, 2400,
5420 4800, 9600, 19200, 38400 }
5421 };
5422
5423 /*
5424 * Only use the TXPrint baud rate if the
5425 * terminal unit is NOT open
5426 */
5427 if (!(ch->ch_tun.un_flags & UN_ISOPEN) &&
5428 (un->un_type == DGAP_PRINT))
5429 baud = C_BAUD(ch->ch_pun.un_tty) & 0xff;
5430 else
5431 baud = C_BAUD(ch->ch_tun.un_tty) & 0xff;
5432
5433 if (ch->ch_c_cflag & CBAUDEX)
5434 iindex = 1;
5435
5436 if (ch->ch_digi.digi_flags & DIGI_FAST)
5437 iindex += 2;
5438
5439 jindex = baud;
5440
5441 if ((iindex >= 0) && (iindex < 4) &&
5442 (jindex >= 0) && (jindex < 16))
5443 baud = bauds[iindex][jindex];
5444 else
5445 baud = 0;
5446
5447 if (baud == 0)
5448 baud = 9600;
5449
5450 ch->ch_baud_info = baud;
5451
5452 /*
5453 * CBAUD has bit position 0x1000 set these days to
5454 * indicate Linux baud rate remap.
5455 * We use a different bit assignment for high speed.
5456 * Clear this bit out while grabbing the parts of
5457 * "cflag" we want.
5458 */
5459 cflag = ch->ch_c_cflag & ((CBAUD ^ CBAUDEX) | PARODD | PARENB |
5460 CSTOPB | CSIZE);
5461
5462 /*
5463 * HUPCL bit is used by FEP to indicate fast baud
5464 * table is to be used.
5465 */
5466 if ((ch->ch_digi.digi_flags & DIGI_FAST) ||
5467 (ch->ch_c_cflag & CBAUDEX))
5468 cflag |= HUPCL;
5469
5470 if ((ch->ch_c_cflag & CBAUDEX) &&
5471 !(ch->ch_digi.digi_flags & DIGI_FAST)) {
5472 /*
5473 * The below code is trying to guarantee that only
5474 * baud rates 115200, 230400, 460800, 921600 are
5475 * remapped. We use exclusive or because the various
5476 * baud rates share common bit positions and therefore
5477 * can't be tested for easily.
5478 */
5479 tcflag_t tcflag = (ch->ch_c_cflag & CBAUD) | CBAUDEX;
5480 int baudpart = 0;
5481
5482 /*
5483 * Map high speed requests to index
5484 * into FEP's baud table
5485 */
5486 switch (tcflag) {
5487 case B57600:
5488 baudpart = 1;
5489 break;
5490 #ifdef B76800
5491 case B76800:
5492 baudpart = 2;
5493 break;
5494 #endif
5495 case B115200:
5496 baudpart = 3;
5497 break;
5498 case B230400:
5499 baudpart = 9;
5500 break;
5501 case B460800:
5502 baudpart = 11;
5503 break;
5504 #ifdef B921600
5505 case B921600:
5506 baudpart = 12;
5507 break;
5508 #endif
5509 default:
5510 baudpart = 0;
5511 }
5512
5513 if (baudpart)
5514 cflag = (cflag & ~(CBAUD | CBAUDEX)) | baudpart;
5515 }
5516
5517 cflag &= 0xffff;
5518
5519 if (cflag != ch->ch_fepcflag) {
5520 ch->ch_fepcflag = (u16) (cflag & 0xffff);
5521
5522 /*
5523 * Okay to have channel and board
5524 * locks held calling this
5525 */
5526 dgap_cmdw(ch, SCFLAG, (u16) cflag, 0);
5527 }
5528
5529 /* Handle transition from B0 */
5530 if (ch->ch_flags & CH_BAUD0) {
5531 ch->ch_flags &= ~(CH_BAUD0);
5532 ch->ch_mval |= (D_RTS(ch)|D_DTR(ch));
5533 }
5534 mval = D_DTR(ch) | D_RTS(ch);
5535 }
5536
5537 /*
5538 * Get input flags.
5539 */
5540 iflag = ch->ch_c_iflag & (IGNBRK | BRKINT | IGNPAR | PARMRK |
5541 INPCK | ISTRIP | IXON | IXANY | IXOFF);
5542
5543 if ((ch->ch_startc == _POSIX_VDISABLE) ||
5544 (ch->ch_stopc == _POSIX_VDISABLE)) {
5545 iflag &= ~(IXON | IXOFF);
5546 ch->ch_c_iflag &= ~(IXON | IXOFF);
5547 }
5548
5549 /*
5550 * Only the IBM Xr card can switch between
5551 * 232 and 422 modes on the fly
5552 */
5553 if (bd->device == PCI_DEV_XR_IBM_DID) {
5554 if (ch->ch_digi.digi_flags & DIGI_422)
5555 dgap_cmdb(ch, SCOMMODE, MODE_422, 0, 0);
5556 else
5557 dgap_cmdb(ch, SCOMMODE, MODE_232, 0, 0);
5558 }
5559
5560 if (ch->ch_digi.digi_flags & DIGI_ALTPIN)
5561 iflag |= IALTPIN;
5562
5563 if (iflag != ch->ch_fepiflag) {
5564 ch->ch_fepiflag = iflag;
5565
5566 /* Okay to have channel and board locks held calling this */
5567 dgap_cmdw(ch, SIFLAG, (u16) ch->ch_fepiflag, 0);
5568 }
5569
5570 /*
5571 * Select hardware handshaking.
5572 */
5573 hflow = 0;
5574
5575 if (ch->ch_c_cflag & CRTSCTS)
5576 hflow |= (D_RTS(ch) | D_CTS(ch));
5577 if (ch->ch_digi.digi_flags & RTSPACE)
5578 hflow |= D_RTS(ch);
5579 if (ch->ch_digi.digi_flags & DTRPACE)
5580 hflow |= D_DTR(ch);
5581 if (ch->ch_digi.digi_flags & CTSPACE)
5582 hflow |= D_CTS(ch);
5583 if (ch->ch_digi.digi_flags & DSRPACE)
5584 hflow |= D_DSR(ch);
5585 if (ch->ch_digi.digi_flags & DCDPACE)
5586 hflow |= D_CD(ch);
5587
5588 if (hflow != ch->ch_hflow) {
5589 ch->ch_hflow = hflow;
5590
5591 /* Okay to have channel and board locks held calling this */
5592 dgap_cmdb(ch, SHFLOW, (uchar) hflow, 0xff, 0);
5593 }
5594
5595
5596 /*
5597 * Set RTS and/or DTR Toggle if needed,
5598 * but only if product is FEP5+ based.
5599 */
5600 if (bd->bd_flags & BD_FEP5PLUS) {
5601 u16 hflow2 = 0;
5602 if (ch->ch_digi.digi_flags & DIGI_RTS_TOGGLE)
5603 hflow2 |= (D_RTS(ch));
5604 if (ch->ch_digi.digi_flags & DIGI_DTR_TOGGLE)
5605 hflow2 |= (D_DTR(ch));
5606
5607 dgap_cmdw_ext(ch, 0xff03, hflow2, 0);
5608 }
5609
5610 /*
5611 * Set modem control lines.
5612 */
5613
5614 mval ^= ch->ch_mforce & (mval ^ ch->ch_mval);
5615
5616 if (ch->ch_mostat ^ mval) {
5617 ch->ch_mostat = mval;
5618
5619 /* Okay to have channel and board locks held calling this */
5620 dgap_cmdb(ch, SMODEM, (uchar) mval, D_RTS(ch)|D_DTR(ch), 0);
5621 }
5622
5623 /*
5624 * Read modem signals, and then call carrier function.
5625 */
5626 ch->ch_mistat = readb(&(bs->m_stat));
5627 dgap_carrier(ch);
5628
5629 /*
5630 * Set the start and stop characters.
5631 */
5632 if (ch->ch_startc != ch->ch_fepstartc ||
5633 ch->ch_stopc != ch->ch_fepstopc) {
5634 ch->ch_fepstartc = ch->ch_startc;
5635 ch->ch_fepstopc = ch->ch_stopc;
5636
5637 /* Okay to have channel and board locks held calling this */
5638 dgap_cmdb(ch, SFLOWC, ch->ch_fepstartc, ch->ch_fepstopc, 0);
5639 }
5640
5641 /*
5642 * Set the Auxiliary start and stop characters.
5643 */
5644 if (ch->ch_astartc != ch->ch_fepastartc ||
5645 ch->ch_astopc != ch->ch_fepastopc) {
5646 ch->ch_fepastartc = ch->ch_astartc;
5647 ch->ch_fepastopc = ch->ch_astopc;
5648
5649 /* Okay to have channel and board locks held calling this */
5650 dgap_cmdb(ch, SAFLOWC, ch->ch_fepastartc, ch->ch_fepastopc, 0);
5651 }
5652
5653 return 0;
5654 }
5655
5656 /*
5657 * dgap_parity_scan()
5658 *
5659 * Convert the FEP5 way of reporting parity errors and breaks into
5660 * the Linux line discipline way.
5661 */
5662 static void dgap_parity_scan(struct channel_t *ch, unsigned char *cbuf,
5663 unsigned char *fbuf, int *len)
5664 {
5665 int l = *len;
5666 int count = 0;
5667 unsigned char *in, *cout, *fout;
5668 unsigned char c;
5669
5670 in = cbuf;
5671 cout = cbuf;
5672 fout = fbuf;
5673
5674 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5675 return;
5676
5677 while (l--) {
5678 c = *in++;
5679 switch (ch->pscan_state) {
5680 default:
5681 /* reset to sanity and fall through */
5682 ch->pscan_state = 0;
5683
5684 case 0:
5685 /* No FF seen yet */
5686 if (c == (unsigned char) '\377')
5687 /* delete this character from stream */
5688 ch->pscan_state = 1;
5689 else {
5690 *cout++ = c;
5691 *fout++ = TTY_NORMAL;
5692 count += 1;
5693 }
5694 break;
5695
5696 case 1:
5697 /* first FF seen */
5698 if (c == (unsigned char) '\377') {
5699 /* doubled ff, transform to single ff */
5700 *cout++ = c;
5701 *fout++ = TTY_NORMAL;
5702 count += 1;
5703 ch->pscan_state = 0;
5704 } else {
5705 /* save value examination in next state */
5706 ch->pscan_savechar = c;
5707 ch->pscan_state = 2;
5708 }
5709 break;
5710
5711 case 2:
5712 /* third character of ff sequence */
5713
5714 *cout++ = c;
5715
5716 if (ch->pscan_savechar == 0x0) {
5717
5718 if (c == 0x0) {
5719 ch->ch_err_break++;
5720 *fout++ = TTY_BREAK;
5721 } else {
5722 ch->ch_err_parity++;
5723 *fout++ = TTY_PARITY;
5724 }
5725 }
5726
5727 count += 1;
5728 ch->pscan_state = 0;
5729 }
5730 }
5731 *len = count;
5732 }
5733
5734 /*=======================================================================
5735 *
5736 * dgap_event - FEP to host event processing routine.
5737 *
5738 * bd - Board of current event.
5739 *
5740 *=======================================================================*/
5741 static int dgap_event(struct board_t *bd)
5742 {
5743 struct channel_t *ch;
5744 ulong lock_flags;
5745 ulong lock_flags2;
5746 struct bs_t *bs;
5747 uchar *event;
5748 uchar *vaddr = NULL;
5749 struct ev_t *eaddr = NULL;
5750 uint head;
5751 uint tail;
5752 int port;
5753 int reason;
5754 int modem;
5755 int b1;
5756
5757 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
5758 return -ENXIO;
5759
5760 DGAP_LOCK(bd->bd_lock, lock_flags);
5761
5762 vaddr = bd->re_map_membase;
5763
5764 if (!vaddr) {
5765 DGAP_UNLOCK(bd->bd_lock, lock_flags);
5766 return -ENXIO;
5767 }
5768
5769 eaddr = (struct ev_t *) (vaddr + EVBUF);
5770
5771 /* Get our head and tail */
5772 head = readw(&(eaddr->ev_head));
5773 tail = readw(&(eaddr->ev_tail));
5774
5775 /*
5776 * Forget it if pointers out of range.
5777 */
5778
5779 if (head >= EVMAX - EVSTART || tail >= EVMAX - EVSTART ||
5780 (head | tail) & 03) {
5781 /* Let go of board lock */
5782 DGAP_UNLOCK(bd->bd_lock, lock_flags);
5783 return -ENXIO;
5784 }
5785
5786 /*
5787 * Loop to process all the events in the buffer.
5788 */
5789 while (tail != head) {
5790
5791 /*
5792 * Get interrupt information.
5793 */
5794
5795 event = bd->re_map_membase + tail + EVSTART;
5796
5797 port = event[0];
5798 reason = event[1];
5799 modem = event[2];
5800 b1 = event[3];
5801
5802 /*
5803 * Make sure the interrupt is valid.
5804 */
5805 if (port >= bd->nasync)
5806 goto next;
5807
5808 if (!(reason & (IFMODEM | IFBREAK | IFTLW | IFTEM | IFDATA)))
5809 goto next;
5810
5811 ch = bd->channels[port];
5812
5813 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
5814 goto next;
5815
5816 /*
5817 * If we have made it here, the event was valid.
5818 * Lock down the channel.
5819 */
5820 DGAP_LOCK(ch->ch_lock, lock_flags2);
5821
5822 bs = ch->ch_bs;
5823
5824 if (!bs) {
5825 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
5826 goto next;
5827 }
5828
5829 /*
5830 * Process received data.
5831 */
5832 if (reason & IFDATA) {
5833
5834 /*
5835 * ALL LOCKS *MUST* BE DROPPED BEFORE CALLING INPUT!
5836 * input could send some data to ld, which in turn
5837 * could do a callback to one of our other functions.
5838 */
5839 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
5840 DGAP_UNLOCK(bd->bd_lock, lock_flags);
5841
5842 dgap_input(ch);
5843
5844 DGAP_LOCK(bd->bd_lock, lock_flags);
5845 DGAP_LOCK(ch->ch_lock, lock_flags2);
5846
5847 if (ch->ch_flags & CH_RACTIVE)
5848 ch->ch_flags |= CH_RENABLE;
5849 else
5850 writeb(1, &(bs->idata));
5851
5852 if (ch->ch_flags & CH_RWAIT) {
5853 ch->ch_flags &= ~CH_RWAIT;
5854
5855 wake_up_interruptible(&ch->ch_tun.un_flags_wait);
5856 }
5857 }
5858
5859 /*
5860 * Process Modem change signals.
5861 */
5862 if (reason & IFMODEM) {
5863 ch->ch_mistat = modem;
5864 dgap_carrier(ch);
5865 }
5866
5867 /*
5868 * Process break.
5869 */
5870 if (reason & IFBREAK) {
5871
5872 if (ch->ch_tun.un_tty) {
5873 /* A break has been indicated */
5874 ch->ch_err_break++;
5875 tty_buffer_request_room(ch->ch_tun.un_tty->port, 1);
5876 tty_insert_flip_char(ch->ch_tun.un_tty->port, 0, TTY_BREAK);
5877 tty_flip_buffer_push(ch->ch_tun.un_tty->port);
5878 }
5879 }
5880
5881 /*
5882 * Process Transmit low.
5883 */
5884 if (reason & IFTLW) {
5885
5886 if (ch->ch_tun.un_flags & UN_LOW) {
5887 ch->ch_tun.un_flags &= ~UN_LOW;
5888
5889 if (ch->ch_tun.un_flags & UN_ISOPEN) {
5890 if ((ch->ch_tun.un_tty->flags &
5891 (1 << TTY_DO_WRITE_WAKEUP)) &&
5892 ch->ch_tun.un_tty->ldisc->ops->write_wakeup) {
5893 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
5894 DGAP_UNLOCK(bd->bd_lock, lock_flags);
5895 (ch->ch_tun.un_tty->ldisc->ops->write_wakeup)(ch->ch_tun.un_tty);
5896 DGAP_LOCK(bd->bd_lock, lock_flags);
5897 DGAP_LOCK(ch->ch_lock, lock_flags2);
5898 }
5899 wake_up_interruptible(&ch->ch_tun.un_tty->write_wait);
5900 wake_up_interruptible(&ch->ch_tun.un_flags_wait);
5901 }
5902 }
5903
5904 if (ch->ch_pun.un_flags & UN_LOW) {
5905 ch->ch_pun.un_flags &= ~UN_LOW;
5906 if (ch->ch_pun.un_flags & UN_ISOPEN) {
5907 if ((ch->ch_pun.un_tty->flags &
5908 (1 << TTY_DO_WRITE_WAKEUP)) &&
5909 ch->ch_pun.un_tty->ldisc->ops->write_wakeup) {
5910 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
5911 DGAP_UNLOCK(bd->bd_lock, lock_flags);
5912 (ch->ch_pun.un_tty->ldisc->ops->write_wakeup)(ch->ch_pun.un_tty);
5913 DGAP_LOCK(bd->bd_lock, lock_flags);
5914 DGAP_LOCK(ch->ch_lock, lock_flags2);
5915 }
5916 wake_up_interruptible(&ch->ch_pun.un_tty->write_wait);
5917 wake_up_interruptible(&ch->ch_pun.un_flags_wait);
5918 }
5919 }
5920
5921 if (ch->ch_flags & CH_WLOW) {
5922 ch->ch_flags &= ~CH_WLOW;
5923 wake_up_interruptible(&ch->ch_flags_wait);
5924 }
5925 }
5926
5927 /*
5928 * Process Transmit empty.
5929 */
5930 if (reason & IFTEM) {
5931 if (ch->ch_tun.un_flags & UN_EMPTY) {
5932 ch->ch_tun.un_flags &= ~UN_EMPTY;
5933 if (ch->ch_tun.un_flags & UN_ISOPEN) {
5934 if ((ch->ch_tun.un_tty->flags &
5935 (1 << TTY_DO_WRITE_WAKEUP)) &&
5936 ch->ch_tun.un_tty->ldisc->ops->write_wakeup) {
5937 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
5938 DGAP_UNLOCK(bd->bd_lock, lock_flags);
5939
5940 (ch->ch_tun.un_tty->ldisc->ops->write_wakeup)(ch->ch_tun.un_tty);
5941 DGAP_LOCK(bd->bd_lock, lock_flags);
5942 DGAP_LOCK(ch->ch_lock, lock_flags2);
5943 }
5944 wake_up_interruptible(&ch->ch_tun.un_tty->write_wait);
5945 wake_up_interruptible(&ch->ch_tun.un_flags_wait);
5946 }
5947 }
5948
5949 if (ch->ch_pun.un_flags & UN_EMPTY) {
5950 ch->ch_pun.un_flags &= ~UN_EMPTY;
5951 if (ch->ch_pun.un_flags & UN_ISOPEN) {
5952 if ((ch->ch_pun.un_tty->flags &
5953 (1 << TTY_DO_WRITE_WAKEUP)) &&
5954 ch->ch_pun.un_tty->ldisc->ops->write_wakeup) {
5955 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
5956 DGAP_UNLOCK(bd->bd_lock, lock_flags);
5957 (ch->ch_pun.un_tty->ldisc->ops->write_wakeup)(ch->ch_pun.un_tty);
5958 DGAP_LOCK(bd->bd_lock, lock_flags);
5959 DGAP_LOCK(ch->ch_lock, lock_flags2);
5960 }
5961 wake_up_interruptible(&ch->ch_pun.un_tty->write_wait);
5962 wake_up_interruptible(&ch->ch_pun.un_flags_wait);
5963 }
5964 }
5965
5966
5967 if (ch->ch_flags & CH_WEMPTY) {
5968 ch->ch_flags &= ~CH_WEMPTY;
5969 wake_up_interruptible(&ch->ch_flags_wait);
5970 }
5971 }
5972
5973 DGAP_UNLOCK(ch->ch_lock, lock_flags2);
5974
5975 next:
5976 tail = (tail + 4) & (EVMAX - EVSTART - 4);
5977 }
5978
5979 writew(tail, &(eaddr->ev_tail));
5980 DGAP_UNLOCK(bd->bd_lock, lock_flags);
5981
5982 return 0;
5983 }
5984
5985 static ssize_t dgap_driver_version_show(struct device_driver *ddp, char *buf)
5986 {
5987 return snprintf(buf, PAGE_SIZE, "%s\n", DG_PART);
5988 }
5989 static DRIVER_ATTR(version, S_IRUSR, dgap_driver_version_show, NULL);
5990
5991
5992 static ssize_t dgap_driver_boards_show(struct device_driver *ddp, char *buf)
5993 {
5994 return snprintf(buf, PAGE_SIZE, "%d\n", dgap_NumBoards);
5995 }
5996 static DRIVER_ATTR(boards, S_IRUSR, dgap_driver_boards_show, NULL);
5997
5998
5999 static ssize_t dgap_driver_maxboards_show(struct device_driver *ddp, char *buf)
6000 {
6001 return snprintf(buf, PAGE_SIZE, "%d\n", MAXBOARDS);
6002 }
6003 static DRIVER_ATTR(maxboards, S_IRUSR, dgap_driver_maxboards_show, NULL);
6004
6005
6006 static ssize_t dgap_driver_pollcounter_show(struct device_driver *ddp, char *buf)
6007 {
6008 return snprintf(buf, PAGE_SIZE, "%ld\n", dgap_poll_counter);
6009 }
6010 static DRIVER_ATTR(pollcounter, S_IRUSR, dgap_driver_pollcounter_show, NULL);
6011
6012
6013 static ssize_t dgap_driver_state_show(struct device_driver *ddp, char *buf)
6014 {
6015 return snprintf(buf, PAGE_SIZE, "%s\n", dgap_driver_state_text[dgap_driver_state]);
6016 }
6017 static DRIVER_ATTR(state, S_IRUSR, dgap_driver_state_show, NULL);
6018
6019 static ssize_t dgap_driver_pollrate_show(struct device_driver *ddp, char *buf)
6020 {
6021 return snprintf(buf, PAGE_SIZE, "%dms\n", dgap_poll_tick);
6022 }
6023
6024 static ssize_t dgap_driver_pollrate_store(struct device_driver *ddp, const char *buf, size_t count)
6025 {
6026 if (sscanf(buf, "%d\n", &dgap_poll_tick) != 1)
6027 return -EINVAL;
6028 return count;
6029 }
6030 static DRIVER_ATTR(pollrate, (S_IRUSR | S_IWUSR), dgap_driver_pollrate_show, dgap_driver_pollrate_store);
6031
6032 static int dgap_create_driver_sysfiles(struct pci_driver *dgap_driver)
6033 {
6034 int rc = 0;
6035 struct device_driver *driverfs = &dgap_driver->driver;
6036
6037 rc |= driver_create_file(driverfs, &driver_attr_version);
6038 rc |= driver_create_file(driverfs, &driver_attr_boards);
6039 rc |= driver_create_file(driverfs, &driver_attr_maxboards);
6040 rc |= driver_create_file(driverfs, &driver_attr_pollrate);
6041 rc |= driver_create_file(driverfs, &driver_attr_pollcounter);
6042 rc |= driver_create_file(driverfs, &driver_attr_state);
6043
6044 return rc;
6045 }
6046
6047 static void dgap_remove_driver_sysfiles(struct pci_driver *dgap_driver)
6048 {
6049 struct device_driver *driverfs = &dgap_driver->driver;
6050 driver_remove_file(driverfs, &driver_attr_version);
6051 driver_remove_file(driverfs, &driver_attr_boards);
6052 driver_remove_file(driverfs, &driver_attr_maxboards);
6053 driver_remove_file(driverfs, &driver_attr_pollrate);
6054 driver_remove_file(driverfs, &driver_attr_pollcounter);
6055 driver_remove_file(driverfs, &driver_attr_state);
6056 }
6057
6058 static struct board_t *dgap_verify_board(struct device *p)
6059 {
6060 struct board_t *bd;
6061
6062 if (!p)
6063 return NULL;
6064
6065 bd = dev_get_drvdata(p);
6066 if (!bd || bd->magic != DGAP_BOARD_MAGIC || bd->state != BOARD_READY)
6067 return NULL;
6068
6069 return bd;
6070 }
6071
6072 static ssize_t dgap_ports_state_show(struct device *p, struct device_attribute *attr, char *buf)
6073 {
6074 struct board_t *bd;
6075 int count = 0;
6076 int i = 0;
6077
6078 bd = dgap_verify_board(p);
6079 if (!bd)
6080 return 0;
6081
6082 for (i = 0; i < bd->nasync; i++) {
6083 count += snprintf(buf + count, PAGE_SIZE - count,
6084 "%d %s\n", bd->channels[i]->ch_portnum,
6085 bd->channels[i]->ch_open_count ? "Open" : "Closed");
6086 }
6087 return count;
6088 }
6089 static DEVICE_ATTR(ports_state, S_IRUSR, dgap_ports_state_show, NULL);
6090
6091 static ssize_t dgap_ports_baud_show(struct device *p, struct device_attribute *attr, char *buf)
6092 {
6093 struct board_t *bd;
6094 int count = 0;
6095 int i = 0;
6096
6097 bd = dgap_verify_board(p);
6098 if (!bd)
6099 return 0;
6100
6101 for (i = 0; i < bd->nasync; i++) {
6102 count += snprintf(buf + count, PAGE_SIZE - count,
6103 "%d %d\n", bd->channels[i]->ch_portnum, bd->channels[i]->ch_baud_info);
6104 }
6105 return count;
6106 }
6107 static DEVICE_ATTR(ports_baud, S_IRUSR, dgap_ports_baud_show, NULL);
6108
6109 static ssize_t dgap_ports_msignals_show(struct device *p, struct device_attribute *attr, char *buf)
6110 {
6111 struct board_t *bd;
6112 int count = 0;
6113 int i = 0;
6114
6115 bd = dgap_verify_board(p);
6116 if (!bd)
6117 return 0;
6118
6119 for (i = 0; i < bd->nasync; i++) {
6120 if (bd->channels[i]->ch_open_count)
6121 count += snprintf(buf + count, PAGE_SIZE - count,
6122 "%d %s %s %s %s %s %s\n", bd->channels[i]->ch_portnum,
6123 (bd->channels[i]->ch_mostat & UART_MCR_RTS) ? "RTS" : "",
6124 (bd->channels[i]->ch_mistat & UART_MSR_CTS) ? "CTS" : "",
6125 (bd->channels[i]->ch_mostat & UART_MCR_DTR) ? "DTR" : "",
6126 (bd->channels[i]->ch_mistat & UART_MSR_DSR) ? "DSR" : "",
6127 (bd->channels[i]->ch_mistat & UART_MSR_DCD) ? "DCD" : "",
6128 (bd->channels[i]->ch_mistat & UART_MSR_RI) ? "RI" : "");
6129 else
6130 count += snprintf(buf + count, PAGE_SIZE - count,
6131 "%d\n", bd->channels[i]->ch_portnum);
6132 }
6133 return count;
6134 }
6135 static DEVICE_ATTR(ports_msignals, S_IRUSR, dgap_ports_msignals_show, NULL);
6136
6137 static ssize_t dgap_ports_iflag_show(struct device *p, struct device_attribute *attr, char *buf)
6138 {
6139 struct board_t *bd;
6140 int count = 0;
6141 int i = 0;
6142
6143 bd = dgap_verify_board(p);
6144 if (!bd)
6145 return 0;
6146
6147 for (i = 0; i < bd->nasync; i++)
6148 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
6149 bd->channels[i]->ch_portnum, bd->channels[i]->ch_c_iflag);
6150 return count;
6151 }
6152 static DEVICE_ATTR(ports_iflag, S_IRUSR, dgap_ports_iflag_show, NULL);
6153
6154 static ssize_t dgap_ports_cflag_show(struct device *p, struct device_attribute *attr, char *buf)
6155 {
6156 struct board_t *bd;
6157 int count = 0;
6158 int i = 0;
6159
6160 bd = dgap_verify_board(p);
6161 if (!bd)
6162 return 0;
6163
6164 for (i = 0; i < bd->nasync; i++)
6165 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
6166 bd->channels[i]->ch_portnum, bd->channels[i]->ch_c_cflag);
6167 return count;
6168 }
6169 static DEVICE_ATTR(ports_cflag, S_IRUSR, dgap_ports_cflag_show, NULL);
6170
6171 static ssize_t dgap_ports_oflag_show(struct device *p, struct device_attribute *attr, char *buf)
6172 {
6173 struct board_t *bd;
6174 int count = 0;
6175 int i = 0;
6176
6177 bd = dgap_verify_board(p);
6178 if (!bd)
6179 return 0;
6180
6181 for (i = 0; i < bd->nasync; i++)
6182 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
6183 bd->channels[i]->ch_portnum, bd->channels[i]->ch_c_oflag);
6184 return count;
6185 }
6186 static DEVICE_ATTR(ports_oflag, S_IRUSR, dgap_ports_oflag_show, NULL);
6187
6188 static ssize_t dgap_ports_lflag_show(struct device *p, struct device_attribute *attr, char *buf)
6189 {
6190 struct board_t *bd;
6191 int count = 0;
6192 int i = 0;
6193
6194 bd = dgap_verify_board(p);
6195 if (!bd)
6196 return 0;
6197
6198 for (i = 0; i < bd->nasync; i++)
6199 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
6200 bd->channels[i]->ch_portnum, bd->channels[i]->ch_c_lflag);
6201 return count;
6202 }
6203 static DEVICE_ATTR(ports_lflag, S_IRUSR, dgap_ports_lflag_show, NULL);
6204
6205 static ssize_t dgap_ports_digi_flag_show(struct device *p, struct device_attribute *attr, char *buf)
6206 {
6207 struct board_t *bd;
6208 int count = 0;
6209 int i = 0;
6210
6211 bd = dgap_verify_board(p);
6212 if (!bd)
6213 return 0;
6214
6215 for (i = 0; i < bd->nasync; i++)
6216 count += snprintf(buf + count, PAGE_SIZE - count, "%d %x\n",
6217 bd->channels[i]->ch_portnum, bd->channels[i]->ch_digi.digi_flags);
6218 return count;
6219 }
6220 static DEVICE_ATTR(ports_digi_flag, S_IRUSR, dgap_ports_digi_flag_show, NULL);
6221
6222 static ssize_t dgap_ports_rxcount_show(struct device *p, struct device_attribute *attr, char *buf)
6223 {
6224 struct board_t *bd;
6225 int count = 0;
6226 int i = 0;
6227
6228 bd = dgap_verify_board(p);
6229 if (!bd)
6230 return 0;
6231
6232 for (i = 0; i < bd->nasync; i++)
6233 count += snprintf(buf + count, PAGE_SIZE - count, "%d %ld\n",
6234 bd->channels[i]->ch_portnum, bd->channels[i]->ch_rxcount);
6235 return count;
6236 }
6237 static DEVICE_ATTR(ports_rxcount, S_IRUSR, dgap_ports_rxcount_show, NULL);
6238
6239 static ssize_t dgap_ports_txcount_show(struct device *p, struct device_attribute *attr, char *buf)
6240 {
6241 struct board_t *bd;
6242 int count = 0;
6243 int i = 0;
6244
6245 bd = dgap_verify_board(p);
6246 if (!bd)
6247 return 0;
6248
6249 for (i = 0; i < bd->nasync; i++)
6250 count += snprintf(buf + count, PAGE_SIZE - count, "%d %ld\n",
6251 bd->channels[i]->ch_portnum, bd->channels[i]->ch_txcount);
6252 return count;
6253 }
6254 static DEVICE_ATTR(ports_txcount, S_IRUSR, dgap_ports_txcount_show, NULL);
6255
6256 /* this function creates the sys files that will export each signal status
6257 * to sysfs each value will be put in a separate filename
6258 */
6259 static void dgap_create_ports_sysfiles(struct board_t *bd)
6260 {
6261 dev_set_drvdata(&bd->pdev->dev, bd);
6262 device_create_file(&(bd->pdev->dev), &dev_attr_ports_state);
6263 device_create_file(&(bd->pdev->dev), &dev_attr_ports_baud);
6264 device_create_file(&(bd->pdev->dev), &dev_attr_ports_msignals);
6265 device_create_file(&(bd->pdev->dev), &dev_attr_ports_iflag);
6266 device_create_file(&(bd->pdev->dev), &dev_attr_ports_cflag);
6267 device_create_file(&(bd->pdev->dev), &dev_attr_ports_oflag);
6268 device_create_file(&(bd->pdev->dev), &dev_attr_ports_lflag);
6269 device_create_file(&(bd->pdev->dev), &dev_attr_ports_digi_flag);
6270 device_create_file(&(bd->pdev->dev), &dev_attr_ports_rxcount);
6271 device_create_file(&(bd->pdev->dev), &dev_attr_ports_txcount);
6272 }
6273
6274 /* removes all the sys files created for that port */
6275 static void dgap_remove_ports_sysfiles(struct board_t *bd)
6276 {
6277 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_state);
6278 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_baud);
6279 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_msignals);
6280 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_iflag);
6281 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_cflag);
6282 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_oflag);
6283 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_lflag);
6284 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_digi_flag);
6285 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_rxcount);
6286 device_remove_file(&(bd->pdev->dev), &dev_attr_ports_txcount);
6287 }
6288
6289 static ssize_t dgap_tty_state_show(struct device *d, struct device_attribute *attr, char *buf)
6290 {
6291 struct board_t *bd;
6292 struct channel_t *ch;
6293 struct un_t *un;
6294
6295 if (!d)
6296 return 0;
6297 un = dev_get_drvdata(d);
6298 if (!un || un->magic != DGAP_UNIT_MAGIC)
6299 return 0;
6300 ch = un->un_ch;
6301 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6302 return 0;
6303 bd = ch->ch_bd;
6304 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6305 return 0;
6306 if (bd->state != BOARD_READY)
6307 return 0;
6308
6309 return snprintf(buf, PAGE_SIZE, "%s", un->un_open_count ? "Open" : "Closed");
6310 }
6311 static DEVICE_ATTR(state, S_IRUSR, dgap_tty_state_show, NULL);
6312
6313 static ssize_t dgap_tty_baud_show(struct device *d, struct device_attribute *attr, char *buf)
6314 {
6315 struct board_t *bd;
6316 struct channel_t *ch;
6317 struct un_t *un;
6318
6319 if (!d)
6320 return 0;
6321 un = dev_get_drvdata(d);
6322 if (!un || un->magic != DGAP_UNIT_MAGIC)
6323 return 0;
6324 ch = un->un_ch;
6325 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6326 return 0;
6327 bd = ch->ch_bd;
6328 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6329 return 0;
6330 if (bd->state != BOARD_READY)
6331 return 0;
6332
6333 return snprintf(buf, PAGE_SIZE, "%d\n", ch->ch_baud_info);
6334 }
6335 static DEVICE_ATTR(baud, S_IRUSR, dgap_tty_baud_show, NULL);
6336
6337 static ssize_t dgap_tty_msignals_show(struct device *d, struct device_attribute *attr, char *buf)
6338 {
6339 struct board_t *bd;
6340 struct channel_t *ch;
6341 struct un_t *un;
6342
6343 if (!d)
6344 return 0;
6345 un = dev_get_drvdata(d);
6346 if (!un || un->magic != DGAP_UNIT_MAGIC)
6347 return 0;
6348 ch = un->un_ch;
6349 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6350 return 0;
6351 bd = ch->ch_bd;
6352 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6353 return 0;
6354 if (bd->state != BOARD_READY)
6355 return 0;
6356
6357 if (ch->ch_open_count) {
6358 return snprintf(buf, PAGE_SIZE, "%s %s %s %s %s %s\n",
6359 (ch->ch_mostat & UART_MCR_RTS) ? "RTS" : "",
6360 (ch->ch_mistat & UART_MSR_CTS) ? "CTS" : "",
6361 (ch->ch_mostat & UART_MCR_DTR) ? "DTR" : "",
6362 (ch->ch_mistat & UART_MSR_DSR) ? "DSR" : "",
6363 (ch->ch_mistat & UART_MSR_DCD) ? "DCD" : "",
6364 (ch->ch_mistat & UART_MSR_RI) ? "RI" : "");
6365 }
6366 return 0;
6367 }
6368 static DEVICE_ATTR(msignals, S_IRUSR, dgap_tty_msignals_show, NULL);
6369
6370 static ssize_t dgap_tty_iflag_show(struct device *d, struct device_attribute *attr, char *buf)
6371 {
6372 struct board_t *bd;
6373 struct channel_t *ch;
6374 struct un_t *un;
6375
6376 if (!d)
6377 return 0;
6378 un = dev_get_drvdata(d);
6379 if (!un || un->magic != DGAP_UNIT_MAGIC)
6380 return 0;
6381 ch = un->un_ch;
6382 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6383 return 0;
6384 bd = ch->ch_bd;
6385 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6386 return 0;
6387 if (bd->state != BOARD_READY)
6388 return 0;
6389
6390 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_c_iflag);
6391 }
6392 static DEVICE_ATTR(iflag, S_IRUSR, dgap_tty_iflag_show, NULL);
6393
6394 static ssize_t dgap_tty_cflag_show(struct device *d, struct device_attribute *attr, char *buf)
6395 {
6396 struct board_t *bd;
6397 struct channel_t *ch;
6398 struct un_t *un;
6399
6400 if (!d)
6401 return 0;
6402 un = dev_get_drvdata(d);
6403 if (!un || un->magic != DGAP_UNIT_MAGIC)
6404 return 0;
6405 ch = un->un_ch;
6406 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6407 return 0;
6408 bd = ch->ch_bd;
6409 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6410 return 0;
6411 if (bd->state != BOARD_READY)
6412 return 0;
6413
6414 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_c_cflag);
6415 }
6416 static DEVICE_ATTR(cflag, S_IRUSR, dgap_tty_cflag_show, NULL);
6417
6418 static ssize_t dgap_tty_oflag_show(struct device *d, struct device_attribute *attr, char *buf)
6419 {
6420 struct board_t *bd;
6421 struct channel_t *ch;
6422 struct un_t *un;
6423
6424 if (!d)
6425 return 0;
6426 un = dev_get_drvdata(d);
6427 if (!un || un->magic != DGAP_UNIT_MAGIC)
6428 return 0;
6429 ch = un->un_ch;
6430 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6431 return 0;
6432 bd = ch->ch_bd;
6433 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6434 return 0;
6435 if (bd->state != BOARD_READY)
6436 return 0;
6437
6438 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_c_oflag);
6439 }
6440 static DEVICE_ATTR(oflag, S_IRUSR, dgap_tty_oflag_show, NULL);
6441
6442 static ssize_t dgap_tty_lflag_show(struct device *d, struct device_attribute *attr, char *buf)
6443 {
6444 struct board_t *bd;
6445 struct channel_t *ch;
6446 struct un_t *un;
6447
6448 if (!d)
6449 return 0;
6450 un = dev_get_drvdata(d);
6451 if (!un || un->magic != DGAP_UNIT_MAGIC)
6452 return 0;
6453 ch = un->un_ch;
6454 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6455 return 0;
6456 bd = ch->ch_bd;
6457 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6458 return 0;
6459 if (bd->state != BOARD_READY)
6460 return 0;
6461
6462 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_c_lflag);
6463 }
6464 static DEVICE_ATTR(lflag, S_IRUSR, dgap_tty_lflag_show, NULL);
6465
6466 static ssize_t dgap_tty_digi_flag_show(struct device *d, struct device_attribute *attr, char *buf)
6467 {
6468 struct board_t *bd;
6469 struct channel_t *ch;
6470 struct un_t *un;
6471
6472 if (!d)
6473 return 0;
6474 un = dev_get_drvdata(d);
6475 if (!un || un->magic != DGAP_UNIT_MAGIC)
6476 return 0;
6477 ch = un->un_ch;
6478 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6479 return 0;
6480 bd = ch->ch_bd;
6481 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6482 return 0;
6483 if (bd->state != BOARD_READY)
6484 return 0;
6485
6486 return snprintf(buf, PAGE_SIZE, "%x\n", ch->ch_digi.digi_flags);
6487 }
6488 static DEVICE_ATTR(digi_flag, S_IRUSR, dgap_tty_digi_flag_show, NULL);
6489
6490 static ssize_t dgap_tty_rxcount_show(struct device *d, struct device_attribute *attr, char *buf)
6491 {
6492 struct board_t *bd;
6493 struct channel_t *ch;
6494 struct un_t *un;
6495
6496 if (!d)
6497 return 0;
6498 un = dev_get_drvdata(d);
6499 if (!un || un->magic != DGAP_UNIT_MAGIC)
6500 return 0;
6501 ch = un->un_ch;
6502 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6503 return 0;
6504 bd = ch->ch_bd;
6505 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6506 return 0;
6507 if (bd->state != BOARD_READY)
6508 return 0;
6509
6510 return snprintf(buf, PAGE_SIZE, "%ld\n", ch->ch_rxcount);
6511 }
6512 static DEVICE_ATTR(rxcount, S_IRUSR, dgap_tty_rxcount_show, NULL);
6513
6514 static ssize_t dgap_tty_txcount_show(struct device *d, struct device_attribute *attr, char *buf)
6515 {
6516 struct board_t *bd;
6517 struct channel_t *ch;
6518 struct un_t *un;
6519
6520 if (!d)
6521 return 0;
6522 un = dev_get_drvdata(d);
6523 if (!un || un->magic != DGAP_UNIT_MAGIC)
6524 return 0;
6525 ch = un->un_ch;
6526 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6527 return 0;
6528 bd = ch->ch_bd;
6529 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6530 return 0;
6531 if (bd->state != BOARD_READY)
6532 return 0;
6533
6534 return snprintf(buf, PAGE_SIZE, "%ld\n", ch->ch_txcount);
6535 }
6536 static DEVICE_ATTR(txcount, S_IRUSR, dgap_tty_txcount_show, NULL);
6537
6538 static ssize_t dgap_tty_name_show(struct device *d, struct device_attribute *attr, char *buf)
6539 {
6540 struct board_t *bd;
6541 struct channel_t *ch;
6542 struct un_t *un;
6543 int cn;
6544 int bn;
6545 struct cnode *cptr = NULL;
6546 int found = FALSE;
6547 int ncount = 0;
6548 int starto = 0;
6549 int i = 0;
6550
6551 if (!d)
6552 return 0;
6553 un = dev_get_drvdata(d);
6554 if (!un || un->magic != DGAP_UNIT_MAGIC)
6555 return 0;
6556 ch = un->un_ch;
6557 if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
6558 return 0;
6559 bd = ch->ch_bd;
6560 if (!bd || bd->magic != DGAP_BOARD_MAGIC)
6561 return 0;
6562 if (bd->state != BOARD_READY)
6563 return 0;
6564
6565 bn = bd->boardnum;
6566 cn = ch->ch_portnum;
6567
6568 for (cptr = bd->bd_config; cptr; cptr = cptr->next) {
6569
6570 if ((cptr->type == BNODE) &&
6571 ((cptr->u.board.type == APORT2_920P) || (cptr->u.board.type == APORT4_920P) ||
6572 (cptr->u.board.type == APORT8_920P) || (cptr->u.board.type == PAPORT4) ||
6573 (cptr->u.board.type == PAPORT8))) {
6574
6575 found = TRUE;
6576 if (cptr->u.board.v_start)
6577 starto = cptr->u.board.start;
6578 else
6579 starto = 1;
6580 }
6581
6582 if (cptr->type == TNODE && found == TRUE) {
6583 char *ptr1;
6584 if (strstr(cptr->u.ttyname, "tty")) {
6585 ptr1 = cptr->u.ttyname;
6586 ptr1 += 3;
6587 } else
6588 ptr1 = cptr->u.ttyname;
6589
6590 for (i = 0; i < dgap_config_get_number_of_ports(bd); i++) {
6591 if (cn == i)
6592 return snprintf(buf, PAGE_SIZE, "%s%s%02d\n",
6593 (un->un_type == DGAP_PRINT) ? "pr" : "tty",
6594 ptr1, i + starto);
6595 }
6596 }
6597
6598 if (cptr->type == CNODE) {
6599
6600 for (i = 0; i < cptr->u.conc.nport; i++) {
6601 if (cn == (i + ncount))
6602
6603 return snprintf(buf, PAGE_SIZE, "%s%s%02d\n",
6604 (un->un_type == DGAP_PRINT) ? "pr" : "tty",
6605 cptr->u.conc.id,
6606 i + (cptr->u.conc.v_start ? cptr->u.conc.start : 1));
6607 }
6608
6609 ncount += cptr->u.conc.nport;
6610 }
6611
6612 if (cptr->type == MNODE) {
6613
6614 for (i = 0; i < cptr->u.module.nport; i++) {
6615 if (cn == (i + ncount))
6616 return snprintf(buf, PAGE_SIZE, "%s%s%02d\n",
6617 (un->un_type == DGAP_PRINT) ? "pr" : "tty",
6618 cptr->u.module.id,
6619 i + (cptr->u.module.v_start ? cptr->u.module.start : 1));
6620 }
6621
6622 ncount += cptr->u.module.nport;
6623
6624 }
6625 }
6626
6627 return snprintf(buf, PAGE_SIZE, "%s_dgap_%d_%d\n",
6628 (un->un_type == DGAP_PRINT) ? "pr" : "tty", bn, cn);
6629
6630 }
6631 static DEVICE_ATTR(custom_name, S_IRUSR, dgap_tty_name_show, NULL);
6632
6633 static struct attribute *dgap_sysfs_tty_entries[] = {
6634 &dev_attr_state.attr,
6635 &dev_attr_baud.attr,
6636 &dev_attr_msignals.attr,
6637 &dev_attr_iflag.attr,
6638 &dev_attr_cflag.attr,
6639 &dev_attr_oflag.attr,
6640 &dev_attr_lflag.attr,
6641 &dev_attr_digi_flag.attr,
6642 &dev_attr_rxcount.attr,
6643 &dev_attr_txcount.attr,
6644 &dev_attr_custom_name.attr,
6645 NULL
6646 };
6647
6648 static struct attribute_group dgap_tty_attribute_group = {
6649 .name = NULL,
6650 .attrs = dgap_sysfs_tty_entries,
6651 };
6652
6653 static void dgap_create_tty_sysfs(struct un_t *un, struct device *c)
6654 {
6655 int ret;
6656
6657 ret = sysfs_create_group(&c->kobj, &dgap_tty_attribute_group);
6658 if (ret)
6659 return;
6660
6661 dev_set_drvdata(c, un);
6662
6663 }
6664
6665 static void dgap_remove_tty_sysfs(struct device *c)
6666 {
6667 sysfs_remove_group(&c->kobj, &dgap_tty_attribute_group);
6668 }
6669
6670 /*
6671 * Parse a configuration file read into memory as a string.
6672 */
6673 static int dgap_parsefile(char **in, int Remove)
6674 {
6675 struct cnode *p, *brd, *line, *conc;
6676 int rc;
6677 char *s = NULL, *s2 = NULL;
6678 int linecnt = 0;
6679
6680 p = &dgap_head;
6681 brd = line = conc = NULL;
6682
6683 /* perhaps we are adding to an existing list? */
6684 while (p->next != NULL)
6685 p = p->next;
6686
6687 /* file must start with a BEGIN */
6688 while ((rc = dgap_gettok(in, p)) != BEGIN) {
6689 if (rc == 0) {
6690 dgap_err("unexpected EOF");
6691 return -1;
6692 }
6693 }
6694
6695 for (; ;) {
6696 rc = dgap_gettok(in, p);
6697 if (rc == 0) {
6698 dgap_err("unexpected EOF");
6699 return -1;
6700 }
6701
6702 switch (rc) {
6703 case 0:
6704 dgap_err("unexpected end of file");
6705 return -1;
6706
6707 case BEGIN: /* should only be 1 begin */
6708 dgap_err("unexpected config_begin\n");
6709 return -1;
6710
6711 case END:
6712 return 0;
6713
6714 case BOARD: /* board info */
6715 if (dgap_checknode(p))
6716 return -1;
6717 p->next = dgap_newnode(BNODE);
6718 if (!p->next) {
6719 dgap_err("out of memory");
6720 return -1;
6721 }
6722 p = p->next;
6723
6724 p->u.board.status = dgap_savestring("No");
6725 line = conc = NULL;
6726 brd = p;
6727 linecnt = -1;
6728 break;
6729
6730 case APORT2_920P: /* AccelePort_4 */
6731 if (p->type != BNODE) {
6732 dgap_err("unexpected Digi_2r_920 string");
6733 return -1;
6734 }
6735 p->u.board.type = APORT2_920P;
6736 p->u.board.v_type = 1;
6737 break;
6738
6739 case APORT4_920P: /* AccelePort_4 */
6740 if (p->type != BNODE) {
6741 dgap_err("unexpected Digi_4r_920 string");
6742 return -1;
6743 }
6744 p->u.board.type = APORT4_920P;
6745 p->u.board.v_type = 1;
6746 break;
6747
6748 case APORT8_920P: /* AccelePort_8 */
6749 if (p->type != BNODE) {
6750 dgap_err("unexpected Digi_8r_920 string");
6751 return -1;
6752 }
6753 p->u.board.type = APORT8_920P;
6754 p->u.board.v_type = 1;
6755 break;
6756
6757 case PAPORT4: /* AccelePort_4 PCI */
6758 if (p->type != BNODE) {
6759 dgap_err("unexpected Digi_4r(PCI) string");
6760 return -1;
6761 }
6762 p->u.board.type = PAPORT4;
6763 p->u.board.v_type = 1;
6764 break;
6765
6766 case PAPORT8: /* AccelePort_8 PCI */
6767 if (p->type != BNODE) {
6768 dgap_err("unexpected Digi_8r string");
6769 return -1;
6770 }
6771 p->u.board.type = PAPORT8;
6772 p->u.board.v_type = 1;
6773 break;
6774
6775 case PCX: /* PCI C/X */
6776 if (p->type != BNODE) {
6777 dgap_err("unexpected Digi_C/X_(PCI) string");
6778 return -1;
6779 }
6780 p->u.board.type = PCX;
6781 p->u.board.v_type = 1;
6782 p->u.board.conc1 = 0;
6783 p->u.board.conc2 = 0;
6784 p->u.board.module1 = 0;
6785 p->u.board.module2 = 0;
6786 break;
6787
6788 case PEPC: /* PCI EPC/X */
6789 if (p->type != BNODE) {
6790 dgap_err("unexpected \"Digi_EPC/X_(PCI)\" string");
6791 return -1;
6792 }
6793 p->u.board.type = PEPC;
6794 p->u.board.v_type = 1;
6795 p->u.board.conc1 = 0;
6796 p->u.board.conc2 = 0;
6797 p->u.board.module1 = 0;
6798 p->u.board.module2 = 0;
6799 break;
6800
6801 case PPCM: /* PCI/Xem */
6802 if (p->type != BNODE) {
6803 dgap_err("unexpected PCI/Xem string");
6804 return -1;
6805 }
6806 p->u.board.type = PPCM;
6807 p->u.board.v_type = 1;
6808 p->u.board.conc1 = 0;
6809 p->u.board.conc2 = 0;
6810 break;
6811
6812 case IO: /* i/o port */
6813 if (p->type != BNODE) {
6814 dgap_err("IO port only vaild for boards");
6815 return -1;
6816 }
6817 s = dgap_getword(in);
6818 if (s == NULL) {
6819 dgap_err("unexpected end of file");
6820 return -1;
6821 }
6822 p->u.board.portstr = dgap_savestring(s);
6823 p->u.board.port = (short)simple_strtol(s, &s2, 0);
6824 if ((short)strlen(s) > (short)(s2 - s)) {
6825 dgap_err("bad number for IO port");
6826 return -1;
6827 }
6828 p->u.board.v_port = 1;
6829 break;
6830
6831 case MEM: /* memory address */
6832 if (p->type != BNODE) {
6833 dgap_err("memory address only vaild for boards");
6834 return -1;
6835 }
6836 s = dgap_getword(in);
6837 if (s == NULL) {
6838 dgap_err("unexpected end of file");
6839 return -1;
6840 }
6841 p->u.board.addrstr = dgap_savestring(s);
6842 p->u.board.addr = simple_strtoul(s, &s2, 0);
6843 if ((int)strlen(s) > (int)(s2 - s)) {
6844 dgap_err("bad number for memory address");
6845 return -1;
6846 }
6847 p->u.board.v_addr = 1;
6848 break;
6849
6850 case PCIINFO: /* pci information */
6851 if (p->type != BNODE) {
6852 dgap_err("memory address only vaild for boards");
6853 return -1;
6854 }
6855 s = dgap_getword(in);
6856 if (s == NULL) {
6857 dgap_err("unexpected end of file");
6858 return -1;
6859 }
6860 p->u.board.pcibusstr = dgap_savestring(s);
6861 p->u.board.pcibus = simple_strtoul(s, &s2, 0);
6862 if ((int)strlen(s) > (int)(s2 - s)) {
6863 dgap_err("bad number for pci bus");
6864 return -1;
6865 }
6866 p->u.board.v_pcibus = 1;
6867 s = dgap_getword(in);
6868 if (s == NULL) {
6869 dgap_err("unexpected end of file");
6870 return -1;
6871 }
6872 p->u.board.pcislotstr = dgap_savestring(s);
6873 p->u.board.pcislot = simple_strtoul(s, &s2, 0);
6874 if ((int)strlen(s) > (int)(s2 - s)) {
6875 dgap_err("bad number for pci slot");
6876 return -1;
6877 }
6878 p->u.board.v_pcislot = 1;
6879 break;
6880
6881 case METHOD:
6882 if (p->type != BNODE) {
6883 dgap_err("install method only vaild for boards");
6884 return -1;
6885 }
6886 s = dgap_getword(in);
6887 if (s == NULL) {
6888 dgap_err("unexpected end of file");
6889 return -1;
6890 }
6891 p->u.board.method = dgap_savestring(s);
6892 p->u.board.v_method = 1;
6893 break;
6894
6895 case STATUS:
6896 if (p->type != BNODE) {
6897 dgap_err("config status only vaild for boards");
6898 return -1;
6899 }
6900 s = dgap_getword(in);
6901 if (s == NULL) {
6902 dgap_err("unexpected end of file");
6903 return -1;
6904 }
6905 p->u.board.status = dgap_savestring(s);
6906 break;
6907
6908 case NPORTS: /* number of ports */
6909 if (p->type == BNODE) {
6910 s = dgap_getword(in);
6911 if (s == NULL) {
6912 dgap_err("unexpected end of file");
6913 return -1;
6914 }
6915 p->u.board.nport = (char)simple_strtol(s, &s2, 0);
6916 if ((int)strlen(s) > (int)(s2 - s)) {
6917 dgap_err("bad number for number of ports");
6918 return -1;
6919 }
6920 p->u.board.v_nport = 1;
6921 } else if (p->type == CNODE) {
6922 s = dgap_getword(in);
6923 if (s == NULL) {
6924 dgap_err("unexpected end of file");
6925 return -1;
6926 }
6927 p->u.conc.nport = (char)simple_strtol(s, &s2, 0);
6928 if ((int)strlen(s) > (int)(s2 - s)) {
6929 dgap_err("bad number for number of ports");
6930 return -1;
6931 }
6932 p->u.conc.v_nport = 1;
6933 } else if (p->type == MNODE) {
6934 s = dgap_getword(in);
6935 if (s == NULL) {
6936 dgap_err("unexpected end of file");
6937 return -1;
6938 }
6939 p->u.module.nport = (char)simple_strtol(s, &s2, 0);
6940 if ((int)strlen(s) > (int)(s2 - s)) {
6941 dgap_err("bad number for number of ports");
6942 return -1;
6943 }
6944 p->u.module.v_nport = 1;
6945 } else {
6946 dgap_err("nports only valid for concentrators or modules");
6947 return -1;
6948 }
6949 break;
6950
6951 case ID: /* letter ID used in tty name */
6952 s = dgap_getword(in);
6953 if (s == NULL) {
6954 dgap_err("unexpected end of file");
6955 return -1;
6956 }
6957
6958 p->u.board.status = dgap_savestring(s);
6959
6960 if (p->type == CNODE) {
6961 p->u.conc.id = dgap_savestring(s);
6962 p->u.conc.v_id = 1;
6963 } else if (p->type == MNODE) {
6964 p->u.module.id = dgap_savestring(s);
6965 p->u.module.v_id = 1;
6966 } else {
6967 dgap_err("id only valid for concentrators or modules");
6968 return -1;
6969 }
6970 break;
6971
6972 case STARTO: /* start offset of ID */
6973 if (p->type == BNODE) {
6974 s = dgap_getword(in);
6975 if (s == NULL) {
6976 dgap_err("unexpected end of file");
6977 return -1;
6978 }
6979 p->u.board.start = simple_strtol(s, &s2, 0);
6980 if ((int)strlen(s) > (int)(s2 - s)) {
6981 dgap_err("bad number for start of tty count");
6982 return -1;
6983 }
6984 p->u.board.v_start = 1;
6985 } else if (p->type == CNODE) {
6986 s = dgap_getword(in);
6987 if (s == NULL) {
6988 dgap_err("unexpected end of file");
6989 return -1;
6990 }
6991 p->u.conc.start = simple_strtol(s, &s2, 0);
6992 if ((int)strlen(s) > (int)(s2 - s)) {
6993 dgap_err("bad number for start of tty count");
6994 return -1;
6995 }
6996 p->u.conc.v_start = 1;
6997 } else if (p->type == MNODE) {
6998 s = dgap_getword(in);
6999 if (s == NULL) {
7000 dgap_err("unexpected end of file");
7001 return -1;
7002 }
7003 p->u.module.start = simple_strtol(s, &s2, 0);
7004 if ((int)strlen(s) > (int)(s2 - s)) {
7005 dgap_err("bad number for start of tty count");
7006 return -1;
7007 }
7008 p->u.module.v_start = 1;
7009 } else {
7010 dgap_err("start only valid for concentrators or modules");
7011 return -1;
7012 }
7013 break;
7014
7015 case TTYN: /* tty name prefix */
7016 if (dgap_checknode(p))
7017 return -1;
7018 p->next = dgap_newnode(TNODE);
7019 if (!p->next) {
7020 dgap_err("out of memory");
7021 return -1;
7022 }
7023 p = p->next;
7024 s = dgap_getword(in);
7025 if (!s) {
7026 dgap_err("unexpeced end of file");
7027 return -1;
7028 }
7029 p->u.ttyname = dgap_savestring(s);
7030 if (!p->u.ttyname) {
7031 dgap_err("out of memory");
7032 return -1;
7033 }
7034 break;
7035
7036 case CU: /* cu name prefix */
7037 if (dgap_checknode(p))
7038 return -1;
7039 p->next = dgap_newnode(CUNODE);
7040 if (!p->next) {
7041 dgap_err("out of memory");
7042 return -1;
7043 }
7044 p = p->next;
7045 s = dgap_getword(in);
7046 if (!s) {
7047 dgap_err("unexpeced end of file");
7048 return -1;
7049 }
7050 p->u.cuname = dgap_savestring(s);
7051 if (!p->u.cuname) {
7052 dgap_err("out of memory");
7053 return -1;
7054 }
7055 break;
7056
7057 case LINE: /* line information */
7058 if (dgap_checknode(p))
7059 return -1;
7060 if (brd == NULL) {
7061 dgap_err("must specify board before line info");
7062 return -1;
7063 }
7064 switch (brd->u.board.type) {
7065 case PPCM:
7066 dgap_err("line not vaild for PC/em");
7067 return -1;
7068 }
7069 p->next = dgap_newnode(LNODE);
7070 if (!p->next) {
7071 dgap_err("out of memory");
7072 return -1;
7073 }
7074 p = p->next;
7075 conc = NULL;
7076 line = p;
7077 linecnt++;
7078 break;
7079
7080 case CONC: /* concentrator information */
7081 if (dgap_checknode(p))
7082 return -1;
7083 if (line == NULL) {
7084 dgap_err("must specify line info before concentrator");
7085 return -1;
7086 }
7087 p->next = dgap_newnode(CNODE);
7088 if (!p->next) {
7089 dgap_err("out of memory");
7090 return -1;
7091 }
7092 p = p->next;
7093 conc = p;
7094 if (linecnt)
7095 brd->u.board.conc2++;
7096 else
7097 brd->u.board.conc1++;
7098
7099 break;
7100
7101 case CX: /* c/x type concentrator */
7102 if (p->type != CNODE) {
7103 dgap_err("cx only valid for concentrators");
7104 return -1;
7105 }
7106 p->u.conc.type = CX;
7107 p->u.conc.v_type = 1;
7108 break;
7109
7110 case EPC: /* epc type concentrator */
7111 if (p->type != CNODE) {
7112 dgap_err("cx only valid for concentrators");
7113 return -1;
7114 }
7115 p->u.conc.type = EPC;
7116 p->u.conc.v_type = 1;
7117 break;
7118
7119 case MOD: /* EBI module */
7120 if (dgap_checknode(p))
7121 return -1;
7122 if (brd == NULL) {
7123 dgap_err("must specify board info before EBI modules");
7124 return -1;
7125 }
7126 switch (brd->u.board.type) {
7127 case PPCM:
7128 linecnt = 0;
7129 break;
7130 default:
7131 if (conc == NULL) {
7132 dgap_err("must specify concentrator info before EBI module");
7133 return -1;
7134 }
7135 }
7136 p->next = dgap_newnode(MNODE);
7137 if (!p->next) {
7138 dgap_err("out of memory");
7139 return -1;
7140 }
7141 p = p->next;
7142 if (linecnt)
7143 brd->u.board.module2++;
7144 else
7145 brd->u.board.module1++;
7146
7147 break;
7148
7149 case PORTS: /* ports type EBI module */
7150 if (p->type != MNODE) {
7151 dgap_err("ports only valid for EBI modules");
7152 return -1;
7153 }
7154 p->u.module.type = PORTS;
7155 p->u.module.v_type = 1;
7156 break;
7157
7158 case MODEM: /* ports type EBI module */
7159 if (p->type != MNODE) {
7160 dgap_err("modem only valid for modem modules");
7161 return -1;
7162 }
7163 p->u.module.type = MODEM;
7164 p->u.module.v_type = 1;
7165 break;
7166
7167 case CABLE:
7168 if (p->type == LNODE) {
7169 s = dgap_getword(in);
7170 if (!s) {
7171 dgap_err("unexpected end of file");
7172 return -1;
7173 }
7174 p->u.line.cable = dgap_savestring(s);
7175 p->u.line.v_cable = 1;
7176 }
7177 break;
7178
7179 case SPEED: /* sync line speed indication */
7180 if (p->type == LNODE) {
7181 s = dgap_getword(in);
7182 if (s == NULL) {
7183 dgap_err("unexpected end of file");
7184 return -1;
7185 }
7186 p->u.line.speed = (char)simple_strtol(s, &s2, 0);
7187 if ((short)strlen(s) > (short)(s2 - s)) {
7188 dgap_err("bad number for line speed");
7189 return -1;
7190 }
7191 p->u.line.v_speed = 1;
7192 } else if (p->type == CNODE) {
7193 s = dgap_getword(in);
7194 if (s == NULL) {
7195 dgap_err("unexpected end of file");
7196 return -1;
7197 }
7198 p->u.conc.speed = (char)simple_strtol(s, &s2, 0);
7199 if ((short)strlen(s) > (short)(s2 - s)) {
7200 dgap_err("bad number for line speed");
7201 return -1;
7202 }
7203 p->u.conc.v_speed = 1;
7204 } else {
7205 dgap_err("speed valid only for lines or concentrators.");
7206 return -1;
7207 }
7208 break;
7209
7210 case CONNECT:
7211 if (p->type == CNODE) {
7212 s = dgap_getword(in);
7213 if (!s) {
7214 dgap_err("unexpected end of file");
7215 return -1;
7216 }
7217 p->u.conc.connect = dgap_savestring(s);
7218 p->u.conc.v_connect = 1;
7219 }
7220 break;
7221 case PRINT: /* transparent print name prefix */
7222 if (dgap_checknode(p))
7223 return -1;
7224 p->next = dgap_newnode(PNODE);
7225 if (!p->next) {
7226 dgap_err("out of memory");
7227 return -1;
7228 }
7229 p = p->next;
7230 s = dgap_getword(in);
7231 if (!s) {
7232 dgap_err("unexpeced end of file");
7233 return -1;
7234 }
7235 p->u.printname = dgap_savestring(s);
7236 if (!p->u.printname) {
7237 dgap_err("out of memory");
7238 return -1;
7239 }
7240 break;
7241
7242 case CMAJOR: /* major number */
7243 if (dgap_checknode(p))
7244 return -1;
7245 p->next = dgap_newnode(JNODE);
7246 if (!p->next) {
7247 dgap_err("out of memory");
7248 return -1;
7249 }
7250 p = p->next;
7251 s = dgap_getword(in);
7252 if (s == NULL) {
7253 dgap_err("unexpected end of file");
7254 return -1;
7255 }
7256 p->u.majornumber = simple_strtol(s, &s2, 0);
7257 if ((int)strlen(s) > (int)(s2 - s)) {
7258 dgap_err("bad number for major number");
7259 return -1;
7260 }
7261 break;
7262
7263 case ALTPIN: /* altpin setting */
7264 if (dgap_checknode(p))
7265 return -1;
7266 p->next = dgap_newnode(ANODE);
7267 if (!p->next) {
7268 dgap_err("out of memory");
7269 return -1;
7270 }
7271 p = p->next;
7272 s = dgap_getword(in);
7273 if (s == NULL) {
7274 dgap_err("unexpected end of file");
7275 return -1;
7276 }
7277 p->u.altpin = simple_strtol(s, &s2, 0);
7278 if ((int)strlen(s) > (int)(s2 - s)) {
7279 dgap_err("bad number for altpin");
7280 return -1;
7281 }
7282 break;
7283
7284 case USEINTR: /* enable interrupt setting */
7285 if (dgap_checknode(p))
7286 return -1;
7287 p->next = dgap_newnode(INTRNODE);
7288 if (!p->next) {
7289 dgap_err("out of memory");
7290 return -1;
7291 }
7292 p = p->next;
7293 s = dgap_getword(in);
7294 if (s == NULL) {
7295 dgap_err("unexpected end of file");
7296 return -1;
7297 }
7298 p->u.useintr = simple_strtol(s, &s2, 0);
7299 if ((int)strlen(s) > (int)(s2 - s)) {
7300 dgap_err("bad number for useintr");
7301 return -1;
7302 }
7303 break;
7304
7305 case TTSIZ: /* size of tty structure */
7306 if (dgap_checknode(p))
7307 return -1;
7308 p->next = dgap_newnode(TSNODE);
7309 if (!p->next) {
7310 dgap_err("out of memory");
7311 return -1;
7312 }
7313 p = p->next;
7314 s = dgap_getword(in);
7315 if (s == NULL) {
7316 dgap_err("unexpected end of file");
7317 return -1;
7318 }
7319 p->u.ttysize = simple_strtol(s, &s2, 0);
7320 if ((int)strlen(s) > (int)(s2 - s)) {
7321 dgap_err("bad number for ttysize");
7322 return -1;
7323 }
7324 break;
7325
7326 case CHSIZ: /* channel structure size */
7327 if (dgap_checknode(p))
7328 return -1;
7329 p->next = dgap_newnode(CSNODE);
7330 if (!p->next) {
7331 dgap_err("out of memory");
7332 return -1;
7333 }
7334 p = p->next;
7335 s = dgap_getword(in);
7336 if (s == NULL) {
7337 dgap_err("unexpected end of file");
7338 return -1;
7339 }
7340 p->u.chsize = simple_strtol(s, &s2, 0);
7341 if ((int)strlen(s) > (int)(s2 - s)) {
7342 dgap_err("bad number for chsize");
7343 return -1;
7344 }
7345 break;
7346
7347 case BSSIZ: /* board structure size */
7348 if (dgap_checknode(p))
7349 return -1;
7350 p->next = dgap_newnode(BSNODE);
7351 if (!p->next) {
7352 dgap_err("out of memory");
7353 return -1;
7354 }
7355 p = p->next;
7356 s = dgap_getword(in);
7357 if (s == NULL) {
7358 dgap_err("unexpected end of file");
7359 return -1;
7360 }
7361 p->u.bssize = simple_strtol(s, &s2, 0);
7362 if ((int)strlen(s) > (int)(s2 - s)) {
7363 dgap_err("bad number for bssize");
7364 return -1;
7365 }
7366 break;
7367
7368 case UNTSIZ: /* sched structure size */
7369 if (dgap_checknode(p))
7370 return -1;
7371 p->next = dgap_newnode(USNODE);
7372 if (!p->next) {
7373 dgap_err("out of memory");
7374 return -1;
7375 }
7376 p = p->next;
7377 s = dgap_getword(in);
7378 if (s == NULL) {
7379 dgap_err("unexpected end of file");
7380 return -1;
7381 }
7382 p->u.unsize = simple_strtol(s, &s2, 0);
7383 if ((int)strlen(s) > (int)(s2 - s)) {
7384 dgap_err("bad number for schedsize");
7385 return -1;
7386 }
7387 break;
7388
7389 case F2SIZ: /* f2200 structure size */
7390 if (dgap_checknode(p))
7391 return -1;
7392 p->next = dgap_newnode(FSNODE);
7393 if (!p->next) {
7394 dgap_err("out of memory");
7395 return -1;
7396 }
7397 p = p->next;
7398 s = dgap_getword(in);
7399 if (s == NULL) {
7400 dgap_err("unexpected end of file");
7401 return -1;
7402 }
7403 p->u.f2size = simple_strtol(s, &s2, 0);
7404 if ((int)strlen(s) > (int)(s2 - s)) {
7405 dgap_err("bad number for f2200size");
7406 return -1;
7407 }
7408 break;
7409
7410 case VPSIZ: /* vpix structure size */
7411 if (dgap_checknode(p))
7412 return -1;
7413 p->next = dgap_newnode(VSNODE);
7414 if (!p->next) {
7415 dgap_err("out of memory");
7416 return -1;
7417 }
7418 p = p->next;
7419 s = dgap_getword(in);
7420 if (s == NULL) {
7421 dgap_err("unexpected end of file");
7422 return -1;
7423 }
7424 p->u.vpixsize = simple_strtol(s, &s2, 0);
7425 if ((int)strlen(s) > (int)(s2 - s)) {
7426 dgap_err("bad number for vpixsize");
7427 return -1;
7428 }
7429 break;
7430 }
7431 }
7432 }
7433
7434 /*
7435 * dgap_sindex: much like index(), but it looks for a match of any character in
7436 * the group, and returns that position. If the first character is a ^, then
7437 * this will match the first occurrence not in that group.
7438 */
7439 static char *dgap_sindex(char *string, char *group)
7440 {
7441 char *ptr;
7442
7443 if (!string || !group)
7444 return (char *) NULL;
7445
7446 if (*group == '^') {
7447 group++;
7448 for (; *string; string++) {
7449 for (ptr = group; *ptr; ptr++) {
7450 if (*ptr == *string)
7451 break;
7452 }
7453 if (*ptr == '\0')
7454 return string;
7455 }
7456 } else {
7457 for (; *string; string++) {
7458 for (ptr = group; *ptr; ptr++) {
7459 if (*ptr == *string)
7460 return string;
7461 }
7462 }
7463 }
7464
7465 return (char *) NULL;
7466 }
7467
7468 /*
7469 * Get a token from the input file; return 0 if end of file is reached
7470 */
7471 static int dgap_gettok(char **in, struct cnode *p)
7472 {
7473 char *w;
7474 struct toklist *t;
7475
7476 if (strstr(dgap_cword, "boar")) {
7477 w = dgap_getword(in);
7478 snprintf(dgap_cword, MAXCWORD, "%s", w);
7479 for (t = dgap_tlist; t->token != 0; t++) {
7480 if (!strcmp(w, t->string))
7481 return t->token;
7482 }
7483 dgap_err("board !!type not specified");
7484 return 1;
7485 } else {
7486 while ((w = dgap_getword(in))) {
7487 snprintf(dgap_cword, MAXCWORD, "%s", w);
7488 for (t = dgap_tlist; t->token != 0; t++) {
7489 if (!strcmp(w, t->string))
7490 return t->token;
7491 }
7492 }
7493 return 0;
7494 }
7495 }
7496
7497 /*
7498 * get a word from the input stream, also keep track of current line number.
7499 * words are separated by whitespace.
7500 */
7501 static char *dgap_getword(char **in)
7502 {
7503 char *ret_ptr = *in;
7504
7505 char *ptr = dgap_sindex(*in, " \t\n");
7506
7507 /* If no word found, return null */
7508 if (!ptr)
7509 return NULL;
7510
7511 /* Mark new location for our buffer */
7512 *ptr = '\0';
7513 *in = ptr + 1;
7514
7515 /* Eat any extra spaces/tabs/newlines that might be present */
7516 while (*in && **in && ((**in == ' ') || (**in == '\t') || (**in == '\n'))) {
7517 **in = '\0';
7518 *in = *in + 1;
7519 }
7520
7521 return ret_ptr;
7522 }
7523
7524 /*
7525 * print an error message, giving the line number in the file where
7526 * the error occurred.
7527 */
7528 static void dgap_err(char *s)
7529 {
7530 pr_err("dgap: parse: %s\n", s);
7531 }
7532
7533 /*
7534 * allocate a new configuration node of type t
7535 */
7536 static struct cnode *dgap_newnode(int t)
7537 {
7538 struct cnode *n;
7539
7540 n = kmalloc(sizeof(struct cnode), GFP_ATOMIC);
7541 if (n != NULL) {
7542 memset((char *)n, 0, sizeof(struct cnode));
7543 n->type = t;
7544 }
7545 return n;
7546 }
7547
7548 /*
7549 * dgap_checknode: see if all the necessary info has been supplied for a node
7550 * before creating the next node.
7551 */
7552 static int dgap_checknode(struct cnode *p)
7553 {
7554 switch (p->type) {
7555 case BNODE:
7556 if (p->u.board.v_type == 0) {
7557 dgap_err("board type !not specified");
7558 return 1;
7559 }
7560
7561 return 0;
7562
7563 case LNODE:
7564 if (p->u.line.v_speed == 0) {
7565 dgap_err("line speed not specified");
7566 return 1;
7567 }
7568 return 0;
7569
7570 case CNODE:
7571 if (p->u.conc.v_type == 0) {
7572 dgap_err("concentrator type not specified");
7573 return 1;
7574 }
7575 if (p->u.conc.v_speed == 0) {
7576 dgap_err("concentrator line speed not specified");
7577 return 1;
7578 }
7579 if (p->u.conc.v_nport == 0) {
7580 dgap_err("number of ports on concentrator not specified");
7581 return 1;
7582 }
7583 if (p->u.conc.v_id == 0) {
7584 dgap_err("concentrator id letter not specified");
7585 return 1;
7586 }
7587 return 0;
7588
7589 case MNODE:
7590 if (p->u.module.v_type == 0) {
7591 dgap_err("EBI module type not specified");
7592 return 1;
7593 }
7594 if (p->u.module.v_nport == 0) {
7595 dgap_err("number of ports on EBI module not specified");
7596 return 1;
7597 }
7598 if (p->u.module.v_id == 0) {
7599 dgap_err("EBI module id letter not specified");
7600 return 1;
7601 }
7602 return 0;
7603 }
7604 return 0;
7605 }
7606
7607 /*
7608 * save a string somewhere
7609 */
7610 static char *dgap_savestring(char *s)
7611 {
7612 char *p;
7613
7614 p = kmalloc(strlen(s) + 1, GFP_ATOMIC);
7615 if (p)
7616 strcpy(p, s);
7617 return p;
7618 }
7619
7620 /*
7621 * Given a board pointer, returns whether we should use interrupts or not.
7622 */
7623 static uint dgap_config_get_useintr(struct board_t *bd)
7624 {
7625 struct cnode *p = NULL;
7626
7627 if (!bd)
7628 return 0;
7629
7630 for (p = bd->bd_config; p; p = p->next) {
7631 switch (p->type) {
7632 case INTRNODE:
7633 /*
7634 * check for pcxr types.
7635 */
7636 return p->u.useintr;
7637 default:
7638 break;
7639 }
7640 }
7641
7642 /* If not found, then don't turn on interrupts. */
7643 return 0;
7644 }
7645
7646 /*
7647 * Given a board pointer, returns whether we turn on altpin or not.
7648 */
7649 static uint dgap_config_get_altpin(struct board_t *bd)
7650 {
7651 struct cnode *p = NULL;
7652
7653 if (!bd)
7654 return 0;
7655
7656 for (p = bd->bd_config; p; p = p->next) {
7657 switch (p->type) {
7658 case ANODE:
7659 /*
7660 * check for pcxr types.
7661 */
7662 return p->u.altpin;
7663 default:
7664 break;
7665 }
7666 }
7667
7668 /* If not found, then don't turn on interrupts. */
7669 return 0;
7670 }
7671
7672 /*
7673 * Given a specific type of board, if found, detached link and
7674 * returns the first occurrence in the list.
7675 */
7676 static struct cnode *dgap_find_config(int type, int bus, int slot)
7677 {
7678 struct cnode *p, *prev = NULL, *prev2 = NULL, *found = NULL;
7679
7680 p = &dgap_head;
7681
7682 while (p->next != NULL) {
7683 prev = p;
7684 p = p->next;
7685
7686 if (p->type == BNODE) {
7687
7688 if (p->u.board.type == type) {
7689
7690 if (p->u.board.v_pcibus &&
7691 p->u.board.pcibus != bus)
7692 continue;
7693 if (p->u.board.v_pcislot &&
7694 p->u.board.pcislot != slot)
7695 continue;
7696
7697 found = p;
7698 /*
7699 * Keep walking thru the list till we find the next board.
7700 */
7701 while (p->next != NULL) {
7702 prev2 = p;
7703 p = p->next;
7704 if (p->type == BNODE) {
7705
7706 /*
7707 * Mark the end of our 1 board chain of configs.
7708 */
7709 prev2->next = NULL;
7710
7711 /*
7712 * Link the "next" board to the previous board,
7713 * effectively "unlinking" our board from the main config.
7714 */
7715 prev->next = p;
7716
7717 return found;
7718 }
7719 }
7720 /*
7721 * It must be the last board in the list.
7722 */
7723 prev->next = NULL;
7724 return found;
7725 }
7726 }
7727 }
7728 return NULL;
7729 }
7730
7731 /*
7732 * Given a board pointer, walks the config link, counting up
7733 * all ports user specified should be on the board.
7734 * (This does NOT mean they are all actually present right now tho)
7735 */
7736 static uint dgap_config_get_number_of_ports(struct board_t *bd)
7737 {
7738 int count = 0;
7739 struct cnode *p = NULL;
7740
7741 if (!bd)
7742 return 0;
7743
7744 for (p = bd->bd_config; p; p = p->next) {
7745
7746 switch (p->type) {
7747 case BNODE:
7748 /*
7749 * check for pcxr types.
7750 */
7751 if (p->u.board.type > EPCFE)
7752 count += p->u.board.nport;
7753 break;
7754 case CNODE:
7755 count += p->u.conc.nport;
7756 break;
7757 case MNODE:
7758 count += p->u.module.nport;
7759 break;
7760 }
7761 }
7762 return count;
7763 }
7764
7765 static char *dgap_create_config_string(struct board_t *bd, char *string)
7766 {
7767 char *ptr = string;
7768 struct cnode *p = NULL;
7769 struct cnode *q = NULL;
7770 int speed;
7771
7772 if (!bd) {
7773 *ptr = 0xff;
7774 return string;
7775 }
7776
7777 for (p = bd->bd_config; p; p = p->next) {
7778
7779 switch (p->type) {
7780 case LNODE:
7781 *ptr = '\0';
7782 ptr++;
7783 *ptr = p->u.line.speed;
7784 ptr++;
7785 break;
7786 case CNODE:
7787 /*
7788 * Because the EPC/con concentrators can have EM modules
7789 * hanging off of them, we have to walk ahead in the list
7790 * and keep adding the number of ports on each EM to the config.
7791 * UGH!
7792 */
7793 speed = p->u.conc.speed;
7794 q = p->next;
7795 if ((q != NULL) && (q->type == MNODE)) {
7796 *ptr = (p->u.conc.nport + 0x80);
7797 ptr++;
7798 p = q;
7799 while ((q->next != NULL) && (q->next->type) == MNODE) {
7800 *ptr = (q->u.module.nport + 0x80);
7801 ptr++;
7802 p = q;
7803 q = q->next;
7804 }
7805 *ptr = q->u.module.nport;
7806 ptr++;
7807 } else {
7808 *ptr = p->u.conc.nport;
7809 ptr++;
7810 }
7811
7812 *ptr = speed;
7813 ptr++;
7814 break;
7815 }
7816 }
7817
7818 *ptr = 0xff;
7819 return string;
7820 }
Linux kernel - Deliverables
This page took 0.2539 seconds and 5 git commands to generate.