• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-1.0+
2 /*
3  * Device driver for Microgate SyncLink GT serial adapters.
4  *
5  * written by Paul Fulghum for Microgate Corporation
6  * paulkf@microgate.com
7  *
8  * Microgate and SyncLink are trademarks of Microgate Corporation
9  *
10  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
11  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
12  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
13  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
14  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
15  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
16  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
17  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
18  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
19  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
20  * OF THE POSSIBILITY OF SUCH DAMAGE.
21  */
22 
23 /*
24  * DEBUG OUTPUT DEFINITIONS
25  *
26  * uncomment lines below to enable specific types of debug output
27  *
28  * DBGINFO   information - most verbose output
29  * DBGERR    serious errors
30  * DBGBH     bottom half service routine debugging
31  * DBGISR    interrupt service routine debugging
32  * DBGDATA   output receive and transmit data
33  * DBGTBUF   output transmit DMA buffers and registers
34  * DBGRBUF   output receive DMA buffers and registers
35  */
36 
37 #define DBGINFO(fmt) if (debug_level >= DEBUG_LEVEL_INFO) printk fmt
38 #define DBGERR(fmt) if (debug_level >= DEBUG_LEVEL_ERROR) printk fmt
39 #define DBGBH(fmt) if (debug_level >= DEBUG_LEVEL_BH) printk fmt
40 #define DBGISR(fmt) if (debug_level >= DEBUG_LEVEL_ISR) printk fmt
41 #define DBGDATA(info, buf, size, label) if (debug_level >= DEBUG_LEVEL_DATA) trace_block((info), (buf), (size), (label))
42 /*#define DBGTBUF(info) dump_tbufs(info)*/
43 /*#define DBGRBUF(info) dump_rbufs(info)*/
44 
45 
46 #include <linux/module.h>
47 #include <linux/errno.h>
48 #include <linux/signal.h>
49 #include <linux/sched.h>
50 #include <linux/timer.h>
51 #include <linux/interrupt.h>
52 #include <linux/pci.h>
53 #include <linux/tty.h>
54 #include <linux/tty_flip.h>
55 #include <linux/serial.h>
56 #include <linux/major.h>
57 #include <linux/string.h>
58 #include <linux/fcntl.h>
59 #include <linux/ptrace.h>
60 #include <linux/ioport.h>
61 #include <linux/mm.h>
62 #include <linux/seq_file.h>
63 #include <linux/slab.h>
64 #include <linux/netdevice.h>
65 #include <linux/vmalloc.h>
66 #include <linux/init.h>
67 #include <linux/delay.h>
68 #include <linux/ioctl.h>
69 #include <linux/termios.h>
70 #include <linux/bitops.h>
71 #include <linux/workqueue.h>
72 #include <linux/hdlc.h>
73 #include <linux/synclink.h>
74 
75 #include <asm/io.h>
76 #include <asm/irq.h>
77 #include <asm/dma.h>
78 #include <asm/types.h>
79 #include <linux/uaccess.h>
80 
81 #if defined(CONFIG_HDLC) || (defined(CONFIG_HDLC_MODULE) && defined(CONFIG_SYNCLINK_GT_MODULE))
82 #define SYNCLINK_GENERIC_HDLC 1
83 #else
84 #define SYNCLINK_GENERIC_HDLC 0
85 #endif
86 
87 /*
88  * module identification
89  */
90 static char *driver_name     = "SyncLink GT";
91 static char *slgt_driver_name = "synclink_gt";
92 static char *tty_dev_prefix  = "ttySLG";
93 MODULE_LICENSE("GPL");
94 #define MGSL_MAGIC 0x5401
95 #define MAX_DEVICES 32
96 
97 static const struct pci_device_id pci_table[] = {
98 	{PCI_VENDOR_ID_MICROGATE, SYNCLINK_GT_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
99 	{PCI_VENDOR_ID_MICROGATE, SYNCLINK_GT2_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
100 	{PCI_VENDOR_ID_MICROGATE, SYNCLINK_GT4_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
101 	{PCI_VENDOR_ID_MICROGATE, SYNCLINK_AC_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
102 	{0,}, /* terminate list */
103 };
104 MODULE_DEVICE_TABLE(pci, pci_table);
105 
106 static int  init_one(struct pci_dev *dev,const struct pci_device_id *ent);
107 static void remove_one(struct pci_dev *dev);
108 static struct pci_driver pci_driver = {
109 	.name		= "synclink_gt",
110 	.id_table	= pci_table,
111 	.probe		= init_one,
112 	.remove		= remove_one,
113 };
114 
115 static bool pci_registered;
116 
117 /*
118  * module configuration and status
119  */
120 static struct slgt_info *slgt_device_list;
121 static int slgt_device_count;
122 
123 static int ttymajor;
124 static int debug_level;
125 static int maxframe[MAX_DEVICES];
126 
127 module_param(ttymajor, int, 0);
128 module_param(debug_level, int, 0);
129 module_param_array(maxframe, int, NULL, 0);
130 
131 MODULE_PARM_DESC(ttymajor, "TTY major device number override: 0=auto assigned");
132 MODULE_PARM_DESC(debug_level, "Debug syslog output: 0=disabled, 1 to 5=increasing detail");
133 MODULE_PARM_DESC(maxframe, "Maximum frame size used by device (4096 to 65535)");
134 
135 /*
136  * tty support and callbacks
137  */
138 static struct tty_driver *serial_driver;
139 
140 static void wait_until_sent(struct tty_struct *tty, int timeout);
141 static void flush_buffer(struct tty_struct *tty);
142 static void tx_release(struct tty_struct *tty);
143 
144 /*
145  * generic HDLC support
146  */
147 #define dev_to_port(D) (dev_to_hdlc(D)->priv)
148 
149 
150 /*
151  * device specific structures, macros and functions
152  */
153 
154 #define SLGT_MAX_PORTS 4
155 #define SLGT_REG_SIZE  256
156 
157 /*
158  * conditional wait facility
159  */
160 struct cond_wait {
161 	struct cond_wait *next;
162 	wait_queue_head_t q;
163 	wait_queue_entry_t wait;
164 	unsigned int data;
165 };
166 static void flush_cond_wait(struct cond_wait **head);
167 
168 /*
169  * DMA buffer descriptor and access macros
170  */
171 struct slgt_desc
172 {
173 	__le16 count;
174 	__le16 status;
175 	__le32 pbuf;  /* physical address of data buffer */
176 	__le32 next;  /* physical address of next descriptor */
177 
178 	/* driver book keeping */
179 	char *buf;          /* virtual  address of data buffer */
180     	unsigned int pdesc; /* physical address of this descriptor */
181 	dma_addr_t buf_dma_addr;
182 	unsigned short buf_count;
183 };
184 
185 #define set_desc_buffer(a,b) (a).pbuf = cpu_to_le32((unsigned int)(b))
186 #define set_desc_next(a,b) (a).next   = cpu_to_le32((unsigned int)(b))
187 #define set_desc_count(a,b)(a).count  = cpu_to_le16((unsigned short)(b))
188 #define set_desc_eof(a,b)  (a).status = cpu_to_le16((b) ? (le16_to_cpu((a).status) | BIT0) : (le16_to_cpu((a).status) & ~BIT0))
189 #define set_desc_status(a, b) (a).status = cpu_to_le16((unsigned short)(b))
190 #define desc_count(a)      (le16_to_cpu((a).count))
191 #define desc_status(a)     (le16_to_cpu((a).status))
192 #define desc_complete(a)   (le16_to_cpu((a).status) & BIT15)
193 #define desc_eof(a)        (le16_to_cpu((a).status) & BIT2)
194 #define desc_crc_error(a)  (le16_to_cpu((a).status) & BIT1)
195 #define desc_abort(a)      (le16_to_cpu((a).status) & BIT0)
196 #define desc_residue(a)    ((le16_to_cpu((a).status) & 0x38) >> 3)
197 
198 struct _input_signal_events {
199 	int ri_up;
200 	int ri_down;
201 	int dsr_up;
202 	int dsr_down;
203 	int dcd_up;
204 	int dcd_down;
205 	int cts_up;
206 	int cts_down;
207 };
208 
209 /*
210  * device instance data structure
211  */
212 struct slgt_info {
213 	void *if_ptr;		/* General purpose pointer (used by SPPP) */
214 	struct tty_port port;
215 
216 	struct slgt_info *next_device;	/* device list link */
217 
218 	int magic;
219 
220 	char device_name[25];
221 	struct pci_dev *pdev;
222 
223 	int port_count;  /* count of ports on adapter */
224 	int adapter_num; /* adapter instance number */
225 	int port_num;    /* port instance number */
226 
227 	/* array of pointers to port contexts on this adapter */
228 	struct slgt_info *port_array[SLGT_MAX_PORTS];
229 
230 	int			line;		/* tty line instance number */
231 
232 	struct mgsl_icount	icount;
233 
234 	int			timeout;
235 	int			x_char;		/* xon/xoff character */
236 	unsigned int		read_status_mask;
237 	unsigned int 		ignore_status_mask;
238 
239 	wait_queue_head_t	status_event_wait_q;
240 	wait_queue_head_t	event_wait_q;
241 	struct timer_list	tx_timer;
242 	struct timer_list	rx_timer;
243 
244 	unsigned int            gpio_present;
245 	struct cond_wait        *gpio_wait_q;
246 
247 	spinlock_t lock;	/* spinlock for synchronizing with ISR */
248 
249 	struct work_struct task;
250 	u32 pending_bh;
251 	bool bh_requested;
252 	bool bh_running;
253 
254 	int isr_overflow;
255 	bool irq_requested;	/* true if IRQ requested */
256 	bool irq_occurred;	/* for diagnostics use */
257 
258 	/* device configuration */
259 
260 	unsigned int bus_type;
261 	unsigned int irq_level;
262 	unsigned long irq_flags;
263 
264 	unsigned char __iomem * reg_addr;  /* memory mapped registers address */
265 	u32 phys_reg_addr;
266 	bool reg_addr_requested;
267 
268 	MGSL_PARAMS params;       /* communications parameters */
269 	u32 idle_mode;
270 	u32 max_frame_size;       /* as set by device config */
271 
272 	unsigned int rbuf_fill_level;
273 	unsigned int rx_pio;
274 	unsigned int if_mode;
275 	unsigned int base_clock;
276 	unsigned int xsync;
277 	unsigned int xctrl;
278 
279 	/* device status */
280 
281 	bool rx_enabled;
282 	bool rx_restart;
283 
284 	bool tx_enabled;
285 	bool tx_active;
286 
287 	unsigned char signals;    /* serial signal states */
288 	int init_error;  /* initialization error */
289 
290 	unsigned char *tx_buf;
291 	int tx_count;
292 
293 	char *flag_buf;
294 	bool drop_rts_on_tx_done;
295 	struct	_input_signal_events	input_signal_events;
296 
297 	int dcd_chkcount;	/* check counts to prevent */
298 	int cts_chkcount;	/* too many IRQs if a signal */
299 	int dsr_chkcount;	/* is floating */
300 	int ri_chkcount;
301 
302 	char *bufs;		/* virtual address of DMA buffer lists */
303 	dma_addr_t bufs_dma_addr; /* physical address of buffer descriptors */
304 
305 	unsigned int rbuf_count;
306 	struct slgt_desc *rbufs;
307 	unsigned int rbuf_current;
308 	unsigned int rbuf_index;
309 	unsigned int rbuf_fill_index;
310 	unsigned short rbuf_fill_count;
311 
312 	unsigned int tbuf_count;
313 	struct slgt_desc *tbufs;
314 	unsigned int tbuf_current;
315 	unsigned int tbuf_start;
316 
317 	unsigned char *tmp_rbuf;
318 	unsigned int tmp_rbuf_count;
319 
320 	/* SPPP/Cisco HDLC device parts */
321 
322 	int netcount;
323 	spinlock_t netlock;
324 #if SYNCLINK_GENERIC_HDLC
325 	struct net_device *netdev;
326 #endif
327 
328 };
329 
330 static MGSL_PARAMS default_params = {
331 	.mode            = MGSL_MODE_HDLC,
332 	.loopback        = 0,
333 	.flags           = HDLC_FLAG_UNDERRUN_ABORT15,
334 	.encoding        = HDLC_ENCODING_NRZI_SPACE,
335 	.clock_speed     = 0,
336 	.addr_filter     = 0xff,
337 	.crc_type        = HDLC_CRC_16_CCITT,
338 	.preamble_length = HDLC_PREAMBLE_LENGTH_8BITS,
339 	.preamble        = HDLC_PREAMBLE_PATTERN_NONE,
340 	.data_rate       = 9600,
341 	.data_bits       = 8,
342 	.stop_bits       = 1,
343 	.parity          = ASYNC_PARITY_NONE
344 };
345 
346 
347 #define BH_RECEIVE  1
348 #define BH_TRANSMIT 2
349 #define BH_STATUS   4
350 #define IO_PIN_SHUTDOWN_LIMIT 100
351 
352 #define DMABUFSIZE 256
353 #define DESC_LIST_SIZE 4096
354 
355 #define MASK_PARITY  BIT1
356 #define MASK_FRAMING BIT0
357 #define MASK_BREAK   BIT14
358 #define MASK_OVERRUN BIT4
359 
360 #define GSR   0x00 /* global status */
361 #define JCR   0x04 /* JTAG control */
362 #define IODR  0x08 /* GPIO direction */
363 #define IOER  0x0c /* GPIO interrupt enable */
364 #define IOVR  0x10 /* GPIO value */
365 #define IOSR  0x14 /* GPIO interrupt status */
366 #define TDR   0x80 /* tx data */
367 #define RDR   0x80 /* rx data */
368 #define TCR   0x82 /* tx control */
369 #define TIR   0x84 /* tx idle */
370 #define TPR   0x85 /* tx preamble */
371 #define RCR   0x86 /* rx control */
372 #define VCR   0x88 /* V.24 control */
373 #define CCR   0x89 /* clock control */
374 #define BDR   0x8a /* baud divisor */
375 #define SCR   0x8c /* serial control */
376 #define SSR   0x8e /* serial status */
377 #define RDCSR 0x90 /* rx DMA control/status */
378 #define TDCSR 0x94 /* tx DMA control/status */
379 #define RDDAR 0x98 /* rx DMA descriptor address */
380 #define TDDAR 0x9c /* tx DMA descriptor address */
381 #define XSR   0x40 /* extended sync pattern */
382 #define XCR   0x44 /* extended control */
383 
384 #define RXIDLE      BIT14
385 #define RXBREAK     BIT14
386 #define IRQ_TXDATA  BIT13
387 #define IRQ_TXIDLE  BIT12
388 #define IRQ_TXUNDER BIT11 /* HDLC */
389 #define IRQ_RXDATA  BIT10
390 #define IRQ_RXIDLE  BIT9  /* HDLC */
391 #define IRQ_RXBREAK BIT9  /* async */
392 #define IRQ_RXOVER  BIT8
393 #define IRQ_DSR     BIT7
394 #define IRQ_CTS     BIT6
395 #define IRQ_DCD     BIT5
396 #define IRQ_RI      BIT4
397 #define IRQ_ALL     0x3ff0
398 #define IRQ_MASTER  BIT0
399 
400 #define slgt_irq_on(info, mask) \
401 	wr_reg16((info), SCR, (unsigned short)(rd_reg16((info), SCR) | (mask)))
402 #define slgt_irq_off(info, mask) \
403 	wr_reg16((info), SCR, (unsigned short)(rd_reg16((info), SCR) & ~(mask)))
404 
405 static __u8  rd_reg8(struct slgt_info *info, unsigned int addr);
406 static void  wr_reg8(struct slgt_info *info, unsigned int addr, __u8 value);
407 static __u16 rd_reg16(struct slgt_info *info, unsigned int addr);
408 static void  wr_reg16(struct slgt_info *info, unsigned int addr, __u16 value);
409 static __u32 rd_reg32(struct slgt_info *info, unsigned int addr);
410 static void  wr_reg32(struct slgt_info *info, unsigned int addr, __u32 value);
411 
412 static void  msc_set_vcr(struct slgt_info *info);
413 
414 static int  startup(struct slgt_info *info);
415 static int  block_til_ready(struct tty_struct *tty, struct file * filp,struct slgt_info *info);
416 static void shutdown(struct slgt_info *info);
417 static void program_hw(struct slgt_info *info);
418 static void change_params(struct slgt_info *info);
419 
420 static int  adapter_test(struct slgt_info *info);
421 
422 static void reset_port(struct slgt_info *info);
423 static void async_mode(struct slgt_info *info);
424 static void sync_mode(struct slgt_info *info);
425 
426 static void rx_stop(struct slgt_info *info);
427 static void rx_start(struct slgt_info *info);
428 static void reset_rbufs(struct slgt_info *info);
429 static void free_rbufs(struct slgt_info *info, unsigned int first, unsigned int last);
430 static bool rx_get_frame(struct slgt_info *info);
431 static bool rx_get_buf(struct slgt_info *info);
432 
433 static void tx_start(struct slgt_info *info);
434 static void tx_stop(struct slgt_info *info);
435 static void tx_set_idle(struct slgt_info *info);
436 static unsigned int tbuf_bytes(struct slgt_info *info);
437 static void reset_tbufs(struct slgt_info *info);
438 static void tdma_reset(struct slgt_info *info);
439 static bool tx_load(struct slgt_info *info, const char *buf, unsigned int count);
440 
441 static void get_gtsignals(struct slgt_info *info);
442 static void set_gtsignals(struct slgt_info *info);
443 static void set_rate(struct slgt_info *info, u32 data_rate);
444 
445 static void bh_transmit(struct slgt_info *info);
446 static void isr_txeom(struct slgt_info *info, unsigned short status);
447 
448 static void tx_timeout(struct timer_list *t);
449 static void rx_timeout(struct timer_list *t);
450 
451 /*
452  * ioctl handlers
453  */
454 static int  get_stats(struct slgt_info *info, struct mgsl_icount __user *user_icount);
455 static int  get_params(struct slgt_info *info, MGSL_PARAMS __user *params);
456 static int  set_params(struct slgt_info *info, MGSL_PARAMS __user *params);
457 static int  get_txidle(struct slgt_info *info, int __user *idle_mode);
458 static int  set_txidle(struct slgt_info *info, int idle_mode);
459 static int  tx_enable(struct slgt_info *info, int enable);
460 static int  tx_abort(struct slgt_info *info);
461 static int  rx_enable(struct slgt_info *info, int enable);
462 static int  modem_input_wait(struct slgt_info *info,int arg);
463 static int  wait_mgsl_event(struct slgt_info *info, int __user *mask_ptr);
464 static int  get_interface(struct slgt_info *info, int __user *if_mode);
465 static int  set_interface(struct slgt_info *info, int if_mode);
466 static int  set_gpio(struct slgt_info *info, struct gpio_desc __user *gpio);
467 static int  get_gpio(struct slgt_info *info, struct gpio_desc __user *gpio);
468 static int  wait_gpio(struct slgt_info *info, struct gpio_desc __user *gpio);
469 static int  get_xsync(struct slgt_info *info, int __user *if_mode);
470 static int  set_xsync(struct slgt_info *info, int if_mode);
471 static int  get_xctrl(struct slgt_info *info, int __user *if_mode);
472 static int  set_xctrl(struct slgt_info *info, int if_mode);
473 
474 /*
475  * driver functions
476  */
477 static void release_resources(struct slgt_info *info);
478 
479 /*
480  * DEBUG OUTPUT CODE
481  */
482 #ifndef DBGINFO
483 #define DBGINFO(fmt)
484 #endif
485 #ifndef DBGERR
486 #define DBGERR(fmt)
487 #endif
488 #ifndef DBGBH
489 #define DBGBH(fmt)
490 #endif
491 #ifndef DBGISR
492 #define DBGISR(fmt)
493 #endif
494 
495 #ifdef DBGDATA
trace_block(struct slgt_info * info,const char * data,int count,const char * label)496 static void trace_block(struct slgt_info *info, const char *data, int count, const char *label)
497 {
498 	int i;
499 	int linecount;
500 	printk("%s %s data:\n",info->device_name, label);
501 	while(count) {
502 		linecount = (count > 16) ? 16 : count;
503 		for(i=0; i < linecount; i++)
504 			printk("%02X ",(unsigned char)data[i]);
505 		for(;i<17;i++)
506 			printk("   ");
507 		for(i=0;i<linecount;i++) {
508 			if (data[i]>=040 && data[i]<=0176)
509 				printk("%c",data[i]);
510 			else
511 				printk(".");
512 		}
513 		printk("\n");
514 		data  += linecount;
515 		count -= linecount;
516 	}
517 }
518 #else
519 #define DBGDATA(info, buf, size, label)
520 #endif
521 
522 #ifdef DBGTBUF
dump_tbufs(struct slgt_info * info)523 static void dump_tbufs(struct slgt_info *info)
524 {
525 	int i;
526 	printk("tbuf_current=%d\n", info->tbuf_current);
527 	for (i=0 ; i < info->tbuf_count ; i++) {
528 		printk("%d: count=%04X status=%04X\n",
529 			i, le16_to_cpu(info->tbufs[i].count), le16_to_cpu(info->tbufs[i].status));
530 	}
531 }
532 #else
533 #define DBGTBUF(info)
534 #endif
535 
536 #ifdef DBGRBUF
dump_rbufs(struct slgt_info * info)537 static void dump_rbufs(struct slgt_info *info)
538 {
539 	int i;
540 	printk("rbuf_current=%d\n", info->rbuf_current);
541 	for (i=0 ; i < info->rbuf_count ; i++) {
542 		printk("%d: count=%04X status=%04X\n",
543 			i, le16_to_cpu(info->rbufs[i].count), le16_to_cpu(info->rbufs[i].status));
544 	}
545 }
546 #else
547 #define DBGRBUF(info)
548 #endif
549 
sanity_check(struct slgt_info * info,char * devname,const char * name)550 static inline int sanity_check(struct slgt_info *info, char *devname, const char *name)
551 {
552 #ifdef SANITY_CHECK
553 	if (!info) {
554 		printk("null struct slgt_info for (%s) in %s\n", devname, name);
555 		return 1;
556 	}
557 	if (info->magic != MGSL_MAGIC) {
558 		printk("bad magic number struct slgt_info (%s) in %s\n", devname, name);
559 		return 1;
560 	}
561 #else
562 	if (!info)
563 		return 1;
564 #endif
565 	return 0;
566 }
567 
568 /**
569  * line discipline callback wrappers
570  *
571  * The wrappers maintain line discipline references
572  * while calling into the line discipline.
573  *
574  * ldisc_receive_buf  - pass receive data to line discipline
575  */
ldisc_receive_buf(struct tty_struct * tty,const __u8 * data,char * flags,int count)576 static void ldisc_receive_buf(struct tty_struct *tty,
577 			      const __u8 *data, char *flags, int count)
578 {
579 	struct tty_ldisc *ld;
580 	if (!tty)
581 		return;
582 	ld = tty_ldisc_ref(tty);
583 	if (ld) {
584 		if (ld->ops->receive_buf)
585 			ld->ops->receive_buf(tty, data, flags, count);
586 		tty_ldisc_deref(ld);
587 	}
588 }
589 
590 /* tty callbacks */
591 
open(struct tty_struct * tty,struct file * filp)592 static int open(struct tty_struct *tty, struct file *filp)
593 {
594 	struct slgt_info *info;
595 	int retval, line;
596 	unsigned long flags;
597 
598 	line = tty->index;
599 	if (line >= slgt_device_count) {
600 		DBGERR(("%s: open with invalid line #%d.\n", driver_name, line));
601 		return -ENODEV;
602 	}
603 
604 	info = slgt_device_list;
605 	while(info && info->line != line)
606 		info = info->next_device;
607 	if (sanity_check(info, tty->name, "open"))
608 		return -ENODEV;
609 	if (info->init_error) {
610 		DBGERR(("%s init error=%d\n", info->device_name, info->init_error));
611 		return -ENODEV;
612 	}
613 
614 	tty->driver_data = info;
615 	info->port.tty = tty;
616 
617 	DBGINFO(("%s open, old ref count = %d\n", info->device_name, info->port.count));
618 
619 	mutex_lock(&info->port.mutex);
620 	info->port.low_latency = (info->port.flags & ASYNC_LOW_LATENCY) ? 1 : 0;
621 
622 	spin_lock_irqsave(&info->netlock, flags);
623 	if (info->netcount) {
624 		retval = -EBUSY;
625 		spin_unlock_irqrestore(&info->netlock, flags);
626 		mutex_unlock(&info->port.mutex);
627 		goto cleanup;
628 	}
629 	info->port.count++;
630 	spin_unlock_irqrestore(&info->netlock, flags);
631 
632 	if (info->port.count == 1) {
633 		/* 1st open on this device, init hardware */
634 		retval = startup(info);
635 		if (retval < 0) {
636 			mutex_unlock(&info->port.mutex);
637 			goto cleanup;
638 		}
639 	}
640 	mutex_unlock(&info->port.mutex);
641 	retval = block_til_ready(tty, filp, info);
642 	if (retval) {
643 		DBGINFO(("%s block_til_ready rc=%d\n", info->device_name, retval));
644 		goto cleanup;
645 	}
646 
647 	retval = 0;
648 
649 cleanup:
650 	if (retval) {
651 		if (tty->count == 1)
652 			info->port.tty = NULL; /* tty layer will release tty struct */
653 		if(info->port.count)
654 			info->port.count--;
655 	}
656 
657 	DBGINFO(("%s open rc=%d\n", info->device_name, retval));
658 	return retval;
659 }
660 
close(struct tty_struct * tty,struct file * filp)661 static void close(struct tty_struct *tty, struct file *filp)
662 {
663 	struct slgt_info *info = tty->driver_data;
664 
665 	if (sanity_check(info, tty->name, "close"))
666 		return;
667 	DBGINFO(("%s close entry, count=%d\n", info->device_name, info->port.count));
668 
669 	if (tty_port_close_start(&info->port, tty, filp) == 0)
670 		goto cleanup;
671 
672 	mutex_lock(&info->port.mutex);
673 	if (tty_port_initialized(&info->port))
674  		wait_until_sent(tty, info->timeout);
675 	flush_buffer(tty);
676 	tty_ldisc_flush(tty);
677 
678 	shutdown(info);
679 	mutex_unlock(&info->port.mutex);
680 
681 	tty_port_close_end(&info->port, tty);
682 	info->port.tty = NULL;
683 cleanup:
684 	DBGINFO(("%s close exit, count=%d\n", tty->driver->name, info->port.count));
685 }
686 
hangup(struct tty_struct * tty)687 static void hangup(struct tty_struct *tty)
688 {
689 	struct slgt_info *info = tty->driver_data;
690 	unsigned long flags;
691 
692 	if (sanity_check(info, tty->name, "hangup"))
693 		return;
694 	DBGINFO(("%s hangup\n", info->device_name));
695 
696 	flush_buffer(tty);
697 
698 	mutex_lock(&info->port.mutex);
699 	shutdown(info);
700 
701 	spin_lock_irqsave(&info->port.lock, flags);
702 	info->port.count = 0;
703 	info->port.tty = NULL;
704 	spin_unlock_irqrestore(&info->port.lock, flags);
705 	tty_port_set_active(&info->port, 0);
706 	mutex_unlock(&info->port.mutex);
707 
708 	wake_up_interruptible(&info->port.open_wait);
709 }
710 
set_termios(struct tty_struct * tty,struct ktermios * old_termios)711 static void set_termios(struct tty_struct *tty, struct ktermios *old_termios)
712 {
713 	struct slgt_info *info = tty->driver_data;
714 	unsigned long flags;
715 
716 	DBGINFO(("%s set_termios\n", tty->driver->name));
717 
718 	change_params(info);
719 
720 	/* Handle transition to B0 status */
721 	if ((old_termios->c_cflag & CBAUD) && !C_BAUD(tty)) {
722 		info->signals &= ~(SerialSignal_RTS | SerialSignal_DTR);
723 		spin_lock_irqsave(&info->lock,flags);
724 		set_gtsignals(info);
725 		spin_unlock_irqrestore(&info->lock,flags);
726 	}
727 
728 	/* Handle transition away from B0 status */
729 	if (!(old_termios->c_cflag & CBAUD) && C_BAUD(tty)) {
730 		info->signals |= SerialSignal_DTR;
731 		if (!C_CRTSCTS(tty) || !tty_throttled(tty))
732 			info->signals |= SerialSignal_RTS;
733 		spin_lock_irqsave(&info->lock,flags);
734 	 	set_gtsignals(info);
735 		spin_unlock_irqrestore(&info->lock,flags);
736 	}
737 
738 	/* Handle turning off CRTSCTS */
739 	if ((old_termios->c_cflag & CRTSCTS) && !C_CRTSCTS(tty)) {
740 		tty->hw_stopped = 0;
741 		tx_release(tty);
742 	}
743 }
744 
update_tx_timer(struct slgt_info * info)745 static void update_tx_timer(struct slgt_info *info)
746 {
747 	/*
748 	 * use worst case speed of 1200bps to calculate transmit timeout
749 	 * based on data in buffers (tbuf_bytes) and FIFO (128 bytes)
750 	 */
751 	if (info->params.mode == MGSL_MODE_HDLC) {
752 		int timeout  = (tbuf_bytes(info) * 7) + 1000;
753 		mod_timer(&info->tx_timer, jiffies + msecs_to_jiffies(timeout));
754 	}
755 }
756 
write(struct tty_struct * tty,const unsigned char * buf,int count)757 static int write(struct tty_struct *tty,
758 		 const unsigned char *buf, int count)
759 {
760 	int ret = 0;
761 	struct slgt_info *info = tty->driver_data;
762 	unsigned long flags;
763 
764 	if (sanity_check(info, tty->name, "write"))
765 		return -EIO;
766 
767 	DBGINFO(("%s write count=%d\n", info->device_name, count));
768 
769 	if (!info->tx_buf || (count > info->max_frame_size))
770 		return -EIO;
771 
772 	if (!count || tty->stopped || tty->hw_stopped)
773 		return 0;
774 
775 	spin_lock_irqsave(&info->lock, flags);
776 
777 	if (info->tx_count) {
778 		/* send accumulated data from send_char() */
779 		if (!tx_load(info, info->tx_buf, info->tx_count))
780 			goto cleanup;
781 		info->tx_count = 0;
782 	}
783 
784 	if (tx_load(info, buf, count))
785 		ret = count;
786 
787 cleanup:
788 	spin_unlock_irqrestore(&info->lock, flags);
789 	DBGINFO(("%s write rc=%d\n", info->device_name, ret));
790 	return ret;
791 }
792 
put_char(struct tty_struct * tty,unsigned char ch)793 static int put_char(struct tty_struct *tty, unsigned char ch)
794 {
795 	struct slgt_info *info = tty->driver_data;
796 	unsigned long flags;
797 	int ret = 0;
798 
799 	if (sanity_check(info, tty->name, "put_char"))
800 		return 0;
801 	DBGINFO(("%s put_char(%d)\n", info->device_name, ch));
802 	if (!info->tx_buf)
803 		return 0;
804 	spin_lock_irqsave(&info->lock,flags);
805 	if (info->tx_count < info->max_frame_size) {
806 		info->tx_buf[info->tx_count++] = ch;
807 		ret = 1;
808 	}
809 	spin_unlock_irqrestore(&info->lock,flags);
810 	return ret;
811 }
812 
send_xchar(struct tty_struct * tty,char ch)813 static void send_xchar(struct tty_struct *tty, char ch)
814 {
815 	struct slgt_info *info = tty->driver_data;
816 	unsigned long flags;
817 
818 	if (sanity_check(info, tty->name, "send_xchar"))
819 		return;
820 	DBGINFO(("%s send_xchar(%d)\n", info->device_name, ch));
821 	info->x_char = ch;
822 	if (ch) {
823 		spin_lock_irqsave(&info->lock,flags);
824 		if (!info->tx_enabled)
825 		 	tx_start(info);
826 		spin_unlock_irqrestore(&info->lock,flags);
827 	}
828 }
829 
wait_until_sent(struct tty_struct * tty,int timeout)830 static void wait_until_sent(struct tty_struct *tty, int timeout)
831 {
832 	struct slgt_info *info = tty->driver_data;
833 	unsigned long orig_jiffies, char_time;
834 
835 	if (!info )
836 		return;
837 	if (sanity_check(info, tty->name, "wait_until_sent"))
838 		return;
839 	DBGINFO(("%s wait_until_sent entry\n", info->device_name));
840 	if (!tty_port_initialized(&info->port))
841 		goto exit;
842 
843 	orig_jiffies = jiffies;
844 
845 	/* Set check interval to 1/5 of estimated time to
846 	 * send a character, and make it at least 1. The check
847 	 * interval should also be less than the timeout.
848 	 * Note: use tight timings here to satisfy the NIST-PCTS.
849 	 */
850 
851 	if (info->params.data_rate) {
852 	       	char_time = info->timeout/(32 * 5);
853 		if (!char_time)
854 			char_time++;
855 	} else
856 		char_time = 1;
857 
858 	if (timeout)
859 		char_time = min_t(unsigned long, char_time, timeout);
860 
861 	while (info->tx_active) {
862 		msleep_interruptible(jiffies_to_msecs(char_time));
863 		if (signal_pending(current))
864 			break;
865 		if (timeout && time_after(jiffies, orig_jiffies + timeout))
866 			break;
867 	}
868 exit:
869 	DBGINFO(("%s wait_until_sent exit\n", info->device_name));
870 }
871 
write_room(struct tty_struct * tty)872 static int write_room(struct tty_struct *tty)
873 {
874 	struct slgt_info *info = tty->driver_data;
875 	int ret;
876 
877 	if (sanity_check(info, tty->name, "write_room"))
878 		return 0;
879 	ret = (info->tx_active) ? 0 : HDLC_MAX_FRAME_SIZE;
880 	DBGINFO(("%s write_room=%d\n", info->device_name, ret));
881 	return ret;
882 }
883 
flush_chars(struct tty_struct * tty)884 static void flush_chars(struct tty_struct *tty)
885 {
886 	struct slgt_info *info = tty->driver_data;
887 	unsigned long flags;
888 
889 	if (sanity_check(info, tty->name, "flush_chars"))
890 		return;
891 	DBGINFO(("%s flush_chars entry tx_count=%d\n", info->device_name, info->tx_count));
892 
893 	if (info->tx_count <= 0 || tty->stopped ||
894 	    tty->hw_stopped || !info->tx_buf)
895 		return;
896 
897 	DBGINFO(("%s flush_chars start transmit\n", info->device_name));
898 
899 	spin_lock_irqsave(&info->lock,flags);
900 	if (info->tx_count && tx_load(info, info->tx_buf, info->tx_count))
901 		info->tx_count = 0;
902 	spin_unlock_irqrestore(&info->lock,flags);
903 }
904 
flush_buffer(struct tty_struct * tty)905 static void flush_buffer(struct tty_struct *tty)
906 {
907 	struct slgt_info *info = tty->driver_data;
908 	unsigned long flags;
909 
910 	if (sanity_check(info, tty->name, "flush_buffer"))
911 		return;
912 	DBGINFO(("%s flush_buffer\n", info->device_name));
913 
914 	spin_lock_irqsave(&info->lock, flags);
915 	info->tx_count = 0;
916 	spin_unlock_irqrestore(&info->lock, flags);
917 
918 	tty_wakeup(tty);
919 }
920 
921 /*
922  * throttle (stop) transmitter
923  */
tx_hold(struct tty_struct * tty)924 static void tx_hold(struct tty_struct *tty)
925 {
926 	struct slgt_info *info = tty->driver_data;
927 	unsigned long flags;
928 
929 	if (sanity_check(info, tty->name, "tx_hold"))
930 		return;
931 	DBGINFO(("%s tx_hold\n", info->device_name));
932 	spin_lock_irqsave(&info->lock,flags);
933 	if (info->tx_enabled && info->params.mode == MGSL_MODE_ASYNC)
934 	 	tx_stop(info);
935 	spin_unlock_irqrestore(&info->lock,flags);
936 }
937 
938 /*
939  * release (start) transmitter
940  */
tx_release(struct tty_struct * tty)941 static void tx_release(struct tty_struct *tty)
942 {
943 	struct slgt_info *info = tty->driver_data;
944 	unsigned long flags;
945 
946 	if (sanity_check(info, tty->name, "tx_release"))
947 		return;
948 	DBGINFO(("%s tx_release\n", info->device_name));
949 	spin_lock_irqsave(&info->lock, flags);
950 	if (info->tx_count && tx_load(info, info->tx_buf, info->tx_count))
951 		info->tx_count = 0;
952 	spin_unlock_irqrestore(&info->lock, flags);
953 }
954 
955 /*
956  * Service an IOCTL request
957  *
958  * Arguments
959  *
960  * 	tty	pointer to tty instance data
961  * 	cmd	IOCTL command code
962  * 	arg	command argument/context
963  *
964  * Return 0 if success, otherwise error code
965  */
ioctl(struct tty_struct * tty,unsigned int cmd,unsigned long arg)966 static int ioctl(struct tty_struct *tty,
967 		 unsigned int cmd, unsigned long arg)
968 {
969 	struct slgt_info *info = tty->driver_data;
970 	void __user *argp = (void __user *)arg;
971 	int ret;
972 
973 	if (sanity_check(info, tty->name, "ioctl"))
974 		return -ENODEV;
975 	DBGINFO(("%s ioctl() cmd=%08X\n", info->device_name, cmd));
976 
977 	if (cmd != TIOCMIWAIT) {
978 		if (tty_io_error(tty))
979 		    return -EIO;
980 	}
981 
982 	switch (cmd) {
983 	case MGSL_IOCWAITEVENT:
984 		return wait_mgsl_event(info, argp);
985 	case TIOCMIWAIT:
986 		return modem_input_wait(info,(int)arg);
987 	case MGSL_IOCSGPIO:
988 		return set_gpio(info, argp);
989 	case MGSL_IOCGGPIO:
990 		return get_gpio(info, argp);
991 	case MGSL_IOCWAITGPIO:
992 		return wait_gpio(info, argp);
993 	case MGSL_IOCGXSYNC:
994 		return get_xsync(info, argp);
995 	case MGSL_IOCSXSYNC:
996 		return set_xsync(info, (int)arg);
997 	case MGSL_IOCGXCTRL:
998 		return get_xctrl(info, argp);
999 	case MGSL_IOCSXCTRL:
1000 		return set_xctrl(info, (int)arg);
1001 	}
1002 	mutex_lock(&info->port.mutex);
1003 	switch (cmd) {
1004 	case MGSL_IOCGPARAMS:
1005 		ret = get_params(info, argp);
1006 		break;
1007 	case MGSL_IOCSPARAMS:
1008 		ret = set_params(info, argp);
1009 		break;
1010 	case MGSL_IOCGTXIDLE:
1011 		ret = get_txidle(info, argp);
1012 		break;
1013 	case MGSL_IOCSTXIDLE:
1014 		ret = set_txidle(info, (int)arg);
1015 		break;
1016 	case MGSL_IOCTXENABLE:
1017 		ret = tx_enable(info, (int)arg);
1018 		break;
1019 	case MGSL_IOCRXENABLE:
1020 		ret = rx_enable(info, (int)arg);
1021 		break;
1022 	case MGSL_IOCTXABORT:
1023 		ret = tx_abort(info);
1024 		break;
1025 	case MGSL_IOCGSTATS:
1026 		ret = get_stats(info, argp);
1027 		break;
1028 	case MGSL_IOCGIF:
1029 		ret = get_interface(info, argp);
1030 		break;
1031 	case MGSL_IOCSIF:
1032 		ret = set_interface(info,(int)arg);
1033 		break;
1034 	default:
1035 		ret = -ENOIOCTLCMD;
1036 	}
1037 	mutex_unlock(&info->port.mutex);
1038 	return ret;
1039 }
1040 
get_icount(struct tty_struct * tty,struct serial_icounter_struct * icount)1041 static int get_icount(struct tty_struct *tty,
1042 				struct serial_icounter_struct *icount)
1043 
1044 {
1045 	struct slgt_info *info = tty->driver_data;
1046 	struct mgsl_icount cnow;	/* kernel counter temps */
1047 	unsigned long flags;
1048 
1049 	spin_lock_irqsave(&info->lock,flags);
1050 	cnow = info->icount;
1051 	spin_unlock_irqrestore(&info->lock,flags);
1052 
1053 	icount->cts = cnow.cts;
1054 	icount->dsr = cnow.dsr;
1055 	icount->rng = cnow.rng;
1056 	icount->dcd = cnow.dcd;
1057 	icount->rx = cnow.rx;
1058 	icount->tx = cnow.tx;
1059 	icount->frame = cnow.frame;
1060 	icount->overrun = cnow.overrun;
1061 	icount->parity = cnow.parity;
1062 	icount->brk = cnow.brk;
1063 	icount->buf_overrun = cnow.buf_overrun;
1064 
1065 	return 0;
1066 }
1067 
1068 /*
1069  * support for 32 bit ioctl calls on 64 bit systems
1070  */
1071 #ifdef CONFIG_COMPAT
get_params32(struct slgt_info * info,struct MGSL_PARAMS32 __user * user_params)1072 static long get_params32(struct slgt_info *info, struct MGSL_PARAMS32 __user *user_params)
1073 {
1074 	struct MGSL_PARAMS32 tmp_params;
1075 
1076 	DBGINFO(("%s get_params32\n", info->device_name));
1077 	memset(&tmp_params, 0, sizeof(tmp_params));
1078 	tmp_params.mode            = (compat_ulong_t)info->params.mode;
1079 	tmp_params.loopback        = info->params.loopback;
1080 	tmp_params.flags           = info->params.flags;
1081 	tmp_params.encoding        = info->params.encoding;
1082 	tmp_params.clock_speed     = (compat_ulong_t)info->params.clock_speed;
1083 	tmp_params.addr_filter     = info->params.addr_filter;
1084 	tmp_params.crc_type        = info->params.crc_type;
1085 	tmp_params.preamble_length = info->params.preamble_length;
1086 	tmp_params.preamble        = info->params.preamble;
1087 	tmp_params.data_rate       = (compat_ulong_t)info->params.data_rate;
1088 	tmp_params.data_bits       = info->params.data_bits;
1089 	tmp_params.stop_bits       = info->params.stop_bits;
1090 	tmp_params.parity          = info->params.parity;
1091 	if (copy_to_user(user_params, &tmp_params, sizeof(struct MGSL_PARAMS32)))
1092 		return -EFAULT;
1093 	return 0;
1094 }
1095 
set_params32(struct slgt_info * info,struct MGSL_PARAMS32 __user * new_params)1096 static long set_params32(struct slgt_info *info, struct MGSL_PARAMS32 __user *new_params)
1097 {
1098 	struct MGSL_PARAMS32 tmp_params;
1099 
1100 	DBGINFO(("%s set_params32\n", info->device_name));
1101 	if (copy_from_user(&tmp_params, new_params, sizeof(struct MGSL_PARAMS32)))
1102 		return -EFAULT;
1103 
1104 	spin_lock(&info->lock);
1105 	if (tmp_params.mode == MGSL_MODE_BASE_CLOCK) {
1106 		info->base_clock = tmp_params.clock_speed;
1107 	} else {
1108 		info->params.mode            = tmp_params.mode;
1109 		info->params.loopback        = tmp_params.loopback;
1110 		info->params.flags           = tmp_params.flags;
1111 		info->params.encoding        = tmp_params.encoding;
1112 		info->params.clock_speed     = tmp_params.clock_speed;
1113 		info->params.addr_filter     = tmp_params.addr_filter;
1114 		info->params.crc_type        = tmp_params.crc_type;
1115 		info->params.preamble_length = tmp_params.preamble_length;
1116 		info->params.preamble        = tmp_params.preamble;
1117 		info->params.data_rate       = tmp_params.data_rate;
1118 		info->params.data_bits       = tmp_params.data_bits;
1119 		info->params.stop_bits       = tmp_params.stop_bits;
1120 		info->params.parity          = tmp_params.parity;
1121 	}
1122 	spin_unlock(&info->lock);
1123 
1124 	program_hw(info);
1125 
1126 	return 0;
1127 }
1128 
slgt_compat_ioctl(struct tty_struct * tty,unsigned int cmd,unsigned long arg)1129 static long slgt_compat_ioctl(struct tty_struct *tty,
1130 			 unsigned int cmd, unsigned long arg)
1131 {
1132 	struct slgt_info *info = tty->driver_data;
1133 	int rc;
1134 
1135 	if (sanity_check(info, tty->name, "compat_ioctl"))
1136 		return -ENODEV;
1137 	DBGINFO(("%s compat_ioctl() cmd=%08X\n", info->device_name, cmd));
1138 
1139 	switch (cmd) {
1140 	case MGSL_IOCSPARAMS32:
1141 		rc = set_params32(info, compat_ptr(arg));
1142 		break;
1143 
1144 	case MGSL_IOCGPARAMS32:
1145 		rc = get_params32(info, compat_ptr(arg));
1146 		break;
1147 
1148 	case MGSL_IOCGPARAMS:
1149 	case MGSL_IOCSPARAMS:
1150 	case MGSL_IOCGTXIDLE:
1151 	case MGSL_IOCGSTATS:
1152 	case MGSL_IOCWAITEVENT:
1153 	case MGSL_IOCGIF:
1154 	case MGSL_IOCSGPIO:
1155 	case MGSL_IOCGGPIO:
1156 	case MGSL_IOCWAITGPIO:
1157 	case MGSL_IOCGXSYNC:
1158 	case MGSL_IOCGXCTRL:
1159 		rc = ioctl(tty, cmd, (unsigned long)compat_ptr(arg));
1160 		break;
1161 	default:
1162 		rc = ioctl(tty, cmd, arg);
1163 	}
1164 	DBGINFO(("%s compat_ioctl() cmd=%08X rc=%d\n", info->device_name, cmd, rc));
1165 	return rc;
1166 }
1167 #else
1168 #define slgt_compat_ioctl NULL
1169 #endif /* ifdef CONFIG_COMPAT */
1170 
1171 /*
1172  * proc fs support
1173  */
line_info(struct seq_file * m,struct slgt_info * info)1174 static inline void line_info(struct seq_file *m, struct slgt_info *info)
1175 {
1176 	char stat_buf[30];
1177 	unsigned long flags;
1178 
1179 	seq_printf(m, "%s: IO=%08X IRQ=%d MaxFrameSize=%u\n",
1180 		      info->device_name, info->phys_reg_addr,
1181 		      info->irq_level, info->max_frame_size);
1182 
1183 	/* output current serial signal states */
1184 	spin_lock_irqsave(&info->lock,flags);
1185 	get_gtsignals(info);
1186 	spin_unlock_irqrestore(&info->lock,flags);
1187 
1188 	stat_buf[0] = 0;
1189 	stat_buf[1] = 0;
1190 	if (info->signals & SerialSignal_RTS)
1191 		strcat(stat_buf, "|RTS");
1192 	if (info->signals & SerialSignal_CTS)
1193 		strcat(stat_buf, "|CTS");
1194 	if (info->signals & SerialSignal_DTR)
1195 		strcat(stat_buf, "|DTR");
1196 	if (info->signals & SerialSignal_DSR)
1197 		strcat(stat_buf, "|DSR");
1198 	if (info->signals & SerialSignal_DCD)
1199 		strcat(stat_buf, "|CD");
1200 	if (info->signals & SerialSignal_RI)
1201 		strcat(stat_buf, "|RI");
1202 
1203 	if (info->params.mode != MGSL_MODE_ASYNC) {
1204 		seq_printf(m, "\tHDLC txok:%d rxok:%d",
1205 			       info->icount.txok, info->icount.rxok);
1206 		if (info->icount.txunder)
1207 			seq_printf(m, " txunder:%d", info->icount.txunder);
1208 		if (info->icount.txabort)
1209 			seq_printf(m, " txabort:%d", info->icount.txabort);
1210 		if (info->icount.rxshort)
1211 			seq_printf(m, " rxshort:%d", info->icount.rxshort);
1212 		if (info->icount.rxlong)
1213 			seq_printf(m, " rxlong:%d", info->icount.rxlong);
1214 		if (info->icount.rxover)
1215 			seq_printf(m, " rxover:%d", info->icount.rxover);
1216 		if (info->icount.rxcrc)
1217 			seq_printf(m, " rxcrc:%d", info->icount.rxcrc);
1218 	} else {
1219 		seq_printf(m, "\tASYNC tx:%d rx:%d",
1220 			       info->icount.tx, info->icount.rx);
1221 		if (info->icount.frame)
1222 			seq_printf(m, " fe:%d", info->icount.frame);
1223 		if (info->icount.parity)
1224 			seq_printf(m, " pe:%d", info->icount.parity);
1225 		if (info->icount.brk)
1226 			seq_printf(m, " brk:%d", info->icount.brk);
1227 		if (info->icount.overrun)
1228 			seq_printf(m, " oe:%d", info->icount.overrun);
1229 	}
1230 
1231 	/* Append serial signal status to end */
1232 	seq_printf(m, " %s\n", stat_buf+1);
1233 
1234 	seq_printf(m, "\ttxactive=%d bh_req=%d bh_run=%d pending_bh=%x\n",
1235 		       info->tx_active,info->bh_requested,info->bh_running,
1236 		       info->pending_bh);
1237 }
1238 
1239 /* Called to print information about devices
1240  */
synclink_gt_proc_show(struct seq_file * m,void * v)1241 static int synclink_gt_proc_show(struct seq_file *m, void *v)
1242 {
1243 	struct slgt_info *info;
1244 
1245 	seq_puts(m, "synclink_gt driver\n");
1246 
1247 	info = slgt_device_list;
1248 	while( info ) {
1249 		line_info(m, info);
1250 		info = info->next_device;
1251 	}
1252 	return 0;
1253 }
1254 
1255 /*
1256  * return count of bytes in transmit buffer
1257  */
chars_in_buffer(struct tty_struct * tty)1258 static int chars_in_buffer(struct tty_struct *tty)
1259 {
1260 	struct slgt_info *info = tty->driver_data;
1261 	int count;
1262 	if (sanity_check(info, tty->name, "chars_in_buffer"))
1263 		return 0;
1264 	count = tbuf_bytes(info);
1265 	DBGINFO(("%s chars_in_buffer()=%d\n", info->device_name, count));
1266 	return count;
1267 }
1268 
1269 /*
1270  * signal remote device to throttle send data (our receive data)
1271  */
throttle(struct tty_struct * tty)1272 static void throttle(struct tty_struct * tty)
1273 {
1274 	struct slgt_info *info = tty->driver_data;
1275 	unsigned long flags;
1276 
1277 	if (sanity_check(info, tty->name, "throttle"))
1278 		return;
1279 	DBGINFO(("%s throttle\n", info->device_name));
1280 	if (I_IXOFF(tty))
1281 		send_xchar(tty, STOP_CHAR(tty));
1282 	if (C_CRTSCTS(tty)) {
1283 		spin_lock_irqsave(&info->lock,flags);
1284 		info->signals &= ~SerialSignal_RTS;
1285 		set_gtsignals(info);
1286 		spin_unlock_irqrestore(&info->lock,flags);
1287 	}
1288 }
1289 
1290 /*
1291  * signal remote device to stop throttling send data (our receive data)
1292  */
unthrottle(struct tty_struct * tty)1293 static void unthrottle(struct tty_struct * tty)
1294 {
1295 	struct slgt_info *info = tty->driver_data;
1296 	unsigned long flags;
1297 
1298 	if (sanity_check(info, tty->name, "unthrottle"))
1299 		return;
1300 	DBGINFO(("%s unthrottle\n", info->device_name));
1301 	if (I_IXOFF(tty)) {
1302 		if (info->x_char)
1303 			info->x_char = 0;
1304 		else
1305 			send_xchar(tty, START_CHAR(tty));
1306 	}
1307 	if (C_CRTSCTS(tty)) {
1308 		spin_lock_irqsave(&info->lock,flags);
1309 		info->signals |= SerialSignal_RTS;
1310 		set_gtsignals(info);
1311 		spin_unlock_irqrestore(&info->lock,flags);
1312 	}
1313 }
1314 
1315 /*
1316  * set or clear transmit break condition
1317  * break_state	-1=set break condition, 0=clear
1318  */
set_break(struct tty_struct * tty,int break_state)1319 static int set_break(struct tty_struct *tty, int break_state)
1320 {
1321 	struct slgt_info *info = tty->driver_data;
1322 	unsigned short value;
1323 	unsigned long flags;
1324 
1325 	if (sanity_check(info, tty->name, "set_break"))
1326 		return -EINVAL;
1327 	DBGINFO(("%s set_break(%d)\n", info->device_name, break_state));
1328 
1329 	spin_lock_irqsave(&info->lock,flags);
1330 	value = rd_reg16(info, TCR);
1331  	if (break_state == -1)
1332 		value |= BIT6;
1333 	else
1334 		value &= ~BIT6;
1335 	wr_reg16(info, TCR, value);
1336 	spin_unlock_irqrestore(&info->lock,flags);
1337 	return 0;
1338 }
1339 
1340 #if SYNCLINK_GENERIC_HDLC
1341 
1342 /**
1343  * hdlcdev_attach - called by generic HDLC layer when protocol selected (PPP, frame relay, etc.)
1344  * @dev:      pointer to network device structure
1345  * @encoding: serial encoding setting
1346  * @parity:   FCS setting
1347  *
1348  * Set encoding and frame check sequence (FCS) options.
1349  *
1350  * Return: 0 if success, otherwise error code
1351  */
hdlcdev_attach(struct net_device * dev,unsigned short encoding,unsigned short parity)1352 static int hdlcdev_attach(struct net_device *dev, unsigned short encoding,
1353 			  unsigned short parity)
1354 {
1355 	struct slgt_info *info = dev_to_port(dev);
1356 	unsigned char  new_encoding;
1357 	unsigned short new_crctype;
1358 
1359 	/* return error if TTY interface open */
1360 	if (info->port.count)
1361 		return -EBUSY;
1362 
1363 	DBGINFO(("%s hdlcdev_attach\n", info->device_name));
1364 
1365 	switch (encoding)
1366 	{
1367 	case ENCODING_NRZ:        new_encoding = HDLC_ENCODING_NRZ; break;
1368 	case ENCODING_NRZI:       new_encoding = HDLC_ENCODING_NRZI_SPACE; break;
1369 	case ENCODING_FM_MARK:    new_encoding = HDLC_ENCODING_BIPHASE_MARK; break;
1370 	case ENCODING_FM_SPACE:   new_encoding = HDLC_ENCODING_BIPHASE_SPACE; break;
1371 	case ENCODING_MANCHESTER: new_encoding = HDLC_ENCODING_BIPHASE_LEVEL; break;
1372 	default: return -EINVAL;
1373 	}
1374 
1375 	switch (parity)
1376 	{
1377 	case PARITY_NONE:            new_crctype = HDLC_CRC_NONE; break;
1378 	case PARITY_CRC16_PR1_CCITT: new_crctype = HDLC_CRC_16_CCITT; break;
1379 	case PARITY_CRC32_PR1_CCITT: new_crctype = HDLC_CRC_32_CCITT; break;
1380 	default: return -EINVAL;
1381 	}
1382 
1383 	info->params.encoding = new_encoding;
1384 	info->params.crc_type = new_crctype;
1385 
1386 	/* if network interface up, reprogram hardware */
1387 	if (info->netcount)
1388 		program_hw(info);
1389 
1390 	return 0;
1391 }
1392 
1393 /**
1394  * hdlcdev_xmit - called by generic HDLC layer to send a frame
1395  * @skb: socket buffer containing HDLC frame
1396  * @dev: pointer to network device structure
1397  */
hdlcdev_xmit(struct sk_buff * skb,struct net_device * dev)1398 static netdev_tx_t hdlcdev_xmit(struct sk_buff *skb,
1399 				      struct net_device *dev)
1400 {
1401 	struct slgt_info *info = dev_to_port(dev);
1402 	unsigned long flags;
1403 
1404 	DBGINFO(("%s hdlc_xmit\n", dev->name));
1405 
1406 	if (!skb->len)
1407 		return NETDEV_TX_OK;
1408 
1409 	/* stop sending until this frame completes */
1410 	netif_stop_queue(dev);
1411 
1412 	/* update network statistics */
1413 	dev->stats.tx_packets++;
1414 	dev->stats.tx_bytes += skb->len;
1415 
1416 	/* save start time for transmit timeout detection */
1417 	netif_trans_update(dev);
1418 
1419 	spin_lock_irqsave(&info->lock, flags);
1420 	tx_load(info, skb->data, skb->len);
1421 	spin_unlock_irqrestore(&info->lock, flags);
1422 
1423 	/* done with socket buffer, so free it */
1424 	dev_kfree_skb(skb);
1425 
1426 	return NETDEV_TX_OK;
1427 }
1428 
1429 /**
1430  * hdlcdev_open - called by network layer when interface enabled
1431  * @dev: pointer to network device structure
1432  *
1433  * Claim resources and initialize hardware.
1434  *
1435  * Return: 0 if success, otherwise error code
1436  */
hdlcdev_open(struct net_device * dev)1437 static int hdlcdev_open(struct net_device *dev)
1438 {
1439 	struct slgt_info *info = dev_to_port(dev);
1440 	int rc;
1441 	unsigned long flags;
1442 
1443 	if (!try_module_get(THIS_MODULE))
1444 		return -EBUSY;
1445 
1446 	DBGINFO(("%s hdlcdev_open\n", dev->name));
1447 
1448 	/* generic HDLC layer open processing */
1449 	rc = hdlc_open(dev);
1450 	if (rc)
1451 		return rc;
1452 
1453 	/* arbitrate between network and tty opens */
1454 	spin_lock_irqsave(&info->netlock, flags);
1455 	if (info->port.count != 0 || info->netcount != 0) {
1456 		DBGINFO(("%s hdlc_open busy\n", dev->name));
1457 		spin_unlock_irqrestore(&info->netlock, flags);
1458 		return -EBUSY;
1459 	}
1460 	info->netcount=1;
1461 	spin_unlock_irqrestore(&info->netlock, flags);
1462 
1463 	/* claim resources and init adapter */
1464 	if ((rc = startup(info)) != 0) {
1465 		spin_lock_irqsave(&info->netlock, flags);
1466 		info->netcount=0;
1467 		spin_unlock_irqrestore(&info->netlock, flags);
1468 		return rc;
1469 	}
1470 
1471 	/* assert RTS and DTR, apply hardware settings */
1472 	info->signals |= SerialSignal_RTS | SerialSignal_DTR;
1473 	program_hw(info);
1474 
1475 	/* enable network layer transmit */
1476 	netif_trans_update(dev);
1477 	netif_start_queue(dev);
1478 
1479 	/* inform generic HDLC layer of current DCD status */
1480 	spin_lock_irqsave(&info->lock, flags);
1481 	get_gtsignals(info);
1482 	spin_unlock_irqrestore(&info->lock, flags);
1483 	if (info->signals & SerialSignal_DCD)
1484 		netif_carrier_on(dev);
1485 	else
1486 		netif_carrier_off(dev);
1487 	return 0;
1488 }
1489 
1490 /**
1491  * hdlcdev_close - called by network layer when interface is disabled
1492  * @dev:  pointer to network device structure
1493  *
1494  * Shutdown hardware and release resources.
1495  *
1496  * Return: 0 if success, otherwise error code
1497  */
hdlcdev_close(struct net_device * dev)1498 static int hdlcdev_close(struct net_device *dev)
1499 {
1500 	struct slgt_info *info = dev_to_port(dev);
1501 	unsigned long flags;
1502 
1503 	DBGINFO(("%s hdlcdev_close\n", dev->name));
1504 
1505 	netif_stop_queue(dev);
1506 
1507 	/* shutdown adapter and release resources */
1508 	shutdown(info);
1509 
1510 	hdlc_close(dev);
1511 
1512 	spin_lock_irqsave(&info->netlock, flags);
1513 	info->netcount=0;
1514 	spin_unlock_irqrestore(&info->netlock, flags);
1515 
1516 	module_put(THIS_MODULE);
1517 	return 0;
1518 }
1519 
1520 /**
1521  * hdlcdev_ioctl - called by network layer to process IOCTL call to network device
1522  * @dev: pointer to network device structure
1523  * @ifr: pointer to network interface request structure
1524  * @cmd: IOCTL command code
1525  *
1526  * Return: 0 if success, otherwise error code
1527  */
hdlcdev_ioctl(struct net_device * dev,struct ifreq * ifr,int cmd)1528 static int hdlcdev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
1529 {
1530 	const size_t size = sizeof(sync_serial_settings);
1531 	sync_serial_settings new_line;
1532 	sync_serial_settings __user *line = ifr->ifr_settings.ifs_ifsu.sync;
1533 	struct slgt_info *info = dev_to_port(dev);
1534 	unsigned int flags;
1535 
1536 	DBGINFO(("%s hdlcdev_ioctl\n", dev->name));
1537 
1538 	/* return error if TTY interface open */
1539 	if (info->port.count)
1540 		return -EBUSY;
1541 
1542 	if (cmd != SIOCWANDEV)
1543 		return hdlc_ioctl(dev, ifr, cmd);
1544 
1545 	memset(&new_line, 0, sizeof(new_line));
1546 
1547 	switch(ifr->ifr_settings.type) {
1548 	case IF_GET_IFACE: /* return current sync_serial_settings */
1549 
1550 		ifr->ifr_settings.type = IF_IFACE_SYNC_SERIAL;
1551 		if (ifr->ifr_settings.size < size) {
1552 			ifr->ifr_settings.size = size; /* data size wanted */
1553 			return -ENOBUFS;
1554 		}
1555 
1556 		flags = info->params.flags & (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL |
1557 					      HDLC_FLAG_RXC_BRG    | HDLC_FLAG_RXC_TXCPIN |
1558 					      HDLC_FLAG_TXC_TXCPIN | HDLC_FLAG_TXC_DPLL |
1559 					      HDLC_FLAG_TXC_BRG    | HDLC_FLAG_TXC_RXCPIN);
1560 
1561 		switch (flags){
1562 		case (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_TXCPIN): new_line.clock_type = CLOCK_EXT; break;
1563 		case (HDLC_FLAG_RXC_BRG    | HDLC_FLAG_TXC_BRG):    new_line.clock_type = CLOCK_INT; break;
1564 		case (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_BRG):    new_line.clock_type = CLOCK_TXINT; break;
1565 		case (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_RXCPIN): new_line.clock_type = CLOCK_TXFROMRX; break;
1566 		default: new_line.clock_type = CLOCK_DEFAULT;
1567 		}
1568 
1569 		new_line.clock_rate = info->params.clock_speed;
1570 		new_line.loopback   = info->params.loopback ? 1:0;
1571 
1572 		if (copy_to_user(line, &new_line, size))
1573 			return -EFAULT;
1574 		return 0;
1575 
1576 	case IF_IFACE_SYNC_SERIAL: /* set sync_serial_settings */
1577 
1578 		if(!capable(CAP_NET_ADMIN))
1579 			return -EPERM;
1580 		if (copy_from_user(&new_line, line, size))
1581 			return -EFAULT;
1582 
1583 		switch (new_line.clock_type)
1584 		{
1585 		case CLOCK_EXT:      flags = HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_TXCPIN; break;
1586 		case CLOCK_TXFROMRX: flags = HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_RXCPIN; break;
1587 		case CLOCK_INT:      flags = HDLC_FLAG_RXC_BRG    | HDLC_FLAG_TXC_BRG;    break;
1588 		case CLOCK_TXINT:    flags = HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_BRG;    break;
1589 		case CLOCK_DEFAULT:  flags = info->params.flags &
1590 					     (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL |
1591 					      HDLC_FLAG_RXC_BRG    | HDLC_FLAG_RXC_TXCPIN |
1592 					      HDLC_FLAG_TXC_TXCPIN | HDLC_FLAG_TXC_DPLL |
1593 					      HDLC_FLAG_TXC_BRG    | HDLC_FLAG_TXC_RXCPIN); break;
1594 		default: return -EINVAL;
1595 		}
1596 
1597 		if (new_line.loopback != 0 && new_line.loopback != 1)
1598 			return -EINVAL;
1599 
1600 		info->params.flags &= ~(HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL |
1601 					HDLC_FLAG_RXC_BRG    | HDLC_FLAG_RXC_TXCPIN |
1602 					HDLC_FLAG_TXC_TXCPIN | HDLC_FLAG_TXC_DPLL |
1603 					HDLC_FLAG_TXC_BRG    | HDLC_FLAG_TXC_RXCPIN);
1604 		info->params.flags |= flags;
1605 
1606 		info->params.loopback = new_line.loopback;
1607 
1608 		if (flags & (HDLC_FLAG_RXC_BRG | HDLC_FLAG_TXC_BRG))
1609 			info->params.clock_speed = new_line.clock_rate;
1610 		else
1611 			info->params.clock_speed = 0;
1612 
1613 		/* if network interface up, reprogram hardware */
1614 		if (info->netcount)
1615 			program_hw(info);
1616 		return 0;
1617 
1618 	default:
1619 		return hdlc_ioctl(dev, ifr, cmd);
1620 	}
1621 }
1622 
1623 /**
1624  * hdlcdev_tx_timeout - called by network layer when transmit timeout is detected
1625  * @dev: pointer to network device structure
1626  */
hdlcdev_tx_timeout(struct net_device * dev,unsigned int txqueue)1627 static void hdlcdev_tx_timeout(struct net_device *dev, unsigned int txqueue)
1628 {
1629 	struct slgt_info *info = dev_to_port(dev);
1630 	unsigned long flags;
1631 
1632 	DBGINFO(("%s hdlcdev_tx_timeout\n", dev->name));
1633 
1634 	dev->stats.tx_errors++;
1635 	dev->stats.tx_aborted_errors++;
1636 
1637 	spin_lock_irqsave(&info->lock,flags);
1638 	tx_stop(info);
1639 	spin_unlock_irqrestore(&info->lock,flags);
1640 
1641 	netif_wake_queue(dev);
1642 }
1643 
1644 /**
1645  * hdlcdev_tx_done - called by device driver when transmit completes
1646  * @info: pointer to device instance information
1647  *
1648  * Reenable network layer transmit if stopped.
1649  */
hdlcdev_tx_done(struct slgt_info * info)1650 static void hdlcdev_tx_done(struct slgt_info *info)
1651 {
1652 	if (netif_queue_stopped(info->netdev))
1653 		netif_wake_queue(info->netdev);
1654 }
1655 
1656 /**
1657  * hdlcdev_rx - called by device driver when frame received
1658  * @info: pointer to device instance information
1659  * @buf:  pointer to buffer contianing frame data
1660  * @size: count of data bytes in buf
1661  *
1662  * Pass frame to network layer.
1663  */
hdlcdev_rx(struct slgt_info * info,char * buf,int size)1664 static void hdlcdev_rx(struct slgt_info *info, char *buf, int size)
1665 {
1666 	struct sk_buff *skb = dev_alloc_skb(size);
1667 	struct net_device *dev = info->netdev;
1668 
1669 	DBGINFO(("%s hdlcdev_rx\n", dev->name));
1670 
1671 	if (skb == NULL) {
1672 		DBGERR(("%s: can't alloc skb, drop packet\n", dev->name));
1673 		dev->stats.rx_dropped++;
1674 		return;
1675 	}
1676 
1677 	skb_put_data(skb, buf, size);
1678 
1679 	skb->protocol = hdlc_type_trans(skb, dev);
1680 
1681 	dev->stats.rx_packets++;
1682 	dev->stats.rx_bytes += size;
1683 
1684 	netif_rx(skb);
1685 }
1686 
1687 static const struct net_device_ops hdlcdev_ops = {
1688 	.ndo_open       = hdlcdev_open,
1689 	.ndo_stop       = hdlcdev_close,
1690 	.ndo_start_xmit = hdlc_start_xmit,
1691 	.ndo_do_ioctl   = hdlcdev_ioctl,
1692 	.ndo_tx_timeout = hdlcdev_tx_timeout,
1693 };
1694 
1695 /**
1696  * hdlcdev_init - called by device driver when adding device instance
1697  * @info: pointer to device instance information
1698  *
1699  * Do generic HDLC initialization.
1700  *
1701  * Return: 0 if success, otherwise error code
1702  */
hdlcdev_init(struct slgt_info * info)1703 static int hdlcdev_init(struct slgt_info *info)
1704 {
1705 	int rc;
1706 	struct net_device *dev;
1707 	hdlc_device *hdlc;
1708 
1709 	/* allocate and initialize network and HDLC layer objects */
1710 
1711 	dev = alloc_hdlcdev(info);
1712 	if (!dev) {
1713 		printk(KERN_ERR "%s hdlc device alloc failure\n", info->device_name);
1714 		return -ENOMEM;
1715 	}
1716 
1717 	/* for network layer reporting purposes only */
1718 	dev->mem_start = info->phys_reg_addr;
1719 	dev->mem_end   = info->phys_reg_addr + SLGT_REG_SIZE - 1;
1720 	dev->irq       = info->irq_level;
1721 
1722 	/* network layer callbacks and settings */
1723 	dev->netdev_ops	    = &hdlcdev_ops;
1724 	dev->watchdog_timeo = 10 * HZ;
1725 	dev->tx_queue_len   = 50;
1726 
1727 	/* generic HDLC layer callbacks and settings */
1728 	hdlc         = dev_to_hdlc(dev);
1729 	hdlc->attach = hdlcdev_attach;
1730 	hdlc->xmit   = hdlcdev_xmit;
1731 
1732 	/* register objects with HDLC layer */
1733 	rc = register_hdlc_device(dev);
1734 	if (rc) {
1735 		printk(KERN_WARNING "%s:unable to register hdlc device\n",__FILE__);
1736 		free_netdev(dev);
1737 		return rc;
1738 	}
1739 
1740 	info->netdev = dev;
1741 	return 0;
1742 }
1743 
1744 /**
1745  * hdlcdev_exit - called by device driver when removing device instance
1746  * @info: pointer to device instance information
1747  *
1748  * Do generic HDLC cleanup.
1749  */
hdlcdev_exit(struct slgt_info * info)1750 static void hdlcdev_exit(struct slgt_info *info)
1751 {
1752 	unregister_hdlc_device(info->netdev);
1753 	free_netdev(info->netdev);
1754 	info->netdev = NULL;
1755 }
1756 
1757 #endif /* ifdef CONFIG_HDLC */
1758 
1759 /*
1760  * get async data from rx DMA buffers
1761  */
rx_async(struct slgt_info * info)1762 static void rx_async(struct slgt_info *info)
1763 {
1764  	struct mgsl_icount *icount = &info->icount;
1765 	unsigned int start, end;
1766 	unsigned char *p;
1767 	unsigned char status;
1768 	struct slgt_desc *bufs = info->rbufs;
1769 	int i, count;
1770 	int chars = 0;
1771 	int stat;
1772 	unsigned char ch;
1773 
1774 	start = end = info->rbuf_current;
1775 
1776 	while(desc_complete(bufs[end])) {
1777 		count = desc_count(bufs[end]) - info->rbuf_index;
1778 		p     = bufs[end].buf + info->rbuf_index;
1779 
1780 		DBGISR(("%s rx_async count=%d\n", info->device_name, count));
1781 		DBGDATA(info, p, count, "rx");
1782 
1783 		for(i=0 ; i < count; i+=2, p+=2) {
1784 			ch = *p;
1785 			icount->rx++;
1786 
1787 			stat = 0;
1788 
1789 			status = *(p + 1) & (BIT1 + BIT0);
1790 			if (status) {
1791 				if (status & BIT1)
1792 					icount->parity++;
1793 				else if (status & BIT0)
1794 					icount->frame++;
1795 				/* discard char if tty control flags say so */
1796 				if (status & info->ignore_status_mask)
1797 					continue;
1798 				if (status & BIT1)
1799 					stat = TTY_PARITY;
1800 				else if (status & BIT0)
1801 					stat = TTY_FRAME;
1802 			}
1803 			tty_insert_flip_char(&info->port, ch, stat);
1804 			chars++;
1805 		}
1806 
1807 		if (i < count) {
1808 			/* receive buffer not completed */
1809 			info->rbuf_index += i;
1810 			mod_timer(&info->rx_timer, jiffies + 1);
1811 			break;
1812 		}
1813 
1814 		info->rbuf_index = 0;
1815 		free_rbufs(info, end, end);
1816 
1817 		if (++end == info->rbuf_count)
1818 			end = 0;
1819 
1820 		/* if entire list searched then no frame available */
1821 		if (end == start)
1822 			break;
1823 	}
1824 
1825 	if (chars)
1826 		tty_flip_buffer_push(&info->port);
1827 }
1828 
1829 /*
1830  * return next bottom half action to perform
1831  */
bh_action(struct slgt_info * info)1832 static int bh_action(struct slgt_info *info)
1833 {
1834 	unsigned long flags;
1835 	int rc;
1836 
1837 	spin_lock_irqsave(&info->lock,flags);
1838 
1839 	if (info->pending_bh & BH_RECEIVE) {
1840 		info->pending_bh &= ~BH_RECEIVE;
1841 		rc = BH_RECEIVE;
1842 	} else if (info->pending_bh & BH_TRANSMIT) {
1843 		info->pending_bh &= ~BH_TRANSMIT;
1844 		rc = BH_TRANSMIT;
1845 	} else if (info->pending_bh & BH_STATUS) {
1846 		info->pending_bh &= ~BH_STATUS;
1847 		rc = BH_STATUS;
1848 	} else {
1849 		/* Mark BH routine as complete */
1850 		info->bh_running = false;
1851 		info->bh_requested = false;
1852 		rc = 0;
1853 	}
1854 
1855 	spin_unlock_irqrestore(&info->lock,flags);
1856 
1857 	return rc;
1858 }
1859 
1860 /*
1861  * perform bottom half processing
1862  */
bh_handler(struct work_struct * work)1863 static void bh_handler(struct work_struct *work)
1864 {
1865 	struct slgt_info *info = container_of(work, struct slgt_info, task);
1866 	int action;
1867 
1868 	info->bh_running = true;
1869 
1870 	while((action = bh_action(info))) {
1871 		switch (action) {
1872 		case BH_RECEIVE:
1873 			DBGBH(("%s bh receive\n", info->device_name));
1874 			switch(info->params.mode) {
1875 			case MGSL_MODE_ASYNC:
1876 				rx_async(info);
1877 				break;
1878 			case MGSL_MODE_HDLC:
1879 				while(rx_get_frame(info));
1880 				break;
1881 			case MGSL_MODE_RAW:
1882 			case MGSL_MODE_MONOSYNC:
1883 			case MGSL_MODE_BISYNC:
1884 			case MGSL_MODE_XSYNC:
1885 				while(rx_get_buf(info));
1886 				break;
1887 			}
1888 			/* restart receiver if rx DMA buffers exhausted */
1889 			if (info->rx_restart)
1890 				rx_start(info);
1891 			break;
1892 		case BH_TRANSMIT:
1893 			bh_transmit(info);
1894 			break;
1895 		case BH_STATUS:
1896 			DBGBH(("%s bh status\n", info->device_name));
1897 			info->ri_chkcount = 0;
1898 			info->dsr_chkcount = 0;
1899 			info->dcd_chkcount = 0;
1900 			info->cts_chkcount = 0;
1901 			break;
1902 		default:
1903 			DBGBH(("%s unknown action\n", info->device_name));
1904 			break;
1905 		}
1906 	}
1907 	DBGBH(("%s bh_handler exit\n", info->device_name));
1908 }
1909 
bh_transmit(struct slgt_info * info)1910 static void bh_transmit(struct slgt_info *info)
1911 {
1912 	struct tty_struct *tty = info->port.tty;
1913 
1914 	DBGBH(("%s bh_transmit\n", info->device_name));
1915 	if (tty)
1916 		tty_wakeup(tty);
1917 }
1918 
dsr_change(struct slgt_info * info,unsigned short status)1919 static void dsr_change(struct slgt_info *info, unsigned short status)
1920 {
1921 	if (status & BIT3) {
1922 		info->signals |= SerialSignal_DSR;
1923 		info->input_signal_events.dsr_up++;
1924 	} else {
1925 		info->signals &= ~SerialSignal_DSR;
1926 		info->input_signal_events.dsr_down++;
1927 	}
1928 	DBGISR(("dsr_change %s signals=%04X\n", info->device_name, info->signals));
1929 	if ((info->dsr_chkcount)++ == IO_PIN_SHUTDOWN_LIMIT) {
1930 		slgt_irq_off(info, IRQ_DSR);
1931 		return;
1932 	}
1933 	info->icount.dsr++;
1934 	wake_up_interruptible(&info->status_event_wait_q);
1935 	wake_up_interruptible(&info->event_wait_q);
1936 	info->pending_bh |= BH_STATUS;
1937 }
1938 
cts_change(struct slgt_info * info,unsigned short status)1939 static void cts_change(struct slgt_info *info, unsigned short status)
1940 {
1941 	if (status & BIT2) {
1942 		info->signals |= SerialSignal_CTS;
1943 		info->input_signal_events.cts_up++;
1944 	} else {
1945 		info->signals &= ~SerialSignal_CTS;
1946 		info->input_signal_events.cts_down++;
1947 	}
1948 	DBGISR(("cts_change %s signals=%04X\n", info->device_name, info->signals));
1949 	if ((info->cts_chkcount)++ == IO_PIN_SHUTDOWN_LIMIT) {
1950 		slgt_irq_off(info, IRQ_CTS);
1951 		return;
1952 	}
1953 	info->icount.cts++;
1954 	wake_up_interruptible(&info->status_event_wait_q);
1955 	wake_up_interruptible(&info->event_wait_q);
1956 	info->pending_bh |= BH_STATUS;
1957 
1958 	if (tty_port_cts_enabled(&info->port)) {
1959 		if (info->port.tty) {
1960 			if (info->port.tty->hw_stopped) {
1961 				if (info->signals & SerialSignal_CTS) {
1962 		 			info->port.tty->hw_stopped = 0;
1963 					info->pending_bh |= BH_TRANSMIT;
1964 					return;
1965 				}
1966 			} else {
1967 				if (!(info->signals & SerialSignal_CTS))
1968 		 			info->port.tty->hw_stopped = 1;
1969 			}
1970 		}
1971 	}
1972 }
1973 
dcd_change(struct slgt_info * info,unsigned short status)1974 static void dcd_change(struct slgt_info *info, unsigned short status)
1975 {
1976 	if (status & BIT1) {
1977 		info->signals |= SerialSignal_DCD;
1978 		info->input_signal_events.dcd_up++;
1979 	} else {
1980 		info->signals &= ~SerialSignal_DCD;
1981 		info->input_signal_events.dcd_down++;
1982 	}
1983 	DBGISR(("dcd_change %s signals=%04X\n", info->device_name, info->signals));
1984 	if ((info->dcd_chkcount)++ == IO_PIN_SHUTDOWN_LIMIT) {
1985 		slgt_irq_off(info, IRQ_DCD);
1986 		return;
1987 	}
1988 	info->icount.dcd++;
1989 #if SYNCLINK_GENERIC_HDLC
1990 	if (info->netcount) {
1991 		if (info->signals & SerialSignal_DCD)
1992 			netif_carrier_on(info->netdev);
1993 		else
1994 			netif_carrier_off(info->netdev);
1995 	}
1996 #endif
1997 	wake_up_interruptible(&info->status_event_wait_q);
1998 	wake_up_interruptible(&info->event_wait_q);
1999 	info->pending_bh |= BH_STATUS;
2000 
2001 	if (tty_port_check_carrier(&info->port)) {
2002 		if (info->signals & SerialSignal_DCD)
2003 			wake_up_interruptible(&info->port.open_wait);
2004 		else {
2005 			if (info->port.tty)
2006 				tty_hangup(info->port.tty);
2007 		}
2008 	}
2009 }
2010 
ri_change(struct slgt_info * info,unsigned short status)2011 static void ri_change(struct slgt_info *info, unsigned short status)
2012 {
2013 	if (status & BIT0) {
2014 		info->signals |= SerialSignal_RI;
2015 		info->input_signal_events.ri_up++;
2016 	} else {
2017 		info->signals &= ~SerialSignal_RI;
2018 		info->input_signal_events.ri_down++;
2019 	}
2020 	DBGISR(("ri_change %s signals=%04X\n", info->device_name, info->signals));
2021 	if ((info->ri_chkcount)++ == IO_PIN_SHUTDOWN_LIMIT) {
2022 		slgt_irq_off(info, IRQ_RI);
2023 		return;
2024 	}
2025 	info->icount.rng++;
2026 	wake_up_interruptible(&info->status_event_wait_q);
2027 	wake_up_interruptible(&info->event_wait_q);
2028 	info->pending_bh |= BH_STATUS;
2029 }
2030 
isr_rxdata(struct slgt_info * info)2031 static void isr_rxdata(struct slgt_info *info)
2032 {
2033 	unsigned int count = info->rbuf_fill_count;
2034 	unsigned int i = info->rbuf_fill_index;
2035 	unsigned short reg;
2036 
2037 	while (rd_reg16(info, SSR) & IRQ_RXDATA) {
2038 		reg = rd_reg16(info, RDR);
2039 		DBGISR(("isr_rxdata %s RDR=%04X\n", info->device_name, reg));
2040 		if (desc_complete(info->rbufs[i])) {
2041 			/* all buffers full */
2042 			rx_stop(info);
2043 			info->rx_restart = true;
2044 			continue;
2045 		}
2046 		info->rbufs[i].buf[count++] = (unsigned char)reg;
2047 		/* async mode saves status byte to buffer for each data byte */
2048 		if (info->params.mode == MGSL_MODE_ASYNC)
2049 			info->rbufs[i].buf[count++] = (unsigned char)(reg >> 8);
2050 		if (count == info->rbuf_fill_level || (reg & BIT10)) {
2051 			/* buffer full or end of frame */
2052 			set_desc_count(info->rbufs[i], count);
2053 			set_desc_status(info->rbufs[i], BIT15 | (reg >> 8));
2054 			info->rbuf_fill_count = count = 0;
2055 			if (++i == info->rbuf_count)
2056 				i = 0;
2057 			info->pending_bh |= BH_RECEIVE;
2058 		}
2059 	}
2060 
2061 	info->rbuf_fill_index = i;
2062 	info->rbuf_fill_count = count;
2063 }
2064 
isr_serial(struct slgt_info * info)2065 static void isr_serial(struct slgt_info *info)
2066 {
2067 	unsigned short status = rd_reg16(info, SSR);
2068 
2069 	DBGISR(("%s isr_serial status=%04X\n", info->device_name, status));
2070 
2071 	wr_reg16(info, SSR, status); /* clear pending */
2072 
2073 	info->irq_occurred = true;
2074 
2075 	if (info->params.mode == MGSL_MODE_ASYNC) {
2076 		if (status & IRQ_TXIDLE) {
2077 			if (info->tx_active)
2078 				isr_txeom(info, status);
2079 		}
2080 		if (info->rx_pio && (status & IRQ_RXDATA))
2081 			isr_rxdata(info);
2082 		if ((status & IRQ_RXBREAK) && (status & RXBREAK)) {
2083 			info->icount.brk++;
2084 			/* process break detection if tty control allows */
2085 			if (info->port.tty) {
2086 				if (!(status & info->ignore_status_mask)) {
2087 					if (info->read_status_mask & MASK_BREAK) {
2088 						tty_insert_flip_char(&info->port, 0, TTY_BREAK);
2089 						if (info->port.flags & ASYNC_SAK)
2090 							do_SAK(info->port.tty);
2091 					}
2092 				}
2093 			}
2094 		}
2095 	} else {
2096 		if (status & (IRQ_TXIDLE + IRQ_TXUNDER))
2097 			isr_txeom(info, status);
2098 		if (info->rx_pio && (status & IRQ_RXDATA))
2099 			isr_rxdata(info);
2100 		if (status & IRQ_RXIDLE) {
2101 			if (status & RXIDLE)
2102 				info->icount.rxidle++;
2103 			else
2104 				info->icount.exithunt++;
2105 			wake_up_interruptible(&info->event_wait_q);
2106 		}
2107 
2108 		if (status & IRQ_RXOVER)
2109 			rx_start(info);
2110 	}
2111 
2112 	if (status & IRQ_DSR)
2113 		dsr_change(info, status);
2114 	if (status & IRQ_CTS)
2115 		cts_change(info, status);
2116 	if (status & IRQ_DCD)
2117 		dcd_change(info, status);
2118 	if (status & IRQ_RI)
2119 		ri_change(info, status);
2120 }
2121 
isr_rdma(struct slgt_info * info)2122 static void isr_rdma(struct slgt_info *info)
2123 {
2124 	unsigned int status = rd_reg32(info, RDCSR);
2125 
2126 	DBGISR(("%s isr_rdma status=%08x\n", info->device_name, status));
2127 
2128 	/* RDCSR (rx DMA control/status)
2129 	 *
2130 	 * 31..07  reserved
2131 	 * 06      save status byte to DMA buffer
2132 	 * 05      error
2133 	 * 04      eol (end of list)
2134 	 * 03      eob (end of buffer)
2135 	 * 02      IRQ enable
2136 	 * 01      reset
2137 	 * 00      enable
2138 	 */
2139 	wr_reg32(info, RDCSR, status);	/* clear pending */
2140 
2141 	if (status & (BIT5 + BIT4)) {
2142 		DBGISR(("%s isr_rdma rx_restart=1\n", info->device_name));
2143 		info->rx_restart = true;
2144 	}
2145 	info->pending_bh |= BH_RECEIVE;
2146 }
2147 
isr_tdma(struct slgt_info * info)2148 static void isr_tdma(struct slgt_info *info)
2149 {
2150 	unsigned int status = rd_reg32(info, TDCSR);
2151 
2152 	DBGISR(("%s isr_tdma status=%08x\n", info->device_name, status));
2153 
2154 	/* TDCSR (tx DMA control/status)
2155 	 *
2156 	 * 31..06  reserved
2157 	 * 05      error
2158 	 * 04      eol (end of list)
2159 	 * 03      eob (end of buffer)
2160 	 * 02      IRQ enable
2161 	 * 01      reset
2162 	 * 00      enable
2163 	 */
2164 	wr_reg32(info, TDCSR, status);	/* clear pending */
2165 
2166 	if (status & (BIT5 + BIT4 + BIT3)) {
2167 		// another transmit buffer has completed
2168 		// run bottom half to get more send data from user
2169 		info->pending_bh |= BH_TRANSMIT;
2170 	}
2171 }
2172 
2173 /*
2174  * return true if there are unsent tx DMA buffers, otherwise false
2175  *
2176  * if there are unsent buffers then info->tbuf_start
2177  * is set to index of first unsent buffer
2178  */
unsent_tbufs(struct slgt_info * info)2179 static bool unsent_tbufs(struct slgt_info *info)
2180 {
2181 	unsigned int i = info->tbuf_current;
2182 	bool rc = false;
2183 
2184 	/*
2185 	 * search backwards from last loaded buffer (precedes tbuf_current)
2186 	 * for first unsent buffer (desc_count > 0)
2187 	 */
2188 
2189 	do {
2190 		if (i)
2191 			i--;
2192 		else
2193 			i = info->tbuf_count - 1;
2194 		if (!desc_count(info->tbufs[i]))
2195 			break;
2196 		info->tbuf_start = i;
2197 		rc = true;
2198 	} while (i != info->tbuf_current);
2199 
2200 	return rc;
2201 }
2202 
isr_txeom(struct slgt_info * info,unsigned short status)2203 static void isr_txeom(struct slgt_info *info, unsigned short status)
2204 {
2205 	DBGISR(("%s txeom status=%04x\n", info->device_name, status));
2206 
2207 	slgt_irq_off(info, IRQ_TXDATA + IRQ_TXIDLE + IRQ_TXUNDER);
2208 	tdma_reset(info);
2209 	if (status & IRQ_TXUNDER) {
2210 		unsigned short val = rd_reg16(info, TCR);
2211 		wr_reg16(info, TCR, (unsigned short)(val | BIT2)); /* set reset bit */
2212 		wr_reg16(info, TCR, val); /* clear reset bit */
2213 	}
2214 
2215 	if (info->tx_active) {
2216 		if (info->params.mode != MGSL_MODE_ASYNC) {
2217 			if (status & IRQ_TXUNDER)
2218 				info->icount.txunder++;
2219 			else if (status & IRQ_TXIDLE)
2220 				info->icount.txok++;
2221 		}
2222 
2223 		if (unsent_tbufs(info)) {
2224 			tx_start(info);
2225 			update_tx_timer(info);
2226 			return;
2227 		}
2228 		info->tx_active = false;
2229 
2230 		del_timer(&info->tx_timer);
2231 
2232 		if (info->params.mode != MGSL_MODE_ASYNC && info->drop_rts_on_tx_done) {
2233 			info->signals &= ~SerialSignal_RTS;
2234 			info->drop_rts_on_tx_done = false;
2235 			set_gtsignals(info);
2236 		}
2237 
2238 #if SYNCLINK_GENERIC_HDLC
2239 		if (info->netcount)
2240 			hdlcdev_tx_done(info);
2241 		else
2242 #endif
2243 		{
2244 			if (info->port.tty && (info->port.tty->stopped || info->port.tty->hw_stopped)) {
2245 				tx_stop(info);
2246 				return;
2247 			}
2248 			info->pending_bh |= BH_TRANSMIT;
2249 		}
2250 	}
2251 }
2252 
isr_gpio(struct slgt_info * info,unsigned int changed,unsigned int state)2253 static void isr_gpio(struct slgt_info *info, unsigned int changed, unsigned int state)
2254 {
2255 	struct cond_wait *w, *prev;
2256 
2257 	/* wake processes waiting for specific transitions */
2258 	for (w = info->gpio_wait_q, prev = NULL ; w != NULL ; w = w->next) {
2259 		if (w->data & changed) {
2260 			w->data = state;
2261 			wake_up_interruptible(&w->q);
2262 			if (prev != NULL)
2263 				prev->next = w->next;
2264 			else
2265 				info->gpio_wait_q = w->next;
2266 		} else
2267 			prev = w;
2268 	}
2269 }
2270 
2271 /* interrupt service routine
2272  *
2273  * 	irq	interrupt number
2274  * 	dev_id	device ID supplied during interrupt registration
2275  */
slgt_interrupt(int dummy,void * dev_id)2276 static irqreturn_t slgt_interrupt(int dummy, void *dev_id)
2277 {
2278 	struct slgt_info *info = dev_id;
2279 	unsigned int gsr;
2280 	unsigned int i;
2281 
2282 	DBGISR(("slgt_interrupt irq=%d entry\n", info->irq_level));
2283 
2284 	while((gsr = rd_reg32(info, GSR) & 0xffffff00)) {
2285 		DBGISR(("%s gsr=%08x\n", info->device_name, gsr));
2286 		info->irq_occurred = true;
2287 		for(i=0; i < info->port_count ; i++) {
2288 			if (info->port_array[i] == NULL)
2289 				continue;
2290 			spin_lock(&info->port_array[i]->lock);
2291 			if (gsr & (BIT8 << i))
2292 				isr_serial(info->port_array[i]);
2293 			if (gsr & (BIT16 << (i*2)))
2294 				isr_rdma(info->port_array[i]);
2295 			if (gsr & (BIT17 << (i*2)))
2296 				isr_tdma(info->port_array[i]);
2297 			spin_unlock(&info->port_array[i]->lock);
2298 		}
2299 	}
2300 
2301 	if (info->gpio_present) {
2302 		unsigned int state;
2303 		unsigned int changed;
2304 		spin_lock(&info->lock);
2305 		while ((changed = rd_reg32(info, IOSR)) != 0) {
2306 			DBGISR(("%s iosr=%08x\n", info->device_name, changed));
2307 			/* read latched state of GPIO signals */
2308 			state = rd_reg32(info, IOVR);
2309 			/* clear pending GPIO interrupt bits */
2310 			wr_reg32(info, IOSR, changed);
2311 			for (i=0 ; i < info->port_count ; i++) {
2312 				if (info->port_array[i] != NULL)
2313 					isr_gpio(info->port_array[i], changed, state);
2314 			}
2315 		}
2316 		spin_unlock(&info->lock);
2317 	}
2318 
2319 	for(i=0; i < info->port_count ; i++) {
2320 		struct slgt_info *port = info->port_array[i];
2321 		if (port == NULL)
2322 			continue;
2323 		spin_lock(&port->lock);
2324 		if ((port->port.count || port->netcount) &&
2325 		    port->pending_bh && !port->bh_running &&
2326 		    !port->bh_requested) {
2327 			DBGISR(("%s bh queued\n", port->device_name));
2328 			schedule_work(&port->task);
2329 			port->bh_requested = true;
2330 		}
2331 		spin_unlock(&port->lock);
2332 	}
2333 
2334 	DBGISR(("slgt_interrupt irq=%d exit\n", info->irq_level));
2335 	return IRQ_HANDLED;
2336 }
2337 
startup(struct slgt_info * info)2338 static int startup(struct slgt_info *info)
2339 {
2340 	DBGINFO(("%s startup\n", info->device_name));
2341 
2342 	if (tty_port_initialized(&info->port))
2343 		return 0;
2344 
2345 	if (!info->tx_buf) {
2346 		info->tx_buf = kmalloc(info->max_frame_size, GFP_KERNEL);
2347 		if (!info->tx_buf) {
2348 			DBGERR(("%s can't allocate tx buffer\n", info->device_name));
2349 			return -ENOMEM;
2350 		}
2351 	}
2352 
2353 	info->pending_bh = 0;
2354 
2355 	memset(&info->icount, 0, sizeof(info->icount));
2356 
2357 	/* program hardware for current parameters */
2358 	change_params(info);
2359 
2360 	if (info->port.tty)
2361 		clear_bit(TTY_IO_ERROR, &info->port.tty->flags);
2362 
2363 	tty_port_set_initialized(&info->port, 1);
2364 
2365 	return 0;
2366 }
2367 
2368 /*
2369  *  called by close() and hangup() to shutdown hardware
2370  */
shutdown(struct slgt_info * info)2371 static void shutdown(struct slgt_info *info)
2372 {
2373 	unsigned long flags;
2374 
2375 	if (!tty_port_initialized(&info->port))
2376 		return;
2377 
2378 	DBGINFO(("%s shutdown\n", info->device_name));
2379 
2380 	/* clear status wait queue because status changes */
2381 	/* can't happen after shutting down the hardware */
2382 	wake_up_interruptible(&info->status_event_wait_q);
2383 	wake_up_interruptible(&info->event_wait_q);
2384 
2385 	del_timer_sync(&info->tx_timer);
2386 	del_timer_sync(&info->rx_timer);
2387 
2388 	kfree(info->tx_buf);
2389 	info->tx_buf = NULL;
2390 
2391 	spin_lock_irqsave(&info->lock,flags);
2392 
2393 	tx_stop(info);
2394 	rx_stop(info);
2395 
2396 	slgt_irq_off(info, IRQ_ALL | IRQ_MASTER);
2397 
2398  	if (!info->port.tty || info->port.tty->termios.c_cflag & HUPCL) {
2399 		info->signals &= ~(SerialSignal_RTS | SerialSignal_DTR);
2400 		set_gtsignals(info);
2401 	}
2402 
2403 	flush_cond_wait(&info->gpio_wait_q);
2404 
2405 	spin_unlock_irqrestore(&info->lock,flags);
2406 
2407 	if (info->port.tty)
2408 		set_bit(TTY_IO_ERROR, &info->port.tty->flags);
2409 
2410 	tty_port_set_initialized(&info->port, 0);
2411 }
2412 
program_hw(struct slgt_info * info)2413 static void program_hw(struct slgt_info *info)
2414 {
2415 	unsigned long flags;
2416 
2417 	spin_lock_irqsave(&info->lock,flags);
2418 
2419 	rx_stop(info);
2420 	tx_stop(info);
2421 
2422 	if (info->params.mode != MGSL_MODE_ASYNC ||
2423 	    info->netcount)
2424 		sync_mode(info);
2425 	else
2426 		async_mode(info);
2427 
2428 	set_gtsignals(info);
2429 
2430 	info->dcd_chkcount = 0;
2431 	info->cts_chkcount = 0;
2432 	info->ri_chkcount = 0;
2433 	info->dsr_chkcount = 0;
2434 
2435 	slgt_irq_on(info, IRQ_DCD | IRQ_CTS | IRQ_DSR | IRQ_RI);
2436 	get_gtsignals(info);
2437 
2438 	if (info->netcount ||
2439 	    (info->port.tty && info->port.tty->termios.c_cflag & CREAD))
2440 		rx_start(info);
2441 
2442 	spin_unlock_irqrestore(&info->lock,flags);
2443 }
2444 
2445 /*
2446  * reconfigure adapter based on new parameters
2447  */
change_params(struct slgt_info * info)2448 static void change_params(struct slgt_info *info)
2449 {
2450 	unsigned cflag;
2451 	int bits_per_char;
2452 
2453 	if (!info->port.tty)
2454 		return;
2455 	DBGINFO(("%s change_params\n", info->device_name));
2456 
2457 	cflag = info->port.tty->termios.c_cflag;
2458 
2459 	/* if B0 rate (hangup) specified then negate RTS and DTR */
2460 	/* otherwise assert RTS and DTR */
2461  	if (cflag & CBAUD)
2462 		info->signals |= SerialSignal_RTS | SerialSignal_DTR;
2463 	else
2464 		info->signals &= ~(SerialSignal_RTS | SerialSignal_DTR);
2465 
2466 	/* byte size and parity */
2467 
2468 	switch (cflag & CSIZE) {
2469 	case CS5: info->params.data_bits = 5; break;
2470 	case CS6: info->params.data_bits = 6; break;
2471 	case CS7: info->params.data_bits = 7; break;
2472 	case CS8: info->params.data_bits = 8; break;
2473 	default:  info->params.data_bits = 7; break;
2474 	}
2475 
2476 	info->params.stop_bits = (cflag & CSTOPB) ? 2 : 1;
2477 
2478 	if (cflag & PARENB)
2479 		info->params.parity = (cflag & PARODD) ? ASYNC_PARITY_ODD : ASYNC_PARITY_EVEN;
2480 	else
2481 		info->params.parity = ASYNC_PARITY_NONE;
2482 
2483 	/* calculate number of jiffies to transmit a full
2484 	 * FIFO (32 bytes) at specified data rate
2485 	 */
2486 	bits_per_char = info->params.data_bits +
2487 			info->params.stop_bits + 1;
2488 
2489 	info->params.data_rate = tty_get_baud_rate(info->port.tty);
2490 
2491 	if (info->params.data_rate) {
2492 		info->timeout = (32*HZ*bits_per_char) /
2493 				info->params.data_rate;
2494 	}
2495 	info->timeout += HZ/50;		/* Add .02 seconds of slop */
2496 
2497 	tty_port_set_cts_flow(&info->port, cflag & CRTSCTS);
2498 	tty_port_set_check_carrier(&info->port, ~cflag & CLOCAL);
2499 
2500 	/* process tty input control flags */
2501 
2502 	info->read_status_mask = IRQ_RXOVER;
2503 	if (I_INPCK(info->port.tty))
2504 		info->read_status_mask |= MASK_PARITY | MASK_FRAMING;
2505 	if (I_BRKINT(info->port.tty) || I_PARMRK(info->port.tty))
2506 		info->read_status_mask |= MASK_BREAK;
2507 	if (I_IGNPAR(info->port.tty))
2508 		info->ignore_status_mask |= MASK_PARITY | MASK_FRAMING;
2509 	if (I_IGNBRK(info->port.tty)) {
2510 		info->ignore_status_mask |= MASK_BREAK;
2511 		/* If ignoring parity and break indicators, ignore
2512 		 * overruns too.  (For real raw support).
2513 		 */
2514 		if (I_IGNPAR(info->port.tty))
2515 			info->ignore_status_mask |= MASK_OVERRUN;
2516 	}
2517 
2518 	program_hw(info);
2519 }
2520 
get_stats(struct slgt_info * info,struct mgsl_icount __user * user_icount)2521 static int get_stats(struct slgt_info *info, struct mgsl_icount __user *user_icount)
2522 {
2523 	DBGINFO(("%s get_stats\n",  info->device_name));
2524 	if (!user_icount) {
2525 		memset(&info->icount, 0, sizeof(info->icount));
2526 	} else {
2527 		if (copy_to_user(user_icount, &info->icount, sizeof(struct mgsl_icount)))
2528 			return -EFAULT;
2529 	}
2530 	return 0;
2531 }
2532 
get_params(struct slgt_info * info,MGSL_PARAMS __user * user_params)2533 static int get_params(struct slgt_info *info, MGSL_PARAMS __user *user_params)
2534 {
2535 	DBGINFO(("%s get_params\n", info->device_name));
2536 	if (copy_to_user(user_params, &info->params, sizeof(MGSL_PARAMS)))
2537 		return -EFAULT;
2538 	return 0;
2539 }
2540 
set_params(struct slgt_info * info,MGSL_PARAMS __user * new_params)2541 static int set_params(struct slgt_info *info, MGSL_PARAMS __user *new_params)
2542 {
2543  	unsigned long flags;
2544 	MGSL_PARAMS tmp_params;
2545 
2546 	DBGINFO(("%s set_params\n", info->device_name));
2547 	if (copy_from_user(&tmp_params, new_params, sizeof(MGSL_PARAMS)))
2548 		return -EFAULT;
2549 
2550 	spin_lock_irqsave(&info->lock, flags);
2551 	if (tmp_params.mode == MGSL_MODE_BASE_CLOCK)
2552 		info->base_clock = tmp_params.clock_speed;
2553 	else
2554 		memcpy(&info->params, &tmp_params, sizeof(MGSL_PARAMS));
2555 	spin_unlock_irqrestore(&info->lock, flags);
2556 
2557 	program_hw(info);
2558 
2559 	return 0;
2560 }
2561 
get_txidle(struct slgt_info * info,int __user * idle_mode)2562 static int get_txidle(struct slgt_info *info, int __user *idle_mode)
2563 {
2564 	DBGINFO(("%s get_txidle=%d\n", info->device_name, info->idle_mode));
2565 	if (put_user(info->idle_mode, idle_mode))
2566 		return -EFAULT;
2567 	return 0;
2568 }
2569 
set_txidle(struct slgt_info * info,int idle_mode)2570 static int set_txidle(struct slgt_info *info, int idle_mode)
2571 {
2572  	unsigned long flags;
2573 	DBGINFO(("%s set_txidle(%d)\n", info->device_name, idle_mode));
2574 	spin_lock_irqsave(&info->lock,flags);
2575 	info->idle_mode = idle_mode;
2576 	if (info->params.mode != MGSL_MODE_ASYNC)
2577 		tx_set_idle(info);
2578 	spin_unlock_irqrestore(&info->lock,flags);
2579 	return 0;
2580 }
2581 
tx_enable(struct slgt_info * info,int enable)2582 static int tx_enable(struct slgt_info *info, int enable)
2583 {
2584  	unsigned long flags;
2585 	DBGINFO(("%s tx_enable(%d)\n", info->device_name, enable));
2586 	spin_lock_irqsave(&info->lock,flags);
2587 	if (enable) {
2588 		if (!info->tx_enabled)
2589 			tx_start(info);
2590 	} else {
2591 		if (info->tx_enabled)
2592 			tx_stop(info);
2593 	}
2594 	spin_unlock_irqrestore(&info->lock,flags);
2595 	return 0;
2596 }
2597 
2598 /*
2599  * abort transmit HDLC frame
2600  */
tx_abort(struct slgt_info * info)2601 static int tx_abort(struct slgt_info *info)
2602 {
2603  	unsigned long flags;
2604 	DBGINFO(("%s tx_abort\n", info->device_name));
2605 	spin_lock_irqsave(&info->lock,flags);
2606 	tdma_reset(info);
2607 	spin_unlock_irqrestore(&info->lock,flags);
2608 	return 0;
2609 }
2610 
rx_enable(struct slgt_info * info,int enable)2611 static int rx_enable(struct slgt_info *info, int enable)
2612 {
2613  	unsigned long flags;
2614 	unsigned int rbuf_fill_level;
2615 	DBGINFO(("%s rx_enable(%08x)\n", info->device_name, enable));
2616 	spin_lock_irqsave(&info->lock,flags);
2617 	/*
2618 	 * enable[31..16] = receive DMA buffer fill level
2619 	 * 0 = noop (leave fill level unchanged)
2620 	 * fill level must be multiple of 4 and <= buffer size
2621 	 */
2622 	rbuf_fill_level = ((unsigned int)enable) >> 16;
2623 	if (rbuf_fill_level) {
2624 		if ((rbuf_fill_level > DMABUFSIZE) || (rbuf_fill_level % 4)) {
2625 			spin_unlock_irqrestore(&info->lock, flags);
2626 			return -EINVAL;
2627 		}
2628 		info->rbuf_fill_level = rbuf_fill_level;
2629 		if (rbuf_fill_level < 128)
2630 			info->rx_pio = 1; /* PIO mode */
2631 		else
2632 			info->rx_pio = 0; /* DMA mode */
2633 		rx_stop(info); /* restart receiver to use new fill level */
2634 	}
2635 
2636 	/*
2637 	 * enable[1..0] = receiver enable command
2638 	 * 0 = disable
2639 	 * 1 = enable
2640 	 * 2 = enable or force hunt mode if already enabled
2641 	 */
2642 	enable &= 3;
2643 	if (enable) {
2644 		if (!info->rx_enabled)
2645 			rx_start(info);
2646 		else if (enable == 2) {
2647 			/* force hunt mode (write 1 to RCR[3]) */
2648 			wr_reg16(info, RCR, rd_reg16(info, RCR) | BIT3);
2649 		}
2650 	} else {
2651 		if (info->rx_enabled)
2652 			rx_stop(info);
2653 	}
2654 	spin_unlock_irqrestore(&info->lock,flags);
2655 	return 0;
2656 }
2657 
2658 /*
2659  *  wait for specified event to occur
2660  */
wait_mgsl_event(struct slgt_info * info,int __user * mask_ptr)2661 static int wait_mgsl_event(struct slgt_info *info, int __user *mask_ptr)
2662 {
2663  	unsigned long flags;
2664 	int s;
2665 	int rc=0;
2666 	struct mgsl_icount cprev, cnow;
2667 	int events;
2668 	int mask;
2669 	struct	_input_signal_events oldsigs, newsigs;
2670 	DECLARE_WAITQUEUE(wait, current);
2671 
2672 	if (get_user(mask, mask_ptr))
2673 		return -EFAULT;
2674 
2675 	DBGINFO(("%s wait_mgsl_event(%d)\n", info->device_name, mask));
2676 
2677 	spin_lock_irqsave(&info->lock,flags);
2678 
2679 	/* return immediately if state matches requested events */
2680 	get_gtsignals(info);
2681 	s = info->signals;
2682 
2683 	events = mask &
2684 		( ((s & SerialSignal_DSR) ? MgslEvent_DsrActive:MgslEvent_DsrInactive) +
2685  		  ((s & SerialSignal_DCD) ? MgslEvent_DcdActive:MgslEvent_DcdInactive) +
2686 		  ((s & SerialSignal_CTS) ? MgslEvent_CtsActive:MgslEvent_CtsInactive) +
2687 		  ((s & SerialSignal_RI)  ? MgslEvent_RiActive :MgslEvent_RiInactive) );
2688 	if (events) {
2689 		spin_unlock_irqrestore(&info->lock,flags);
2690 		goto exit;
2691 	}
2692 
2693 	/* save current irq counts */
2694 	cprev = info->icount;
2695 	oldsigs = info->input_signal_events;
2696 
2697 	/* enable hunt and idle irqs if needed */
2698 	if (mask & (MgslEvent_ExitHuntMode+MgslEvent_IdleReceived)) {
2699 		unsigned short val = rd_reg16(info, SCR);
2700 		if (!(val & IRQ_RXIDLE))
2701 			wr_reg16(info, SCR, (unsigned short)(val | IRQ_RXIDLE));
2702 	}
2703 
2704 	set_current_state(TASK_INTERRUPTIBLE);
2705 	add_wait_queue(&info->event_wait_q, &wait);
2706 
2707 	spin_unlock_irqrestore(&info->lock,flags);
2708 
2709 	for(;;) {
2710 		schedule();
2711 		if (signal_pending(current)) {
2712 			rc = -ERESTARTSYS;
2713 			break;
2714 		}
2715 
2716 		/* get current irq counts */
2717 		spin_lock_irqsave(&info->lock,flags);
2718 		cnow = info->icount;
2719 		newsigs = info->input_signal_events;
2720 		set_current_state(TASK_INTERRUPTIBLE);
2721 		spin_unlock_irqrestore(&info->lock,flags);
2722 
2723 		/* if no change, wait aborted for some reason */
2724 		if (newsigs.dsr_up   == oldsigs.dsr_up   &&
2725 		    newsigs.dsr_down == oldsigs.dsr_down &&
2726 		    newsigs.dcd_up   == oldsigs.dcd_up   &&
2727 		    newsigs.dcd_down == oldsigs.dcd_down &&
2728 		    newsigs.cts_up   == oldsigs.cts_up   &&
2729 		    newsigs.cts_down == oldsigs.cts_down &&
2730 		    newsigs.ri_up    == oldsigs.ri_up    &&
2731 		    newsigs.ri_down  == oldsigs.ri_down  &&
2732 		    cnow.exithunt    == cprev.exithunt   &&
2733 		    cnow.rxidle      == cprev.rxidle) {
2734 			rc = -EIO;
2735 			break;
2736 		}
2737 
2738 		events = mask &
2739 			( (newsigs.dsr_up   != oldsigs.dsr_up   ? MgslEvent_DsrActive:0)   +
2740 			  (newsigs.dsr_down != oldsigs.dsr_down ? MgslEvent_DsrInactive:0) +
2741 			  (newsigs.dcd_up   != oldsigs.dcd_up   ? MgslEvent_DcdActive:0)   +
2742 			  (newsigs.dcd_down != oldsigs.dcd_down ? MgslEvent_DcdInactive:0) +
2743 			  (newsigs.cts_up   != oldsigs.cts_up   ? MgslEvent_CtsActive:0)   +
2744 			  (newsigs.cts_down != oldsigs.cts_down ? MgslEvent_CtsInactive:0) +
2745 			  (newsigs.ri_up    != oldsigs.ri_up    ? MgslEvent_RiActive:0)    +
2746 			  (newsigs.ri_down  != oldsigs.ri_down  ? MgslEvent_RiInactive:0)  +
2747 			  (cnow.exithunt    != cprev.exithunt   ? MgslEvent_ExitHuntMode:0) +
2748 			  (cnow.rxidle      != cprev.rxidle     ? MgslEvent_IdleReceived:0) );
2749 		if (events)
2750 			break;
2751 
2752 		cprev = cnow;
2753 		oldsigs = newsigs;
2754 	}
2755 
2756 	remove_wait_queue(&info->event_wait_q, &wait);
2757 	set_current_state(TASK_RUNNING);
2758 
2759 
2760 	if (mask & (MgslEvent_ExitHuntMode + MgslEvent_IdleReceived)) {
2761 		spin_lock_irqsave(&info->lock,flags);
2762 		if (!waitqueue_active(&info->event_wait_q)) {
2763 			/* disable enable exit hunt mode/idle rcvd IRQs */
2764 			wr_reg16(info, SCR,
2765 				(unsigned short)(rd_reg16(info, SCR) & ~IRQ_RXIDLE));
2766 		}
2767 		spin_unlock_irqrestore(&info->lock,flags);
2768 	}
2769 exit:
2770 	if (rc == 0)
2771 		rc = put_user(events, mask_ptr);
2772 	return rc;
2773 }
2774 
get_interface(struct slgt_info * info,int __user * if_mode)2775 static int get_interface(struct slgt_info *info, int __user *if_mode)
2776 {
2777 	DBGINFO(("%s get_interface=%x\n", info->device_name, info->if_mode));
2778 	if (put_user(info->if_mode, if_mode))
2779 		return -EFAULT;
2780 	return 0;
2781 }
2782 
set_interface(struct slgt_info * info,int if_mode)2783 static int set_interface(struct slgt_info *info, int if_mode)
2784 {
2785  	unsigned long flags;
2786 	unsigned short val;
2787 
2788 	DBGINFO(("%s set_interface=%x)\n", info->device_name, if_mode));
2789 	spin_lock_irqsave(&info->lock,flags);
2790 	info->if_mode = if_mode;
2791 
2792 	msc_set_vcr(info);
2793 
2794 	/* TCR (tx control) 07  1=RTS driver control */
2795 	val = rd_reg16(info, TCR);
2796 	if (info->if_mode & MGSL_INTERFACE_RTS_EN)
2797 		val |= BIT7;
2798 	else
2799 		val &= ~BIT7;
2800 	wr_reg16(info, TCR, val);
2801 
2802 	spin_unlock_irqrestore(&info->lock,flags);
2803 	return 0;
2804 }
2805 
get_xsync(struct slgt_info * info,int __user * xsync)2806 static int get_xsync(struct slgt_info *info, int __user *xsync)
2807 {
2808 	DBGINFO(("%s get_xsync=%x\n", info->device_name, info->xsync));
2809 	if (put_user(info->xsync, xsync))
2810 		return -EFAULT;
2811 	return 0;
2812 }
2813 
2814 /*
2815  * set extended sync pattern (1 to 4 bytes) for extended sync mode
2816  *
2817  * sync pattern is contained in least significant bytes of value
2818  * most significant byte of sync pattern is oldest (1st sent/detected)
2819  */
set_xsync(struct slgt_info * info,int xsync)2820 static int set_xsync(struct slgt_info *info, int xsync)
2821 {
2822 	unsigned long flags;
2823 
2824 	DBGINFO(("%s set_xsync=%x)\n", info->device_name, xsync));
2825 	spin_lock_irqsave(&info->lock, flags);
2826 	info->xsync = xsync;
2827 	wr_reg32(info, XSR, xsync);
2828 	spin_unlock_irqrestore(&info->lock, flags);
2829 	return 0;
2830 }
2831 
get_xctrl(struct slgt_info * info,int __user * xctrl)2832 static int get_xctrl(struct slgt_info *info, int __user *xctrl)
2833 {
2834 	DBGINFO(("%s get_xctrl=%x\n", info->device_name, info->xctrl));
2835 	if (put_user(info->xctrl, xctrl))
2836 		return -EFAULT;
2837 	return 0;
2838 }
2839 
2840 /*
2841  * set extended control options
2842  *
2843  * xctrl[31:19] reserved, must be zero
2844  * xctrl[18:17] extended sync pattern length in bytes
2845  *              00 = 1 byte  in xsr[7:0]
2846  *              01 = 2 bytes in xsr[15:0]
2847  *              10 = 3 bytes in xsr[23:0]
2848  *              11 = 4 bytes in xsr[31:0]
2849  * xctrl[16]    1 = enable terminal count, 0=disabled
2850  * xctrl[15:0]  receive terminal count for fixed length packets
2851  *              value is count minus one (0 = 1 byte packet)
2852  *              when terminal count is reached, receiver
2853  *              automatically returns to hunt mode and receive
2854  *              FIFO contents are flushed to DMA buffers with
2855  *              end of frame (EOF) status
2856  */
set_xctrl(struct slgt_info * info,int xctrl)2857 static int set_xctrl(struct slgt_info *info, int xctrl)
2858 {
2859 	unsigned long flags;
2860 
2861 	DBGINFO(("%s set_xctrl=%x)\n", info->device_name, xctrl));
2862 	spin_lock_irqsave(&info->lock, flags);
2863 	info->xctrl = xctrl;
2864 	wr_reg32(info, XCR, xctrl);
2865 	spin_unlock_irqrestore(&info->lock, flags);
2866 	return 0;
2867 }
2868 
2869 /*
2870  * set general purpose IO pin state and direction
2871  *
2872  * user_gpio fields:
2873  * state   each bit indicates a pin state
2874  * smask   set bit indicates pin state to set
2875  * dir     each bit indicates a pin direction (0=input, 1=output)
2876  * dmask   set bit indicates pin direction to set
2877  */
set_gpio(struct slgt_info * info,struct gpio_desc __user * user_gpio)2878 static int set_gpio(struct slgt_info *info, struct gpio_desc __user *user_gpio)
2879 {
2880  	unsigned long flags;
2881 	struct gpio_desc gpio;
2882 	__u32 data;
2883 
2884 	if (!info->gpio_present)
2885 		return -EINVAL;
2886 	if (copy_from_user(&gpio, user_gpio, sizeof(gpio)))
2887 		return -EFAULT;
2888 	DBGINFO(("%s set_gpio state=%08x smask=%08x dir=%08x dmask=%08x\n",
2889 		 info->device_name, gpio.state, gpio.smask,
2890 		 gpio.dir, gpio.dmask));
2891 
2892 	spin_lock_irqsave(&info->port_array[0]->lock, flags);
2893 	if (gpio.dmask) {
2894 		data = rd_reg32(info, IODR);
2895 		data |= gpio.dmask & gpio.dir;
2896 		data &= ~(gpio.dmask & ~gpio.dir);
2897 		wr_reg32(info, IODR, data);
2898 	}
2899 	if (gpio.smask) {
2900 		data = rd_reg32(info, IOVR);
2901 		data |= gpio.smask & gpio.state;
2902 		data &= ~(gpio.smask & ~gpio.state);
2903 		wr_reg32(info, IOVR, data);
2904 	}
2905 	spin_unlock_irqrestore(&info->port_array[0]->lock, flags);
2906 
2907 	return 0;
2908 }
2909 
2910 /*
2911  * get general purpose IO pin state and direction
2912  */
get_gpio(struct slgt_info * info,struct gpio_desc __user * user_gpio)2913 static int get_gpio(struct slgt_info *info, struct gpio_desc __user *user_gpio)
2914 {
2915 	struct gpio_desc gpio;
2916 	if (!info->gpio_present)
2917 		return -EINVAL;
2918 	gpio.state = rd_reg32(info, IOVR);
2919 	gpio.smask = 0xffffffff;
2920 	gpio.dir   = rd_reg32(info, IODR);
2921 	gpio.dmask = 0xffffffff;
2922 	if (copy_to_user(user_gpio, &gpio, sizeof(gpio)))
2923 		return -EFAULT;
2924 	DBGINFO(("%s get_gpio state=%08x dir=%08x\n",
2925 		 info->device_name, gpio.state, gpio.dir));
2926 	return 0;
2927 }
2928 
2929 /*
2930  * conditional wait facility
2931  */
init_cond_wait(struct cond_wait * w,unsigned int data)2932 static void init_cond_wait(struct cond_wait *w, unsigned int data)
2933 {
2934 	init_waitqueue_head(&w->q);
2935 	init_waitqueue_entry(&w->wait, current);
2936 	w->data = data;
2937 }
2938 
add_cond_wait(struct cond_wait ** head,struct cond_wait * w)2939 static void add_cond_wait(struct cond_wait **head, struct cond_wait *w)
2940 {
2941 	set_current_state(TASK_INTERRUPTIBLE);
2942 	add_wait_queue(&w->q, &w->wait);
2943 	w->next = *head;
2944 	*head = w;
2945 }
2946 
remove_cond_wait(struct cond_wait ** head,struct cond_wait * cw)2947 static void remove_cond_wait(struct cond_wait **head, struct cond_wait *cw)
2948 {
2949 	struct cond_wait *w, *prev;
2950 	remove_wait_queue(&cw->q, &cw->wait);
2951 	set_current_state(TASK_RUNNING);
2952 	for (w = *head, prev = NULL ; w != NULL ; prev = w, w = w->next) {
2953 		if (w == cw) {
2954 			if (prev != NULL)
2955 				prev->next = w->next;
2956 			else
2957 				*head = w->next;
2958 			break;
2959 		}
2960 	}
2961 }
2962 
flush_cond_wait(struct cond_wait ** head)2963 static void flush_cond_wait(struct cond_wait **head)
2964 {
2965 	while (*head != NULL) {
2966 		wake_up_interruptible(&(*head)->q);
2967 		*head = (*head)->next;
2968 	}
2969 }
2970 
2971 /*
2972  * wait for general purpose I/O pin(s) to enter specified state
2973  *
2974  * user_gpio fields:
2975  * state - bit indicates target pin state
2976  * smask - set bit indicates watched pin
2977  *
2978  * The wait ends when at least one watched pin enters the specified
2979  * state. When 0 (no error) is returned, user_gpio->state is set to the
2980  * state of all GPIO pins when the wait ends.
2981  *
2982  * Note: Each pin may be a dedicated input, dedicated output, or
2983  * configurable input/output. The number and configuration of pins
2984  * varies with the specific adapter model. Only input pins (dedicated
2985  * or configured) can be monitored with this function.
2986  */
wait_gpio(struct slgt_info * info,struct gpio_desc __user * user_gpio)2987 static int wait_gpio(struct slgt_info *info, struct gpio_desc __user *user_gpio)
2988 {
2989  	unsigned long flags;
2990 	int rc = 0;
2991 	struct gpio_desc gpio;
2992 	struct cond_wait wait;
2993 	u32 state;
2994 
2995 	if (!info->gpio_present)
2996 		return -EINVAL;
2997 	if (copy_from_user(&gpio, user_gpio, sizeof(gpio)))
2998 		return -EFAULT;
2999 	DBGINFO(("%s wait_gpio() state=%08x smask=%08x\n",
3000 		 info->device_name, gpio.state, gpio.smask));
3001 	/* ignore output pins identified by set IODR bit */
3002 	if ((gpio.smask &= ~rd_reg32(info, IODR)) == 0)
3003 		return -EINVAL;
3004 	init_cond_wait(&wait, gpio.smask);
3005 
3006 	spin_lock_irqsave(&info->port_array[0]->lock, flags);
3007 	/* enable interrupts for watched pins */
3008 	wr_reg32(info, IOER, rd_reg32(info, IOER) | gpio.smask);
3009 	/* get current pin states */
3010 	state = rd_reg32(info, IOVR);
3011 
3012 	if (gpio.smask & ~(state ^ gpio.state)) {
3013 		/* already in target state */
3014 		gpio.state = state;
3015 	} else {
3016 		/* wait for target state */
3017 		add_cond_wait(&info->gpio_wait_q, &wait);
3018 		spin_unlock_irqrestore(&info->port_array[0]->lock, flags);
3019 		schedule();
3020 		if (signal_pending(current))
3021 			rc = -ERESTARTSYS;
3022 		else
3023 			gpio.state = wait.data;
3024 		spin_lock_irqsave(&info->port_array[0]->lock, flags);
3025 		remove_cond_wait(&info->gpio_wait_q, &wait);
3026 	}
3027 
3028 	/* disable all GPIO interrupts if no waiting processes */
3029 	if (info->gpio_wait_q == NULL)
3030 		wr_reg32(info, IOER, 0);
3031 	spin_unlock_irqrestore(&info->port_array[0]->lock, flags);
3032 
3033 	if ((rc == 0) && copy_to_user(user_gpio, &gpio, sizeof(gpio)))
3034 		rc = -EFAULT;
3035 	return rc;
3036 }
3037 
modem_input_wait(struct slgt_info * info,int arg)3038 static int modem_input_wait(struct slgt_info *info,int arg)
3039 {
3040  	unsigned long flags;
3041 	int rc;
3042 	struct mgsl_icount cprev, cnow;
3043 	DECLARE_WAITQUEUE(wait, current);
3044 
3045 	/* save current irq counts */
3046 	spin_lock_irqsave(&info->lock,flags);
3047 	cprev = info->icount;
3048 	add_wait_queue(&info->status_event_wait_q, &wait);
3049 	set_current_state(TASK_INTERRUPTIBLE);
3050 	spin_unlock_irqrestore(&info->lock,flags);
3051 
3052 	for(;;) {
3053 		schedule();
3054 		if (signal_pending(current)) {
3055 			rc = -ERESTARTSYS;
3056 			break;
3057 		}
3058 
3059 		/* get new irq counts */
3060 		spin_lock_irqsave(&info->lock,flags);
3061 		cnow = info->icount;
3062 		set_current_state(TASK_INTERRUPTIBLE);
3063 		spin_unlock_irqrestore(&info->lock,flags);
3064 
3065 		/* if no change, wait aborted for some reason */
3066 		if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
3067 		    cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) {
3068 			rc = -EIO;
3069 			break;
3070 		}
3071 
3072 		/* check for change in caller specified modem input */
3073 		if ((arg & TIOCM_RNG && cnow.rng != cprev.rng) ||
3074 		    (arg & TIOCM_DSR && cnow.dsr != cprev.dsr) ||
3075 		    (arg & TIOCM_CD  && cnow.dcd != cprev.dcd) ||
3076 		    (arg & TIOCM_CTS && cnow.cts != cprev.cts)) {
3077 			rc = 0;
3078 			break;
3079 		}
3080 
3081 		cprev = cnow;
3082 	}
3083 	remove_wait_queue(&info->status_event_wait_q, &wait);
3084 	set_current_state(TASK_RUNNING);
3085 	return rc;
3086 }
3087 
3088 /*
3089  *  return state of serial control and status signals
3090  */
tiocmget(struct tty_struct * tty)3091 static int tiocmget(struct tty_struct *tty)
3092 {
3093 	struct slgt_info *info = tty->driver_data;
3094 	unsigned int result;
3095  	unsigned long flags;
3096 
3097 	spin_lock_irqsave(&info->lock,flags);
3098  	get_gtsignals(info);
3099 	spin_unlock_irqrestore(&info->lock,flags);
3100 
3101 	result = ((info->signals & SerialSignal_RTS) ? TIOCM_RTS:0) +
3102 		((info->signals & SerialSignal_DTR) ? TIOCM_DTR:0) +
3103 		((info->signals & SerialSignal_DCD) ? TIOCM_CAR:0) +
3104 		((info->signals & SerialSignal_RI)  ? TIOCM_RNG:0) +
3105 		((info->signals & SerialSignal_DSR) ? TIOCM_DSR:0) +
3106 		((info->signals & SerialSignal_CTS) ? TIOCM_CTS:0);
3107 
3108 	DBGINFO(("%s tiocmget value=%08X\n", info->device_name, result));
3109 	return result;
3110 }
3111 
3112 /*
3113  * set modem control signals (DTR/RTS)
3114  *
3115  * 	cmd	signal command: TIOCMBIS = set bit TIOCMBIC = clear bit
3116  *		TIOCMSET = set/clear signal values
3117  * 	value	bit mask for command
3118  */
tiocmset(struct tty_struct * tty,unsigned int set,unsigned int clear)3119 static int tiocmset(struct tty_struct *tty,
3120 		    unsigned int set, unsigned int clear)
3121 {
3122 	struct slgt_info *info = tty->driver_data;
3123  	unsigned long flags;
3124 
3125 	DBGINFO(("%s tiocmset(%x,%x)\n", info->device_name, set, clear));
3126 
3127 	if (set & TIOCM_RTS)
3128 		info->signals |= SerialSignal_RTS;
3129 	if (set & TIOCM_DTR)
3130 		info->signals |= SerialSignal_DTR;
3131 	if (clear & TIOCM_RTS)
3132 		info->signals &= ~SerialSignal_RTS;
3133 	if (clear & TIOCM_DTR)
3134 		info->signals &= ~SerialSignal_DTR;
3135 
3136 	spin_lock_irqsave(&info->lock,flags);
3137 	set_gtsignals(info);
3138 	spin_unlock_irqrestore(&info->lock,flags);
3139 	return 0;
3140 }
3141 
carrier_raised(struct tty_port * port)3142 static int carrier_raised(struct tty_port *port)
3143 {
3144 	unsigned long flags;
3145 	struct slgt_info *info = container_of(port, struct slgt_info, port);
3146 
3147 	spin_lock_irqsave(&info->lock,flags);
3148 	get_gtsignals(info);
3149 	spin_unlock_irqrestore(&info->lock,flags);
3150 	return (info->signals & SerialSignal_DCD) ? 1 : 0;
3151 }
3152 
dtr_rts(struct tty_port * port,int on)3153 static void dtr_rts(struct tty_port *port, int on)
3154 {
3155 	unsigned long flags;
3156 	struct slgt_info *info = container_of(port, struct slgt_info, port);
3157 
3158 	spin_lock_irqsave(&info->lock,flags);
3159 	if (on)
3160 		info->signals |= SerialSignal_RTS | SerialSignal_DTR;
3161 	else
3162 		info->signals &= ~(SerialSignal_RTS | SerialSignal_DTR);
3163 	set_gtsignals(info);
3164 	spin_unlock_irqrestore(&info->lock,flags);
3165 }
3166 
3167 
3168 /*
3169  *  block current process until the device is ready to open
3170  */
block_til_ready(struct tty_struct * tty,struct file * filp,struct slgt_info * info)3171 static int block_til_ready(struct tty_struct *tty, struct file *filp,
3172 			   struct slgt_info *info)
3173 {
3174 	DECLARE_WAITQUEUE(wait, current);
3175 	int		retval;
3176 	bool		do_clocal = false;
3177 	unsigned long	flags;
3178 	int		cd;
3179 	struct tty_port *port = &info->port;
3180 
3181 	DBGINFO(("%s block_til_ready\n", tty->driver->name));
3182 
3183 	if (filp->f_flags & O_NONBLOCK || tty_io_error(tty)) {
3184 		/* nonblock mode is set or port is not enabled */
3185 		tty_port_set_active(port, 1);
3186 		return 0;
3187 	}
3188 
3189 	if (C_CLOCAL(tty))
3190 		do_clocal = true;
3191 
3192 	/* Wait for carrier detect and the line to become
3193 	 * free (i.e., not in use by the callout).  While we are in
3194 	 * this loop, port->count is dropped by one, so that
3195 	 * close() knows when to free things.  We restore it upon
3196 	 * exit, either normal or abnormal.
3197 	 */
3198 
3199 	retval = 0;
3200 	add_wait_queue(&port->open_wait, &wait);
3201 
3202 	spin_lock_irqsave(&info->lock, flags);
3203 	port->count--;
3204 	spin_unlock_irqrestore(&info->lock, flags);
3205 	port->blocked_open++;
3206 
3207 	while (1) {
3208 		if (C_BAUD(tty) && tty_port_initialized(port))
3209 			tty_port_raise_dtr_rts(port);
3210 
3211 		set_current_state(TASK_INTERRUPTIBLE);
3212 
3213 		if (tty_hung_up_p(filp) || !tty_port_initialized(port)) {
3214 			retval = (port->flags & ASYNC_HUP_NOTIFY) ?
3215 					-EAGAIN : -ERESTARTSYS;
3216 			break;
3217 		}
3218 
3219 		cd = tty_port_carrier_raised(port);
3220 		if (do_clocal || cd)
3221 			break;
3222 
3223 		if (signal_pending(current)) {
3224 			retval = -ERESTARTSYS;
3225 			break;
3226 		}
3227 
3228 		DBGINFO(("%s block_til_ready wait\n", tty->driver->name));
3229 		tty_unlock(tty);
3230 		schedule();
3231 		tty_lock(tty);
3232 	}
3233 
3234 	set_current_state(TASK_RUNNING);
3235 	remove_wait_queue(&port->open_wait, &wait);
3236 
3237 	if (!tty_hung_up_p(filp))
3238 		port->count++;
3239 	port->blocked_open--;
3240 
3241 	if (!retval)
3242 		tty_port_set_active(port, 1);
3243 
3244 	DBGINFO(("%s block_til_ready ready, rc=%d\n", tty->driver->name, retval));
3245 	return retval;
3246 }
3247 
3248 /*
3249  * allocate buffers used for calling line discipline receive_buf
3250  * directly in synchronous mode
3251  * note: add 5 bytes to max frame size to allow appending
3252  * 32-bit CRC and status byte when configured to do so
3253  */
alloc_tmp_rbuf(struct slgt_info * info)3254 static int alloc_tmp_rbuf(struct slgt_info *info)
3255 {
3256 	info->tmp_rbuf = kmalloc(info->max_frame_size + 5, GFP_KERNEL);
3257 	if (info->tmp_rbuf == NULL)
3258 		return -ENOMEM;
3259 	/* unused flag buffer to satisfy receive_buf calling interface */
3260 	info->flag_buf = kzalloc(info->max_frame_size + 5, GFP_KERNEL);
3261 	if (!info->flag_buf) {
3262 		kfree(info->tmp_rbuf);
3263 		info->tmp_rbuf = NULL;
3264 		return -ENOMEM;
3265 	}
3266 	return 0;
3267 }
3268 
free_tmp_rbuf(struct slgt_info * info)3269 static void free_tmp_rbuf(struct slgt_info *info)
3270 {
3271 	kfree(info->tmp_rbuf);
3272 	info->tmp_rbuf = NULL;
3273 	kfree(info->flag_buf);
3274 	info->flag_buf = NULL;
3275 }
3276 
3277 /*
3278  * allocate DMA descriptor lists.
3279  */
alloc_desc(struct slgt_info * info)3280 static int alloc_desc(struct slgt_info *info)
3281 {
3282 	unsigned int i;
3283 	unsigned int pbufs;
3284 
3285 	/* allocate memory to hold descriptor lists */
3286 	info->bufs = dma_alloc_coherent(&info->pdev->dev, DESC_LIST_SIZE,
3287 					&info->bufs_dma_addr, GFP_KERNEL);
3288 	if (info->bufs == NULL)
3289 		return -ENOMEM;
3290 
3291 	info->rbufs = (struct slgt_desc*)info->bufs;
3292 	info->tbufs = ((struct slgt_desc*)info->bufs) + info->rbuf_count;
3293 
3294 	pbufs = (unsigned int)info->bufs_dma_addr;
3295 
3296 	/*
3297 	 * Build circular lists of descriptors
3298 	 */
3299 
3300 	for (i=0; i < info->rbuf_count; i++) {
3301 		/* physical address of this descriptor */
3302 		info->rbufs[i].pdesc = pbufs + (i * sizeof(struct slgt_desc));
3303 
3304 		/* physical address of next descriptor */
3305 		if (i == info->rbuf_count - 1)
3306 			info->rbufs[i].next = cpu_to_le32(pbufs);
3307 		else
3308 			info->rbufs[i].next = cpu_to_le32(pbufs + ((i+1) * sizeof(struct slgt_desc)));
3309 		set_desc_count(info->rbufs[i], DMABUFSIZE);
3310 	}
3311 
3312 	for (i=0; i < info->tbuf_count; i++) {
3313 		/* physical address of this descriptor */
3314 		info->tbufs[i].pdesc = pbufs + ((info->rbuf_count + i) * sizeof(struct slgt_desc));
3315 
3316 		/* physical address of next descriptor */
3317 		if (i == info->tbuf_count - 1)
3318 			info->tbufs[i].next = cpu_to_le32(pbufs + info->rbuf_count * sizeof(struct slgt_desc));
3319 		else
3320 			info->tbufs[i].next = cpu_to_le32(pbufs + ((info->rbuf_count + i + 1) * sizeof(struct slgt_desc)));
3321 	}
3322 
3323 	return 0;
3324 }
3325 
free_desc(struct slgt_info * info)3326 static void free_desc(struct slgt_info *info)
3327 {
3328 	if (info->bufs != NULL) {
3329 		dma_free_coherent(&info->pdev->dev, DESC_LIST_SIZE,
3330 				  info->bufs, info->bufs_dma_addr);
3331 		info->bufs  = NULL;
3332 		info->rbufs = NULL;
3333 		info->tbufs = NULL;
3334 	}
3335 }
3336 
alloc_bufs(struct slgt_info * info,struct slgt_desc * bufs,int count)3337 static int alloc_bufs(struct slgt_info *info, struct slgt_desc *bufs, int count)
3338 {
3339 	int i;
3340 	for (i=0; i < count; i++) {
3341 		bufs[i].buf = dma_alloc_coherent(&info->pdev->dev, DMABUFSIZE,
3342 						 &bufs[i].buf_dma_addr, GFP_KERNEL);
3343 		if (!bufs[i].buf)
3344 			return -ENOMEM;
3345 		bufs[i].pbuf  = cpu_to_le32((unsigned int)bufs[i].buf_dma_addr);
3346 	}
3347 	return 0;
3348 }
3349 
free_bufs(struct slgt_info * info,struct slgt_desc * bufs,int count)3350 static void free_bufs(struct slgt_info *info, struct slgt_desc *bufs, int count)
3351 {
3352 	int i;
3353 	for (i=0; i < count; i++) {
3354 		if (bufs[i].buf == NULL)
3355 			continue;
3356 		dma_free_coherent(&info->pdev->dev, DMABUFSIZE, bufs[i].buf,
3357 				  bufs[i].buf_dma_addr);
3358 		bufs[i].buf = NULL;
3359 	}
3360 }
3361 
alloc_dma_bufs(struct slgt_info * info)3362 static int alloc_dma_bufs(struct slgt_info *info)
3363 {
3364 	info->rbuf_count = 32;
3365 	info->tbuf_count = 32;
3366 
3367 	if (alloc_desc(info) < 0 ||
3368 	    alloc_bufs(info, info->rbufs, info->rbuf_count) < 0 ||
3369 	    alloc_bufs(info, info->tbufs, info->tbuf_count) < 0 ||
3370 	    alloc_tmp_rbuf(info) < 0) {
3371 		DBGERR(("%s DMA buffer alloc fail\n", info->device_name));
3372 		return -ENOMEM;
3373 	}
3374 	reset_rbufs(info);
3375 	return 0;
3376 }
3377 
free_dma_bufs(struct slgt_info * info)3378 static void free_dma_bufs(struct slgt_info *info)
3379 {
3380 	if (info->bufs) {
3381 		free_bufs(info, info->rbufs, info->rbuf_count);
3382 		free_bufs(info, info->tbufs, info->tbuf_count);
3383 		free_desc(info);
3384 	}
3385 	free_tmp_rbuf(info);
3386 }
3387 
claim_resources(struct slgt_info * info)3388 static int claim_resources(struct slgt_info *info)
3389 {
3390 	if (request_mem_region(info->phys_reg_addr, SLGT_REG_SIZE, "synclink_gt") == NULL) {
3391 		DBGERR(("%s reg addr conflict, addr=%08X\n",
3392 			info->device_name, info->phys_reg_addr));
3393 		info->init_error = DiagStatus_AddressConflict;
3394 		goto errout;
3395 	}
3396 	else
3397 		info->reg_addr_requested = true;
3398 
3399 	info->reg_addr = ioremap(info->phys_reg_addr, SLGT_REG_SIZE);
3400 	if (!info->reg_addr) {
3401 		DBGERR(("%s can't map device registers, addr=%08X\n",
3402 			info->device_name, info->phys_reg_addr));
3403 		info->init_error = DiagStatus_CantAssignPciResources;
3404 		goto errout;
3405 	}
3406 	return 0;
3407 
3408 errout:
3409 	release_resources(info);
3410 	return -ENODEV;
3411 }
3412 
release_resources(struct slgt_info * info)3413 static void release_resources(struct slgt_info *info)
3414 {
3415 	if (info->irq_requested) {
3416 		free_irq(info->irq_level, info);
3417 		info->irq_requested = false;
3418 	}
3419 
3420 	if (info->reg_addr_requested) {
3421 		release_mem_region(info->phys_reg_addr, SLGT_REG_SIZE);
3422 		info->reg_addr_requested = false;
3423 	}
3424 
3425 	if (info->reg_addr) {
3426 		iounmap(info->reg_addr);
3427 		info->reg_addr = NULL;
3428 	}
3429 }
3430 
3431 /* Add the specified device instance data structure to the
3432  * global linked list of devices and increment the device count.
3433  */
add_device(struct slgt_info * info)3434 static void add_device(struct slgt_info *info)
3435 {
3436 	char *devstr;
3437 
3438 	info->next_device = NULL;
3439 	info->line = slgt_device_count;
3440 	sprintf(info->device_name, "%s%d", tty_dev_prefix, info->line);
3441 
3442 	if (info->line < MAX_DEVICES) {
3443 		if (maxframe[info->line])
3444 			info->max_frame_size = maxframe[info->line];
3445 	}
3446 
3447 	slgt_device_count++;
3448 
3449 	if (!slgt_device_list)
3450 		slgt_device_list = info;
3451 	else {
3452 		struct slgt_info *current_dev = slgt_device_list;
3453 		while(current_dev->next_device)
3454 			current_dev = current_dev->next_device;
3455 		current_dev->next_device = info;
3456 	}
3457 
3458 	if (info->max_frame_size < 4096)
3459 		info->max_frame_size = 4096;
3460 	else if (info->max_frame_size > 65535)
3461 		info->max_frame_size = 65535;
3462 
3463 	switch(info->pdev->device) {
3464 	case SYNCLINK_GT_DEVICE_ID:
3465 		devstr = "GT";
3466 		break;
3467 	case SYNCLINK_GT2_DEVICE_ID:
3468 		devstr = "GT2";
3469 		break;
3470 	case SYNCLINK_GT4_DEVICE_ID:
3471 		devstr = "GT4";
3472 		break;
3473 	case SYNCLINK_AC_DEVICE_ID:
3474 		devstr = "AC";
3475 		info->params.mode = MGSL_MODE_ASYNC;
3476 		break;
3477 	default:
3478 		devstr = "(unknown model)";
3479 	}
3480 	printk("SyncLink %s %s IO=%08x IRQ=%d MaxFrameSize=%u\n",
3481 		devstr, info->device_name, info->phys_reg_addr,
3482 		info->irq_level, info->max_frame_size);
3483 
3484 #if SYNCLINK_GENERIC_HDLC
3485 	hdlcdev_init(info);
3486 #endif
3487 }
3488 
3489 static const struct tty_port_operations slgt_port_ops = {
3490 	.carrier_raised = carrier_raised,
3491 	.dtr_rts = dtr_rts,
3492 };
3493 
3494 /*
3495  *  allocate device instance structure, return NULL on failure
3496  */
alloc_dev(int adapter_num,int port_num,struct pci_dev * pdev)3497 static struct slgt_info *alloc_dev(int adapter_num, int port_num, struct pci_dev *pdev)
3498 {
3499 	struct slgt_info *info;
3500 
3501 	info = kzalloc(sizeof(struct slgt_info), GFP_KERNEL);
3502 
3503 	if (!info) {
3504 		DBGERR(("%s device alloc failed adapter=%d port=%d\n",
3505 			driver_name, adapter_num, port_num));
3506 	} else {
3507 		tty_port_init(&info->port);
3508 		info->port.ops = &slgt_port_ops;
3509 		info->magic = MGSL_MAGIC;
3510 		INIT_WORK(&info->task, bh_handler);
3511 		info->max_frame_size = 4096;
3512 		info->base_clock = 14745600;
3513 		info->rbuf_fill_level = DMABUFSIZE;
3514 		info->port.close_delay = 5*HZ/10;
3515 		info->port.closing_wait = 30*HZ;
3516 		init_waitqueue_head(&info->status_event_wait_q);
3517 		init_waitqueue_head(&info->event_wait_q);
3518 		spin_lock_init(&info->netlock);
3519 		memcpy(&info->params,&default_params,sizeof(MGSL_PARAMS));
3520 		info->idle_mode = HDLC_TXIDLE_FLAGS;
3521 		info->adapter_num = adapter_num;
3522 		info->port_num = port_num;
3523 
3524 		timer_setup(&info->tx_timer, tx_timeout, 0);
3525 		timer_setup(&info->rx_timer, rx_timeout, 0);
3526 
3527 		/* Copy configuration info to device instance data */
3528 		info->pdev = pdev;
3529 		info->irq_level = pdev->irq;
3530 		info->phys_reg_addr = pci_resource_start(pdev,0);
3531 
3532 		info->bus_type = MGSL_BUS_TYPE_PCI;
3533 		info->irq_flags = IRQF_SHARED;
3534 
3535 		info->init_error = -1; /* assume error, set to 0 on successful init */
3536 	}
3537 
3538 	return info;
3539 }
3540 
device_init(int adapter_num,struct pci_dev * pdev)3541 static void device_init(int adapter_num, struct pci_dev *pdev)
3542 {
3543 	struct slgt_info *port_array[SLGT_MAX_PORTS];
3544 	int i;
3545 	int port_count = 1;
3546 
3547 	if (pdev->device == SYNCLINK_GT2_DEVICE_ID)
3548 		port_count = 2;
3549 	else if (pdev->device == SYNCLINK_GT4_DEVICE_ID)
3550 		port_count = 4;
3551 
3552 	/* allocate device instances for all ports */
3553 	for (i=0; i < port_count; ++i) {
3554 		port_array[i] = alloc_dev(adapter_num, i, pdev);
3555 		if (port_array[i] == NULL) {
3556 			for (--i; i >= 0; --i) {
3557 				tty_port_destroy(&port_array[i]->port);
3558 				kfree(port_array[i]);
3559 			}
3560 			return;
3561 		}
3562 	}
3563 
3564 	/* give copy of port_array to all ports and add to device list  */
3565 	for (i=0; i < port_count; ++i) {
3566 		memcpy(port_array[i]->port_array, port_array, sizeof(port_array));
3567 		add_device(port_array[i]);
3568 		port_array[i]->port_count = port_count;
3569 		spin_lock_init(&port_array[i]->lock);
3570 	}
3571 
3572 	/* Allocate and claim adapter resources */
3573 	if (!claim_resources(port_array[0])) {
3574 
3575 		alloc_dma_bufs(port_array[0]);
3576 
3577 		/* copy resource information from first port to others */
3578 		for (i = 1; i < port_count; ++i) {
3579 			port_array[i]->irq_level = port_array[0]->irq_level;
3580 			port_array[i]->reg_addr  = port_array[0]->reg_addr;
3581 			alloc_dma_bufs(port_array[i]);
3582 		}
3583 
3584 		if (request_irq(port_array[0]->irq_level,
3585 					slgt_interrupt,
3586 					port_array[0]->irq_flags,
3587 					port_array[0]->device_name,
3588 					port_array[0]) < 0) {
3589 			DBGERR(("%s request_irq failed IRQ=%d\n",
3590 				port_array[0]->device_name,
3591 				port_array[0]->irq_level));
3592 		} else {
3593 			port_array[0]->irq_requested = true;
3594 			adapter_test(port_array[0]);
3595 			for (i=1 ; i < port_count ; i++) {
3596 				port_array[i]->init_error = port_array[0]->init_error;
3597 				port_array[i]->gpio_present = port_array[0]->gpio_present;
3598 			}
3599 		}
3600 	}
3601 
3602 	for (i = 0; i < port_count; ++i) {
3603 		struct slgt_info *info = port_array[i];
3604 		tty_port_register_device(&info->port, serial_driver, info->line,
3605 				&info->pdev->dev);
3606 	}
3607 }
3608 
init_one(struct pci_dev * dev,const struct pci_device_id * ent)3609 static int init_one(struct pci_dev *dev,
3610 			      const struct pci_device_id *ent)
3611 {
3612 	if (pci_enable_device(dev)) {
3613 		printk("error enabling pci device %p\n", dev);
3614 		return -EIO;
3615 	}
3616 	pci_set_master(dev);
3617 	device_init(slgt_device_count, dev);
3618 	return 0;
3619 }
3620 
remove_one(struct pci_dev * dev)3621 static void remove_one(struct pci_dev *dev)
3622 {
3623 }
3624 
3625 static const struct tty_operations ops = {
3626 	.open = open,
3627 	.close = close,
3628 	.write = write,
3629 	.put_char = put_char,
3630 	.flush_chars = flush_chars,
3631 	.write_room = write_room,
3632 	.chars_in_buffer = chars_in_buffer,
3633 	.flush_buffer = flush_buffer,
3634 	.ioctl = ioctl,
3635 	.compat_ioctl = slgt_compat_ioctl,
3636 	.throttle = throttle,
3637 	.unthrottle = unthrottle,
3638 	.send_xchar = send_xchar,
3639 	.break_ctl = set_break,
3640 	.wait_until_sent = wait_until_sent,
3641 	.set_termios = set_termios,
3642 	.stop = tx_hold,
3643 	.start = tx_release,
3644 	.hangup = hangup,
3645 	.tiocmget = tiocmget,
3646 	.tiocmset = tiocmset,
3647 	.get_icount = get_icount,
3648 	.proc_show = synclink_gt_proc_show,
3649 };
3650 
slgt_cleanup(void)3651 static void slgt_cleanup(void)
3652 {
3653 	int rc;
3654 	struct slgt_info *info;
3655 	struct slgt_info *tmp;
3656 
3657 	printk(KERN_INFO "unload %s\n", driver_name);
3658 
3659 	if (serial_driver) {
3660 		for (info=slgt_device_list ; info != NULL ; info=info->next_device)
3661 			tty_unregister_device(serial_driver, info->line);
3662 		rc = tty_unregister_driver(serial_driver);
3663 		if (rc)
3664 			DBGERR(("tty_unregister_driver error=%d\n", rc));
3665 		put_tty_driver(serial_driver);
3666 	}
3667 
3668 	/* reset devices */
3669 	info = slgt_device_list;
3670 	while(info) {
3671 		reset_port(info);
3672 		info = info->next_device;
3673 	}
3674 
3675 	/* release devices */
3676 	info = slgt_device_list;
3677 	while(info) {
3678 #if SYNCLINK_GENERIC_HDLC
3679 		hdlcdev_exit(info);
3680 #endif
3681 		free_dma_bufs(info);
3682 		free_tmp_rbuf(info);
3683 		if (info->port_num == 0)
3684 			release_resources(info);
3685 		tmp = info;
3686 		info = info->next_device;
3687 		tty_port_destroy(&tmp->port);
3688 		kfree(tmp);
3689 	}
3690 
3691 	if (pci_registered)
3692 		pci_unregister_driver(&pci_driver);
3693 }
3694 
3695 /*
3696  *  Driver initialization entry point.
3697  */
slgt_init(void)3698 static int __init slgt_init(void)
3699 {
3700 	int rc;
3701 
3702 	printk(KERN_INFO "%s\n", driver_name);
3703 
3704 	serial_driver = alloc_tty_driver(MAX_DEVICES);
3705 	if (!serial_driver) {
3706 		printk("%s can't allocate tty driver\n", driver_name);
3707 		return -ENOMEM;
3708 	}
3709 
3710 	/* Initialize the tty_driver structure */
3711 
3712 	serial_driver->driver_name = slgt_driver_name;
3713 	serial_driver->name = tty_dev_prefix;
3714 	serial_driver->major = ttymajor;
3715 	serial_driver->minor_start = 64;
3716 	serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
3717 	serial_driver->subtype = SERIAL_TYPE_NORMAL;
3718 	serial_driver->init_termios = tty_std_termios;
3719 	serial_driver->init_termios.c_cflag =
3720 		B9600 | CS8 | CREAD | HUPCL | CLOCAL;
3721 	serial_driver->init_termios.c_ispeed = 9600;
3722 	serial_driver->init_termios.c_ospeed = 9600;
3723 	serial_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
3724 	tty_set_operations(serial_driver, &ops);
3725 	if ((rc = tty_register_driver(serial_driver)) < 0) {
3726 		DBGERR(("%s can't register serial driver\n", driver_name));
3727 		put_tty_driver(serial_driver);
3728 		serial_driver = NULL;
3729 		goto error;
3730 	}
3731 
3732 	printk(KERN_INFO "%s, tty major#%d\n",
3733 	       driver_name, serial_driver->major);
3734 
3735 	slgt_device_count = 0;
3736 	if ((rc = pci_register_driver(&pci_driver)) < 0) {
3737 		printk("%s pci_register_driver error=%d\n", driver_name, rc);
3738 		goto error;
3739 	}
3740 	pci_registered = true;
3741 
3742 	if (!slgt_device_list)
3743 		printk("%s no devices found\n",driver_name);
3744 
3745 	return 0;
3746 
3747 error:
3748 	slgt_cleanup();
3749 	return rc;
3750 }
3751 
slgt_exit(void)3752 static void __exit slgt_exit(void)
3753 {
3754 	slgt_cleanup();
3755 }
3756 
3757 module_init(slgt_init);
3758 module_exit(slgt_exit);
3759 
3760 /*
3761  * register access routines
3762  */
3763 
3764 #define CALC_REGADDR() \
3765 	unsigned long reg_addr = ((unsigned long)info->reg_addr) + addr; \
3766 	if (addr >= 0x80) \
3767 		reg_addr += (info->port_num) * 32; \
3768 	else if (addr >= 0x40)	\
3769 		reg_addr += (info->port_num) * 16;
3770 
rd_reg8(struct slgt_info * info,unsigned int addr)3771 static __u8 rd_reg8(struct slgt_info *info, unsigned int addr)
3772 {
3773 	CALC_REGADDR();
3774 	return readb((void __iomem *)reg_addr);
3775 }
3776 
wr_reg8(struct slgt_info * info,unsigned int addr,__u8 value)3777 static void wr_reg8(struct slgt_info *info, unsigned int addr, __u8 value)
3778 {
3779 	CALC_REGADDR();
3780 	writeb(value, (void __iomem *)reg_addr);
3781 }
3782 
rd_reg16(struct slgt_info * info,unsigned int addr)3783 static __u16 rd_reg16(struct slgt_info *info, unsigned int addr)
3784 {
3785 	CALC_REGADDR();
3786 	return readw((void __iomem *)reg_addr);
3787 }
3788 
wr_reg16(struct slgt_info * info,unsigned int addr,__u16 value)3789 static void wr_reg16(struct slgt_info *info, unsigned int addr, __u16 value)
3790 {
3791 	CALC_REGADDR();
3792 	writew(value, (void __iomem *)reg_addr);
3793 }
3794 
rd_reg32(struct slgt_info * info,unsigned int addr)3795 static __u32 rd_reg32(struct slgt_info *info, unsigned int addr)
3796 {
3797 	CALC_REGADDR();
3798 	return readl((void __iomem *)reg_addr);
3799 }
3800 
wr_reg32(struct slgt_info * info,unsigned int addr,__u32 value)3801 static void wr_reg32(struct slgt_info *info, unsigned int addr, __u32 value)
3802 {
3803 	CALC_REGADDR();
3804 	writel(value, (void __iomem *)reg_addr);
3805 }
3806 
rdma_reset(struct slgt_info * info)3807 static void rdma_reset(struct slgt_info *info)
3808 {
3809 	unsigned int i;
3810 
3811 	/* set reset bit */
3812 	wr_reg32(info, RDCSR, BIT1);
3813 
3814 	/* wait for enable bit cleared */
3815 	for(i=0 ; i < 1000 ; i++)
3816 		if (!(rd_reg32(info, RDCSR) & BIT0))
3817 			break;
3818 }
3819 
tdma_reset(struct slgt_info * info)3820 static void tdma_reset(struct slgt_info *info)
3821 {
3822 	unsigned int i;
3823 
3824 	/* set reset bit */
3825 	wr_reg32(info, TDCSR, BIT1);
3826 
3827 	/* wait for enable bit cleared */
3828 	for(i=0 ; i < 1000 ; i++)
3829 		if (!(rd_reg32(info, TDCSR) & BIT0))
3830 			break;
3831 }
3832 
3833 /*
3834  * enable internal loopback
3835  * TxCLK and RxCLK are generated from BRG
3836  * and TxD is looped back to RxD internally.
3837  */
enable_loopback(struct slgt_info * info)3838 static void enable_loopback(struct slgt_info *info)
3839 {
3840 	/* SCR (serial control) BIT2=loopback enable */
3841 	wr_reg16(info, SCR, (unsigned short)(rd_reg16(info, SCR) | BIT2));
3842 
3843 	if (info->params.mode != MGSL_MODE_ASYNC) {
3844 		/* CCR (clock control)
3845 		 * 07..05  tx clock source (010 = BRG)
3846 		 * 04..02  rx clock source (010 = BRG)
3847 		 * 01      auxclk enable   (0 = disable)
3848 		 * 00      BRG enable      (1 = enable)
3849 		 *
3850 		 * 0100 1001
3851 		 */
3852 		wr_reg8(info, CCR, 0x49);
3853 
3854 		/* set speed if available, otherwise use default */
3855 		if (info->params.clock_speed)
3856 			set_rate(info, info->params.clock_speed);
3857 		else
3858 			set_rate(info, 3686400);
3859 	}
3860 }
3861 
3862 /*
3863  *  set baud rate generator to specified rate
3864  */
set_rate(struct slgt_info * info,u32 rate)3865 static void set_rate(struct slgt_info *info, u32 rate)
3866 {
3867 	unsigned int div;
3868 	unsigned int osc = info->base_clock;
3869 
3870 	/* div = osc/rate - 1
3871 	 *
3872 	 * Round div up if osc/rate is not integer to
3873 	 * force to next slowest rate.
3874 	 */
3875 
3876 	if (rate) {
3877 		div = osc/rate;
3878 		if (!(osc % rate) && div)
3879 			div--;
3880 		wr_reg16(info, BDR, (unsigned short)div);
3881 	}
3882 }
3883 
rx_stop(struct slgt_info * info)3884 static void rx_stop(struct slgt_info *info)
3885 {
3886 	unsigned short val;
3887 
3888 	/* disable and reset receiver */
3889 	val = rd_reg16(info, RCR) & ~BIT1;          /* clear enable bit */
3890 	wr_reg16(info, RCR, (unsigned short)(val | BIT2)); /* set reset bit */
3891 	wr_reg16(info, RCR, val);                  /* clear reset bit */
3892 
3893 	slgt_irq_off(info, IRQ_RXOVER + IRQ_RXDATA + IRQ_RXIDLE);
3894 
3895 	/* clear pending rx interrupts */
3896 	wr_reg16(info, SSR, IRQ_RXIDLE + IRQ_RXOVER);
3897 
3898 	rdma_reset(info);
3899 
3900 	info->rx_enabled = false;
3901 	info->rx_restart = false;
3902 }
3903 
rx_start(struct slgt_info * info)3904 static void rx_start(struct slgt_info *info)
3905 {
3906 	unsigned short val;
3907 
3908 	slgt_irq_off(info, IRQ_RXOVER + IRQ_RXDATA);
3909 
3910 	/* clear pending rx overrun IRQ */
3911 	wr_reg16(info, SSR, IRQ_RXOVER);
3912 
3913 	/* reset and disable receiver */
3914 	val = rd_reg16(info, RCR) & ~BIT1; /* clear enable bit */
3915 	wr_reg16(info, RCR, (unsigned short)(val | BIT2)); /* set reset bit */
3916 	wr_reg16(info, RCR, val);                  /* clear reset bit */
3917 
3918 	rdma_reset(info);
3919 	reset_rbufs(info);
3920 
3921 	if (info->rx_pio) {
3922 		/* rx request when rx FIFO not empty */
3923 		wr_reg16(info, SCR, (unsigned short)(rd_reg16(info, SCR) & ~BIT14));
3924 		slgt_irq_on(info, IRQ_RXDATA);
3925 		if (info->params.mode == MGSL_MODE_ASYNC) {
3926 			/* enable saving of rx status */
3927 			wr_reg32(info, RDCSR, BIT6);
3928 		}
3929 	} else {
3930 		/* rx request when rx FIFO half full */
3931 		wr_reg16(info, SCR, (unsigned short)(rd_reg16(info, SCR) | BIT14));
3932 		/* set 1st descriptor address */
3933 		wr_reg32(info, RDDAR, info->rbufs[0].pdesc);
3934 
3935 		if (info->params.mode != MGSL_MODE_ASYNC) {
3936 			/* enable rx DMA and DMA interrupt */
3937 			wr_reg32(info, RDCSR, (BIT2 + BIT0));
3938 		} else {
3939 			/* enable saving of rx status, rx DMA and DMA interrupt */
3940 			wr_reg32(info, RDCSR, (BIT6 + BIT2 + BIT0));
3941 		}
3942 	}
3943 
3944 	slgt_irq_on(info, IRQ_RXOVER);
3945 
3946 	/* enable receiver */
3947 	wr_reg16(info, RCR, (unsigned short)(rd_reg16(info, RCR) | BIT1));
3948 
3949 	info->rx_restart = false;
3950 	info->rx_enabled = true;
3951 }
3952 
tx_start(struct slgt_info * info)3953 static void tx_start(struct slgt_info *info)
3954 {
3955 	if (!info->tx_enabled) {
3956 		wr_reg16(info, TCR,
3957 			 (unsigned short)((rd_reg16(info, TCR) | BIT1) & ~BIT2));
3958 		info->tx_enabled = true;
3959 	}
3960 
3961 	if (desc_count(info->tbufs[info->tbuf_start])) {
3962 		info->drop_rts_on_tx_done = false;
3963 
3964 		if (info->params.mode != MGSL_MODE_ASYNC) {
3965 			if (info->params.flags & HDLC_FLAG_AUTO_RTS) {
3966 				get_gtsignals(info);
3967 				if (!(info->signals & SerialSignal_RTS)) {
3968 					info->signals |= SerialSignal_RTS;
3969 					set_gtsignals(info);
3970 					info->drop_rts_on_tx_done = true;
3971 				}
3972 			}
3973 
3974 			slgt_irq_off(info, IRQ_TXDATA);
3975 			slgt_irq_on(info, IRQ_TXUNDER + IRQ_TXIDLE);
3976 			/* clear tx idle and underrun status bits */
3977 			wr_reg16(info, SSR, (unsigned short)(IRQ_TXIDLE + IRQ_TXUNDER));
3978 		} else {
3979 			slgt_irq_off(info, IRQ_TXDATA);
3980 			slgt_irq_on(info, IRQ_TXIDLE);
3981 			/* clear tx idle status bit */
3982 			wr_reg16(info, SSR, IRQ_TXIDLE);
3983 		}
3984 		/* set 1st descriptor address and start DMA */
3985 		wr_reg32(info, TDDAR, info->tbufs[info->tbuf_start].pdesc);
3986 		wr_reg32(info, TDCSR, BIT2 + BIT0);
3987 		info->tx_active = true;
3988 	}
3989 }
3990 
tx_stop(struct slgt_info * info)3991 static void tx_stop(struct slgt_info *info)
3992 {
3993 	unsigned short val;
3994 
3995 	del_timer(&info->tx_timer);
3996 
3997 	tdma_reset(info);
3998 
3999 	/* reset and disable transmitter */
4000 	val = rd_reg16(info, TCR) & ~BIT1;          /* clear enable bit */
4001 	wr_reg16(info, TCR, (unsigned short)(val | BIT2)); /* set reset bit */
4002 
4003 	slgt_irq_off(info, IRQ_TXDATA + IRQ_TXIDLE + IRQ_TXUNDER);
4004 
4005 	/* clear tx idle and underrun status bit */
4006 	wr_reg16(info, SSR, (unsigned short)(IRQ_TXIDLE + IRQ_TXUNDER));
4007 
4008 	reset_tbufs(info);
4009 
4010 	info->tx_enabled = false;
4011 	info->tx_active = false;
4012 }
4013 
reset_port(struct slgt_info * info)4014 static void reset_port(struct slgt_info *info)
4015 {
4016 	if (!info->reg_addr)
4017 		return;
4018 
4019 	tx_stop(info);
4020 	rx_stop(info);
4021 
4022 	info->signals &= ~(SerialSignal_RTS | SerialSignal_DTR);
4023 	set_gtsignals(info);
4024 
4025 	slgt_irq_off(info, IRQ_ALL | IRQ_MASTER);
4026 }
4027 
reset_adapter(struct slgt_info * info)4028 static void reset_adapter(struct slgt_info *info)
4029 {
4030 	int i;
4031 	for (i=0; i < info->port_count; ++i) {
4032 		if (info->port_array[i])
4033 			reset_port(info->port_array[i]);
4034 	}
4035 }
4036 
async_mode(struct slgt_info * info)4037 static void async_mode(struct slgt_info *info)
4038 {
4039   	unsigned short val;
4040 
4041 	slgt_irq_off(info, IRQ_ALL | IRQ_MASTER);
4042 	tx_stop(info);
4043 	rx_stop(info);
4044 
4045 	/* TCR (tx control)
4046 	 *
4047 	 * 15..13  mode, 010=async
4048 	 * 12..10  encoding, 000=NRZ
4049 	 * 09      parity enable
4050 	 * 08      1=odd parity, 0=even parity
4051 	 * 07      1=RTS driver control
4052 	 * 06      1=break enable
4053 	 * 05..04  character length
4054 	 *         00=5 bits
4055 	 *         01=6 bits
4056 	 *         10=7 bits
4057 	 *         11=8 bits
4058 	 * 03      0=1 stop bit, 1=2 stop bits
4059 	 * 02      reset
4060 	 * 01      enable
4061 	 * 00      auto-CTS enable
4062 	 */
4063 	val = 0x4000;
4064 
4065 	if (info->if_mode & MGSL_INTERFACE_RTS_EN)
4066 		val |= BIT7;
4067 
4068 	if (info->params.parity != ASYNC_PARITY_NONE) {
4069 		val |= BIT9;
4070 		if (info->params.parity == ASYNC_PARITY_ODD)
4071 			val |= BIT8;
4072 	}
4073 
4074 	switch (info->params.data_bits)
4075 	{
4076 	case 6: val |= BIT4; break;
4077 	case 7: val |= BIT5; break;
4078 	case 8: val |= BIT5 + BIT4; break;
4079 	}
4080 
4081 	if (info->params.stop_bits != 1)
4082 		val |= BIT3;
4083 
4084 	if (info->params.flags & HDLC_FLAG_AUTO_CTS)
4085 		val |= BIT0;
4086 
4087 	wr_reg16(info, TCR, val);
4088 
4089 	/* RCR (rx control)
4090 	 *
4091 	 * 15..13  mode, 010=async
4092 	 * 12..10  encoding, 000=NRZ
4093 	 * 09      parity enable
4094 	 * 08      1=odd parity, 0=even parity
4095 	 * 07..06  reserved, must be 0
4096 	 * 05..04  character length
4097 	 *         00=5 bits
4098 	 *         01=6 bits
4099 	 *         10=7 bits
4100 	 *         11=8 bits
4101 	 * 03      reserved, must be zero
4102 	 * 02      reset
4103 	 * 01      enable
4104 	 * 00      auto-DCD enable
4105 	 */
4106 	val = 0x4000;
4107 
4108 	if (info->params.parity != ASYNC_PARITY_NONE) {
4109 		val |= BIT9;
4110 		if (info->params.parity == ASYNC_PARITY_ODD)
4111 			val |= BIT8;
4112 	}
4113 
4114 	switch (info->params.data_bits)
4115 	{
4116 	case 6: val |= BIT4; break;
4117 	case 7: val |= BIT5; break;
4118 	case 8: val |= BIT5 + BIT4; break;
4119 	}
4120 
4121 	if (info->params.flags & HDLC_FLAG_AUTO_DCD)
4122 		val |= BIT0;
4123 
4124 	wr_reg16(info, RCR, val);
4125 
4126 	/* CCR (clock control)
4127 	 *
4128 	 * 07..05  011 = tx clock source is BRG/16
4129 	 * 04..02  010 = rx clock source is BRG
4130 	 * 01      0 = auxclk disabled
4131 	 * 00      1 = BRG enabled
4132 	 *
4133 	 * 0110 1001
4134 	 */
4135 	wr_reg8(info, CCR, 0x69);
4136 
4137 	msc_set_vcr(info);
4138 
4139 	/* SCR (serial control)
4140 	 *
4141 	 * 15  1=tx req on FIFO half empty
4142 	 * 14  1=rx req on FIFO half full
4143 	 * 13  tx data  IRQ enable
4144 	 * 12  tx idle  IRQ enable
4145 	 * 11  rx break on IRQ enable
4146 	 * 10  rx data  IRQ enable
4147 	 * 09  rx break off IRQ enable
4148 	 * 08  overrun  IRQ enable
4149 	 * 07  DSR      IRQ enable
4150 	 * 06  CTS      IRQ enable
4151 	 * 05  DCD      IRQ enable
4152 	 * 04  RI       IRQ enable
4153 	 * 03  0=16x sampling, 1=8x sampling
4154 	 * 02  1=txd->rxd internal loopback enable
4155 	 * 01  reserved, must be zero
4156 	 * 00  1=master IRQ enable
4157 	 */
4158 	val = BIT15 + BIT14 + BIT0;
4159 	/* JCR[8] : 1 = x8 async mode feature available */
4160 	if ((rd_reg32(info, JCR) & BIT8) && info->params.data_rate &&
4161 	    ((info->base_clock < (info->params.data_rate * 16)) ||
4162 	     (info->base_clock % (info->params.data_rate * 16)))) {
4163 		/* use 8x sampling */
4164 		val |= BIT3;
4165 		set_rate(info, info->params.data_rate * 8);
4166 	} else {
4167 		/* use 16x sampling */
4168 		set_rate(info, info->params.data_rate * 16);
4169 	}
4170 	wr_reg16(info, SCR, val);
4171 
4172 	slgt_irq_on(info, IRQ_RXBREAK | IRQ_RXOVER);
4173 
4174 	if (info->params.loopback)
4175 		enable_loopback(info);
4176 }
4177 
sync_mode(struct slgt_info * info)4178 static void sync_mode(struct slgt_info *info)
4179 {
4180 	unsigned short val;
4181 
4182 	slgt_irq_off(info, IRQ_ALL | IRQ_MASTER);
4183 	tx_stop(info);
4184 	rx_stop(info);
4185 
4186 	/* TCR (tx control)
4187 	 *
4188 	 * 15..13  mode
4189 	 *         000=HDLC/SDLC
4190 	 *         001=raw bit synchronous
4191 	 *         010=asynchronous/isochronous
4192 	 *         011=monosync byte synchronous
4193 	 *         100=bisync byte synchronous
4194 	 *         101=xsync byte synchronous
4195 	 * 12..10  encoding
4196 	 * 09      CRC enable
4197 	 * 08      CRC32
4198 	 * 07      1=RTS driver control
4199 	 * 06      preamble enable
4200 	 * 05..04  preamble length
4201 	 * 03      share open/close flag
4202 	 * 02      reset
4203 	 * 01      enable
4204 	 * 00      auto-CTS enable
4205 	 */
4206 	val = BIT2;
4207 
4208 	switch(info->params.mode) {
4209 	case MGSL_MODE_XSYNC:
4210 		val |= BIT15 + BIT13;
4211 		break;
4212 	case MGSL_MODE_MONOSYNC: val |= BIT14 + BIT13; break;
4213 	case MGSL_MODE_BISYNC:   val |= BIT15; break;
4214 	case MGSL_MODE_RAW:      val |= BIT13; break;
4215 	}
4216 	if (info->if_mode & MGSL_INTERFACE_RTS_EN)
4217 		val |= BIT7;
4218 
4219 	switch(info->params.encoding)
4220 	{
4221 	case HDLC_ENCODING_NRZB:          val |= BIT10; break;
4222 	case HDLC_ENCODING_NRZI_MARK:     val |= BIT11; break;
4223 	case HDLC_ENCODING_NRZI:          val |= BIT11 + BIT10; break;
4224 	case HDLC_ENCODING_BIPHASE_MARK:  val |= BIT12; break;
4225 	case HDLC_ENCODING_BIPHASE_SPACE: val |= BIT12 + BIT10; break;
4226 	case HDLC_ENCODING_BIPHASE_LEVEL: val |= BIT12 + BIT11; break;
4227 	case HDLC_ENCODING_DIFF_BIPHASE_LEVEL: val |= BIT12 + BIT11 + BIT10; break;
4228 	}
4229 
4230 	switch (info->params.crc_type & HDLC_CRC_MASK)
4231 	{
4232 	case HDLC_CRC_16_CCITT: val |= BIT9; break;
4233 	case HDLC_CRC_32_CCITT: val |= BIT9 + BIT8; break;
4234 	}
4235 
4236 	if (info->params.preamble != HDLC_PREAMBLE_PATTERN_NONE)
4237 		val |= BIT6;
4238 
4239 	switch (info->params.preamble_length)
4240 	{
4241 	case HDLC_PREAMBLE_LENGTH_16BITS: val |= BIT5; break;
4242 	case HDLC_PREAMBLE_LENGTH_32BITS: val |= BIT4; break;
4243 	case HDLC_PREAMBLE_LENGTH_64BITS: val |= BIT5 + BIT4; break;
4244 	}
4245 
4246 	if (info->params.flags & HDLC_FLAG_AUTO_CTS)
4247 		val |= BIT0;
4248 
4249 	wr_reg16(info, TCR, val);
4250 
4251 	/* TPR (transmit preamble) */
4252 
4253 	switch (info->params.preamble)
4254 	{
4255 	case HDLC_PREAMBLE_PATTERN_FLAGS: val = 0x7e; break;
4256 	case HDLC_PREAMBLE_PATTERN_ONES:  val = 0xff; break;
4257 	case HDLC_PREAMBLE_PATTERN_ZEROS: val = 0x00; break;
4258 	case HDLC_PREAMBLE_PATTERN_10:    val = 0x55; break;
4259 	case HDLC_PREAMBLE_PATTERN_01:    val = 0xaa; break;
4260 	default:                          val = 0x7e; break;
4261 	}
4262 	wr_reg8(info, TPR, (unsigned char)val);
4263 
4264 	/* RCR (rx control)
4265 	 *
4266 	 * 15..13  mode
4267 	 *         000=HDLC/SDLC
4268 	 *         001=raw bit synchronous
4269 	 *         010=asynchronous/isochronous
4270 	 *         011=monosync byte synchronous
4271 	 *         100=bisync byte synchronous
4272 	 *         101=xsync byte synchronous
4273 	 * 12..10  encoding
4274 	 * 09      CRC enable
4275 	 * 08      CRC32
4276 	 * 07..03  reserved, must be 0
4277 	 * 02      reset
4278 	 * 01      enable
4279 	 * 00      auto-DCD enable
4280 	 */
4281 	val = 0;
4282 
4283 	switch(info->params.mode) {
4284 	case MGSL_MODE_XSYNC:
4285 		val |= BIT15 + BIT13;
4286 		break;
4287 	case MGSL_MODE_MONOSYNC: val |= BIT14 + BIT13; break;
4288 	case MGSL_MODE_BISYNC:   val |= BIT15; break;
4289 	case MGSL_MODE_RAW:      val |= BIT13; break;
4290 	}
4291 
4292 	switch(info->params.encoding)
4293 	{
4294 	case HDLC_ENCODING_NRZB:          val |= BIT10; break;
4295 	case HDLC_ENCODING_NRZI_MARK:     val |= BIT11; break;
4296 	case HDLC_ENCODING_NRZI:          val |= BIT11 + BIT10; break;
4297 	case HDLC_ENCODING_BIPHASE_MARK:  val |= BIT12; break;
4298 	case HDLC_ENCODING_BIPHASE_SPACE: val |= BIT12 + BIT10; break;
4299 	case HDLC_ENCODING_BIPHASE_LEVEL: val |= BIT12 + BIT11; break;
4300 	case HDLC_ENCODING_DIFF_BIPHASE_LEVEL: val |= BIT12 + BIT11 + BIT10; break;
4301 	}
4302 
4303 	switch (info->params.crc_type & HDLC_CRC_MASK)
4304 	{
4305 	case HDLC_CRC_16_CCITT: val |= BIT9; break;
4306 	case HDLC_CRC_32_CCITT: val |= BIT9 + BIT8; break;
4307 	}
4308 
4309 	if (info->params.flags & HDLC_FLAG_AUTO_DCD)
4310 		val |= BIT0;
4311 
4312 	wr_reg16(info, RCR, val);
4313 
4314 	/* CCR (clock control)
4315 	 *
4316 	 * 07..05  tx clock source
4317 	 * 04..02  rx clock source
4318 	 * 01      auxclk enable
4319 	 * 00      BRG enable
4320 	 */
4321 	val = 0;
4322 
4323 	if (info->params.flags & HDLC_FLAG_TXC_BRG)
4324 	{
4325 		// when RxC source is DPLL, BRG generates 16X DPLL
4326 		// reference clock, so take TxC from BRG/16 to get
4327 		// transmit clock at actual data rate
4328 		if (info->params.flags & HDLC_FLAG_RXC_DPLL)
4329 			val |= BIT6 + BIT5;	/* 011, txclk = BRG/16 */
4330 		else
4331 			val |= BIT6;	/* 010, txclk = BRG */
4332 	}
4333 	else if (info->params.flags & HDLC_FLAG_TXC_DPLL)
4334 		val |= BIT7;	/* 100, txclk = DPLL Input */
4335 	else if (info->params.flags & HDLC_FLAG_TXC_RXCPIN)
4336 		val |= BIT5;	/* 001, txclk = RXC Input */
4337 
4338 	if (info->params.flags & HDLC_FLAG_RXC_BRG)
4339 		val |= BIT3;	/* 010, rxclk = BRG */
4340 	else if (info->params.flags & HDLC_FLAG_RXC_DPLL)
4341 		val |= BIT4;	/* 100, rxclk = DPLL */
4342 	else if (info->params.flags & HDLC_FLAG_RXC_TXCPIN)
4343 		val |= BIT2;	/* 001, rxclk = TXC Input */
4344 
4345 	if (info->params.clock_speed)
4346 		val |= BIT1 + BIT0;
4347 
4348 	wr_reg8(info, CCR, (unsigned char)val);
4349 
4350 	if (info->params.flags & (HDLC_FLAG_TXC_DPLL + HDLC_FLAG_RXC_DPLL))
4351 	{
4352 		// program DPLL mode
4353 		switch(info->params.encoding)
4354 		{
4355 		case HDLC_ENCODING_BIPHASE_MARK:
4356 		case HDLC_ENCODING_BIPHASE_SPACE:
4357 			val = BIT7; break;
4358 		case HDLC_ENCODING_BIPHASE_LEVEL:
4359 		case HDLC_ENCODING_DIFF_BIPHASE_LEVEL:
4360 			val = BIT7 + BIT6; break;
4361 		default: val = BIT6;	// NRZ encodings
4362 		}
4363 		wr_reg16(info, RCR, (unsigned short)(rd_reg16(info, RCR) | val));
4364 
4365 		// DPLL requires a 16X reference clock from BRG
4366 		set_rate(info, info->params.clock_speed * 16);
4367 	}
4368 	else
4369 		set_rate(info, info->params.clock_speed);
4370 
4371 	tx_set_idle(info);
4372 
4373 	msc_set_vcr(info);
4374 
4375 	/* SCR (serial control)
4376 	 *
4377 	 * 15  1=tx req on FIFO half empty
4378 	 * 14  1=rx req on FIFO half full
4379 	 * 13  tx data  IRQ enable
4380 	 * 12  tx idle  IRQ enable
4381 	 * 11  underrun IRQ enable
4382 	 * 10  rx data  IRQ enable
4383 	 * 09  rx idle  IRQ enable
4384 	 * 08  overrun  IRQ enable
4385 	 * 07  DSR      IRQ enable
4386 	 * 06  CTS      IRQ enable
4387 	 * 05  DCD      IRQ enable
4388 	 * 04  RI       IRQ enable
4389 	 * 03  reserved, must be zero
4390 	 * 02  1=txd->rxd internal loopback enable
4391 	 * 01  reserved, must be zero
4392 	 * 00  1=master IRQ enable
4393 	 */
4394 	wr_reg16(info, SCR, BIT15 + BIT14 + BIT0);
4395 
4396 	if (info->params.loopback)
4397 		enable_loopback(info);
4398 }
4399 
4400 /*
4401  *  set transmit idle mode
4402  */
tx_set_idle(struct slgt_info * info)4403 static void tx_set_idle(struct slgt_info *info)
4404 {
4405 	unsigned char val;
4406 	unsigned short tcr;
4407 
4408 	/* if preamble enabled (tcr[6] == 1) then tx idle size = 8 bits
4409 	 * else tcr[5:4] = tx idle size: 00 = 8 bits, 01 = 16 bits
4410 	 */
4411 	tcr = rd_reg16(info, TCR);
4412 	if (info->idle_mode & HDLC_TXIDLE_CUSTOM_16) {
4413 		/* disable preamble, set idle size to 16 bits */
4414 		tcr = (tcr & ~(BIT6 + BIT5)) | BIT4;
4415 		/* MSB of 16 bit idle specified in tx preamble register (TPR) */
4416 		wr_reg8(info, TPR, (unsigned char)((info->idle_mode >> 8) & 0xff));
4417 	} else if (!(tcr & BIT6)) {
4418 		/* preamble is disabled, set idle size to 8 bits */
4419 		tcr &= ~(BIT5 + BIT4);
4420 	}
4421 	wr_reg16(info, TCR, tcr);
4422 
4423 	if (info->idle_mode & (HDLC_TXIDLE_CUSTOM_8 | HDLC_TXIDLE_CUSTOM_16)) {
4424 		/* LSB of custom tx idle specified in tx idle register */
4425 		val = (unsigned char)(info->idle_mode & 0xff);
4426 	} else {
4427 		/* standard 8 bit idle patterns */
4428 		switch(info->idle_mode)
4429 		{
4430 		case HDLC_TXIDLE_FLAGS:          val = 0x7e; break;
4431 		case HDLC_TXIDLE_ALT_ZEROS_ONES:
4432 		case HDLC_TXIDLE_ALT_MARK_SPACE: val = 0xaa; break;
4433 		case HDLC_TXIDLE_ZEROS:
4434 		case HDLC_TXIDLE_SPACE:          val = 0x00; break;
4435 		default:                         val = 0xff;
4436 		}
4437 	}
4438 
4439 	wr_reg8(info, TIR, val);
4440 }
4441 
4442 /*
4443  * get state of V24 status (input) signals
4444  */
get_gtsignals(struct slgt_info * info)4445 static void get_gtsignals(struct slgt_info *info)
4446 {
4447 	unsigned short status = rd_reg16(info, SSR);
4448 
4449 	/* clear all serial signals except RTS and DTR */
4450 	info->signals &= SerialSignal_RTS | SerialSignal_DTR;
4451 
4452 	if (status & BIT3)
4453 		info->signals |= SerialSignal_DSR;
4454 	if (status & BIT2)
4455 		info->signals |= SerialSignal_CTS;
4456 	if (status & BIT1)
4457 		info->signals |= SerialSignal_DCD;
4458 	if (status & BIT0)
4459 		info->signals |= SerialSignal_RI;
4460 }
4461 
4462 /*
4463  * set V.24 Control Register based on current configuration
4464  */
msc_set_vcr(struct slgt_info * info)4465 static void msc_set_vcr(struct slgt_info *info)
4466 {
4467 	unsigned char val = 0;
4468 
4469 	/* VCR (V.24 control)
4470 	 *
4471 	 * 07..04  serial IF select
4472 	 * 03      DTR
4473 	 * 02      RTS
4474 	 * 01      LL
4475 	 * 00      RL
4476 	 */
4477 
4478 	switch(info->if_mode & MGSL_INTERFACE_MASK)
4479 	{
4480 	case MGSL_INTERFACE_RS232:
4481 		val |= BIT5; /* 0010 */
4482 		break;
4483 	case MGSL_INTERFACE_V35:
4484 		val |= BIT7 + BIT6 + BIT5; /* 1110 */
4485 		break;
4486 	case MGSL_INTERFACE_RS422:
4487 		val |= BIT6; /* 0100 */
4488 		break;
4489 	}
4490 
4491 	if (info->if_mode & MGSL_INTERFACE_MSB_FIRST)
4492 		val |= BIT4;
4493 	if (info->signals & SerialSignal_DTR)
4494 		val |= BIT3;
4495 	if (info->signals & SerialSignal_RTS)
4496 		val |= BIT2;
4497 	if (info->if_mode & MGSL_INTERFACE_LL)
4498 		val |= BIT1;
4499 	if (info->if_mode & MGSL_INTERFACE_RL)
4500 		val |= BIT0;
4501 	wr_reg8(info, VCR, val);
4502 }
4503 
4504 /*
4505  * set state of V24 control (output) signals
4506  */
set_gtsignals(struct slgt_info * info)4507 static void set_gtsignals(struct slgt_info *info)
4508 {
4509 	unsigned char val = rd_reg8(info, VCR);
4510 	if (info->signals & SerialSignal_DTR)
4511 		val |= BIT3;
4512 	else
4513 		val &= ~BIT3;
4514 	if (info->signals & SerialSignal_RTS)
4515 		val |= BIT2;
4516 	else
4517 		val &= ~BIT2;
4518 	wr_reg8(info, VCR, val);
4519 }
4520 
4521 /*
4522  * free range of receive DMA buffers (i to last)
4523  */
free_rbufs(struct slgt_info * info,unsigned int i,unsigned int last)4524 static void free_rbufs(struct slgt_info *info, unsigned int i, unsigned int last)
4525 {
4526 	int done = 0;
4527 
4528 	while(!done) {
4529 		/* reset current buffer for reuse */
4530 		info->rbufs[i].status = 0;
4531 		set_desc_count(info->rbufs[i], info->rbuf_fill_level);
4532 		if (i == last)
4533 			done = 1;
4534 		if (++i == info->rbuf_count)
4535 			i = 0;
4536 	}
4537 	info->rbuf_current = i;
4538 }
4539 
4540 /*
4541  * mark all receive DMA buffers as free
4542  */
reset_rbufs(struct slgt_info * info)4543 static void reset_rbufs(struct slgt_info *info)
4544 {
4545 	free_rbufs(info, 0, info->rbuf_count - 1);
4546 	info->rbuf_fill_index = 0;
4547 	info->rbuf_fill_count = 0;
4548 }
4549 
4550 /*
4551  * pass receive HDLC frame to upper layer
4552  *
4553  * return true if frame available, otherwise false
4554  */
rx_get_frame(struct slgt_info * info)4555 static bool rx_get_frame(struct slgt_info *info)
4556 {
4557 	unsigned int start, end;
4558 	unsigned short status;
4559 	unsigned int framesize = 0;
4560 	unsigned long flags;
4561 	struct tty_struct *tty = info->port.tty;
4562 	unsigned char addr_field = 0xff;
4563 	unsigned int crc_size = 0;
4564 
4565 	switch (info->params.crc_type & HDLC_CRC_MASK) {
4566 	case HDLC_CRC_16_CCITT: crc_size = 2; break;
4567 	case HDLC_CRC_32_CCITT: crc_size = 4; break;
4568 	}
4569 
4570 check_again:
4571 
4572 	framesize = 0;
4573 	addr_field = 0xff;
4574 	start = end = info->rbuf_current;
4575 
4576 	for (;;) {
4577 		if (!desc_complete(info->rbufs[end]))
4578 			goto cleanup;
4579 
4580 		if (framesize == 0 && info->params.addr_filter != 0xff)
4581 			addr_field = info->rbufs[end].buf[0];
4582 
4583 		framesize += desc_count(info->rbufs[end]);
4584 
4585 		if (desc_eof(info->rbufs[end]))
4586 			break;
4587 
4588 		if (++end == info->rbuf_count)
4589 			end = 0;
4590 
4591 		if (end == info->rbuf_current) {
4592 			if (info->rx_enabled){
4593 				spin_lock_irqsave(&info->lock,flags);
4594 				rx_start(info);
4595 				spin_unlock_irqrestore(&info->lock,flags);
4596 			}
4597 			goto cleanup;
4598 		}
4599 	}
4600 
4601 	/* status
4602 	 *
4603 	 * 15      buffer complete
4604 	 * 14..06  reserved
4605 	 * 05..04  residue
4606 	 * 02      eof (end of frame)
4607 	 * 01      CRC error
4608 	 * 00      abort
4609 	 */
4610 	status = desc_status(info->rbufs[end]);
4611 
4612 	/* ignore CRC bit if not using CRC (bit is undefined) */
4613 	if ((info->params.crc_type & HDLC_CRC_MASK) == HDLC_CRC_NONE)
4614 		status &= ~BIT1;
4615 
4616 	if (framesize == 0 ||
4617 		 (addr_field != 0xff && addr_field != info->params.addr_filter)) {
4618 		free_rbufs(info, start, end);
4619 		goto check_again;
4620 	}
4621 
4622 	if (framesize < (2 + crc_size) || status & BIT0) {
4623 		info->icount.rxshort++;
4624 		framesize = 0;
4625 	} else if (status & BIT1) {
4626 		info->icount.rxcrc++;
4627 		if (!(info->params.crc_type & HDLC_CRC_RETURN_EX))
4628 			framesize = 0;
4629 	}
4630 
4631 #if SYNCLINK_GENERIC_HDLC
4632 	if (framesize == 0) {
4633 		info->netdev->stats.rx_errors++;
4634 		info->netdev->stats.rx_frame_errors++;
4635 	}
4636 #endif
4637 
4638 	DBGBH(("%s rx frame status=%04X size=%d\n",
4639 		info->device_name, status, framesize));
4640 	DBGDATA(info, info->rbufs[start].buf, min_t(int, framesize, info->rbuf_fill_level), "rx");
4641 
4642 	if (framesize) {
4643 		if (!(info->params.crc_type & HDLC_CRC_RETURN_EX)) {
4644 			framesize -= crc_size;
4645 			crc_size = 0;
4646 		}
4647 
4648 		if (framesize > info->max_frame_size + crc_size)
4649 			info->icount.rxlong++;
4650 		else {
4651 			/* copy dma buffer(s) to contiguous temp buffer */
4652 			int copy_count = framesize;
4653 			int i = start;
4654 			unsigned char *p = info->tmp_rbuf;
4655 			info->tmp_rbuf_count = framesize;
4656 
4657 			info->icount.rxok++;
4658 
4659 			while(copy_count) {
4660 				int partial_count = min_t(int, copy_count, info->rbuf_fill_level);
4661 				memcpy(p, info->rbufs[i].buf, partial_count);
4662 				p += partial_count;
4663 				copy_count -= partial_count;
4664 				if (++i == info->rbuf_count)
4665 					i = 0;
4666 			}
4667 
4668 			if (info->params.crc_type & HDLC_CRC_RETURN_EX) {
4669 				*p = (status & BIT1) ? RX_CRC_ERROR : RX_OK;
4670 				framesize++;
4671 			}
4672 
4673 #if SYNCLINK_GENERIC_HDLC
4674 			if (info->netcount)
4675 				hdlcdev_rx(info,info->tmp_rbuf, framesize);
4676 			else
4677 #endif
4678 				ldisc_receive_buf(tty, info->tmp_rbuf, info->flag_buf, framesize);
4679 		}
4680 	}
4681 	free_rbufs(info, start, end);
4682 	return true;
4683 
4684 cleanup:
4685 	return false;
4686 }
4687 
4688 /*
4689  * pass receive buffer (RAW synchronous mode) to tty layer
4690  * return true if buffer available, otherwise false
4691  */
rx_get_buf(struct slgt_info * info)4692 static bool rx_get_buf(struct slgt_info *info)
4693 {
4694 	unsigned int i = info->rbuf_current;
4695 	unsigned int count;
4696 
4697 	if (!desc_complete(info->rbufs[i]))
4698 		return false;
4699 	count = desc_count(info->rbufs[i]);
4700 	switch(info->params.mode) {
4701 	case MGSL_MODE_MONOSYNC:
4702 	case MGSL_MODE_BISYNC:
4703 	case MGSL_MODE_XSYNC:
4704 		/* ignore residue in byte synchronous modes */
4705 		if (desc_residue(info->rbufs[i]))
4706 			count--;
4707 		break;
4708 	}
4709 	DBGDATA(info, info->rbufs[i].buf, count, "rx");
4710 	DBGINFO(("rx_get_buf size=%d\n", count));
4711 	if (count)
4712 		ldisc_receive_buf(info->port.tty, info->rbufs[i].buf,
4713 				  info->flag_buf, count);
4714 	free_rbufs(info, i, i);
4715 	return true;
4716 }
4717 
reset_tbufs(struct slgt_info * info)4718 static void reset_tbufs(struct slgt_info *info)
4719 {
4720 	unsigned int i;
4721 	info->tbuf_current = 0;
4722 	for (i=0 ; i < info->tbuf_count ; i++) {
4723 		info->tbufs[i].status = 0;
4724 		info->tbufs[i].count  = 0;
4725 	}
4726 }
4727 
4728 /*
4729  * return number of free transmit DMA buffers
4730  */
free_tbuf_count(struct slgt_info * info)4731 static unsigned int free_tbuf_count(struct slgt_info *info)
4732 {
4733 	unsigned int count = 0;
4734 	unsigned int i = info->tbuf_current;
4735 
4736 	do
4737 	{
4738 		if (desc_count(info->tbufs[i]))
4739 			break; /* buffer in use */
4740 		++count;
4741 		if (++i == info->tbuf_count)
4742 			i=0;
4743 	} while (i != info->tbuf_current);
4744 
4745 	/* if tx DMA active, last zero count buffer is in use */
4746 	if (count && (rd_reg32(info, TDCSR) & BIT0))
4747 		--count;
4748 
4749 	return count;
4750 }
4751 
4752 /*
4753  * return number of bytes in unsent transmit DMA buffers
4754  * and the serial controller tx FIFO
4755  */
tbuf_bytes(struct slgt_info * info)4756 static unsigned int tbuf_bytes(struct slgt_info *info)
4757 {
4758 	unsigned int total_count = 0;
4759 	unsigned int i = info->tbuf_current;
4760 	unsigned int reg_value;
4761 	unsigned int count;
4762 	unsigned int active_buf_count = 0;
4763 
4764 	/*
4765 	 * Add descriptor counts for all tx DMA buffers.
4766 	 * If count is zero (cleared by DMA controller after read),
4767 	 * the buffer is complete or is actively being read from.
4768 	 *
4769 	 * Record buf_count of last buffer with zero count starting
4770 	 * from current ring position. buf_count is mirror
4771 	 * copy of count and is not cleared by serial controller.
4772 	 * If DMA controller is active, that buffer is actively
4773 	 * being read so add to total.
4774 	 */
4775 	do {
4776 		count = desc_count(info->tbufs[i]);
4777 		if (count)
4778 			total_count += count;
4779 		else if (!total_count)
4780 			active_buf_count = info->tbufs[i].buf_count;
4781 		if (++i == info->tbuf_count)
4782 			i = 0;
4783 	} while (i != info->tbuf_current);
4784 
4785 	/* read tx DMA status register */
4786 	reg_value = rd_reg32(info, TDCSR);
4787 
4788 	/* if tx DMA active, last zero count buffer is in use */
4789 	if (reg_value & BIT0)
4790 		total_count += active_buf_count;
4791 
4792 	/* add tx FIFO count = reg_value[15..8] */
4793 	total_count += (reg_value >> 8) & 0xff;
4794 
4795 	/* if transmitter active add one byte for shift register */
4796 	if (info->tx_active)
4797 		total_count++;
4798 
4799 	return total_count;
4800 }
4801 
4802 /*
4803  * load data into transmit DMA buffer ring and start transmitter if needed
4804  * return true if data accepted, otherwise false (buffers full)
4805  */
tx_load(struct slgt_info * info,const char * buf,unsigned int size)4806 static bool tx_load(struct slgt_info *info, const char *buf, unsigned int size)
4807 {
4808 	unsigned short count;
4809 	unsigned int i;
4810 	struct slgt_desc *d;
4811 
4812 	/* check required buffer space */
4813 	if (DIV_ROUND_UP(size, DMABUFSIZE) > free_tbuf_count(info))
4814 		return false;
4815 
4816 	DBGDATA(info, buf, size, "tx");
4817 
4818 	/*
4819 	 * copy data to one or more DMA buffers in circular ring
4820 	 * tbuf_start   = first buffer for this data
4821 	 * tbuf_current = next free buffer
4822 	 *
4823 	 * Copy all data before making data visible to DMA controller by
4824 	 * setting descriptor count of the first buffer.
4825 	 * This prevents an active DMA controller from reading the first DMA
4826 	 * buffers of a frame and stopping before the final buffers are filled.
4827 	 */
4828 
4829 	info->tbuf_start = i = info->tbuf_current;
4830 
4831 	while (size) {
4832 		d = &info->tbufs[i];
4833 
4834 		count = (unsigned short)((size > DMABUFSIZE) ? DMABUFSIZE : size);
4835 		memcpy(d->buf, buf, count);
4836 
4837 		size -= count;
4838 		buf  += count;
4839 
4840 		/*
4841 		 * set EOF bit for last buffer of HDLC frame or
4842 		 * for every buffer in raw mode
4843 		 */
4844 		if ((!size && info->params.mode == MGSL_MODE_HDLC) ||
4845 		    info->params.mode == MGSL_MODE_RAW)
4846 			set_desc_eof(*d, 1);
4847 		else
4848 			set_desc_eof(*d, 0);
4849 
4850 		/* set descriptor count for all but first buffer */
4851 		if (i != info->tbuf_start)
4852 			set_desc_count(*d, count);
4853 		d->buf_count = count;
4854 
4855 		if (++i == info->tbuf_count)
4856 			i = 0;
4857 	}
4858 
4859 	info->tbuf_current = i;
4860 
4861 	/* set first buffer count to make new data visible to DMA controller */
4862 	d = &info->tbufs[info->tbuf_start];
4863 	set_desc_count(*d, d->buf_count);
4864 
4865 	/* start transmitter if needed and update transmit timeout */
4866 	if (!info->tx_active)
4867 		tx_start(info);
4868 	update_tx_timer(info);
4869 
4870 	return true;
4871 }
4872 
register_test(struct slgt_info * info)4873 static int register_test(struct slgt_info *info)
4874 {
4875 	static unsigned short patterns[] =
4876 		{0x0000, 0xffff, 0xaaaa, 0x5555, 0x6969, 0x9696};
4877 	static unsigned int count = ARRAY_SIZE(patterns);
4878 	unsigned int i;
4879 	int rc = 0;
4880 
4881 	for (i=0 ; i < count ; i++) {
4882 		wr_reg16(info, TIR, patterns[i]);
4883 		wr_reg16(info, BDR, patterns[(i+1)%count]);
4884 		if ((rd_reg16(info, TIR) != patterns[i]) ||
4885 		    (rd_reg16(info, BDR) != patterns[(i+1)%count])) {
4886 			rc = -ENODEV;
4887 			break;
4888 		}
4889 	}
4890 	info->gpio_present = (rd_reg32(info, JCR) & BIT5) ? 1 : 0;
4891 	info->init_error = rc ? 0 : DiagStatus_AddressFailure;
4892 	return rc;
4893 }
4894 
irq_test(struct slgt_info * info)4895 static int irq_test(struct slgt_info *info)
4896 {
4897 	unsigned long timeout;
4898 	unsigned long flags;
4899 	struct tty_struct *oldtty = info->port.tty;
4900 	u32 speed = info->params.data_rate;
4901 
4902 	info->params.data_rate = 921600;
4903 	info->port.tty = NULL;
4904 
4905 	spin_lock_irqsave(&info->lock, flags);
4906 	async_mode(info);
4907 	slgt_irq_on(info, IRQ_TXIDLE);
4908 
4909 	/* enable transmitter */
4910 	wr_reg16(info, TCR,
4911 		(unsigned short)(rd_reg16(info, TCR) | BIT1));
4912 
4913 	/* write one byte and wait for tx idle */
4914 	wr_reg16(info, TDR, 0);
4915 
4916 	/* assume failure */
4917 	info->init_error = DiagStatus_IrqFailure;
4918 	info->irq_occurred = false;
4919 
4920 	spin_unlock_irqrestore(&info->lock, flags);
4921 
4922 	timeout=100;
4923 	while(timeout-- && !info->irq_occurred)
4924 		msleep_interruptible(10);
4925 
4926 	spin_lock_irqsave(&info->lock,flags);
4927 	reset_port(info);
4928 	spin_unlock_irqrestore(&info->lock,flags);
4929 
4930 	info->params.data_rate = speed;
4931 	info->port.tty = oldtty;
4932 
4933 	info->init_error = info->irq_occurred ? 0 : DiagStatus_IrqFailure;
4934 	return info->irq_occurred ? 0 : -ENODEV;
4935 }
4936 
loopback_test_rx(struct slgt_info * info)4937 static int loopback_test_rx(struct slgt_info *info)
4938 {
4939 	unsigned char *src, *dest;
4940 	int count;
4941 
4942 	if (desc_complete(info->rbufs[0])) {
4943 		count = desc_count(info->rbufs[0]);
4944 		src   = info->rbufs[0].buf;
4945 		dest  = info->tmp_rbuf;
4946 
4947 		for( ; count ; count-=2, src+=2) {
4948 			/* src=data byte (src+1)=status byte */
4949 			if (!(*(src+1) & (BIT9 + BIT8))) {
4950 				*dest = *src;
4951 				dest++;
4952 				info->tmp_rbuf_count++;
4953 			}
4954 		}
4955 		DBGDATA(info, info->tmp_rbuf, info->tmp_rbuf_count, "rx");
4956 		return 1;
4957 	}
4958 	return 0;
4959 }
4960 
loopback_test(struct slgt_info * info)4961 static int loopback_test(struct slgt_info *info)
4962 {
4963 #define TESTFRAMESIZE 20
4964 
4965 	unsigned long timeout;
4966 	u16 count = TESTFRAMESIZE;
4967 	unsigned char buf[TESTFRAMESIZE];
4968 	int rc = -ENODEV;
4969 	unsigned long flags;
4970 
4971 	struct tty_struct *oldtty = info->port.tty;
4972 	MGSL_PARAMS params;
4973 
4974 	memcpy(&params, &info->params, sizeof(params));
4975 
4976 	info->params.mode = MGSL_MODE_ASYNC;
4977 	info->params.data_rate = 921600;
4978 	info->params.loopback = 1;
4979 	info->port.tty = NULL;
4980 
4981 	/* build and send transmit frame */
4982 	for (count = 0; count < TESTFRAMESIZE; ++count)
4983 		buf[count] = (unsigned char)count;
4984 
4985 	info->tmp_rbuf_count = 0;
4986 	memset(info->tmp_rbuf, 0, TESTFRAMESIZE);
4987 
4988 	/* program hardware for HDLC and enabled receiver */
4989 	spin_lock_irqsave(&info->lock,flags);
4990 	async_mode(info);
4991 	rx_start(info);
4992 	tx_load(info, buf, count);
4993 	spin_unlock_irqrestore(&info->lock, flags);
4994 
4995 	/* wait for receive complete */
4996 	for (timeout = 100; timeout; --timeout) {
4997 		msleep_interruptible(10);
4998 		if (loopback_test_rx(info)) {
4999 			rc = 0;
5000 			break;
5001 		}
5002 	}
5003 
5004 	/* verify received frame length and contents */
5005 	if (!rc && (info->tmp_rbuf_count != count ||
5006 		  memcmp(buf, info->tmp_rbuf, count))) {
5007 		rc = -ENODEV;
5008 	}
5009 
5010 	spin_lock_irqsave(&info->lock,flags);
5011 	reset_adapter(info);
5012 	spin_unlock_irqrestore(&info->lock,flags);
5013 
5014 	memcpy(&info->params, &params, sizeof(info->params));
5015 	info->port.tty = oldtty;
5016 
5017 	info->init_error = rc ? DiagStatus_DmaFailure : 0;
5018 	return rc;
5019 }
5020 
adapter_test(struct slgt_info * info)5021 static int adapter_test(struct slgt_info *info)
5022 {
5023 	DBGINFO(("testing %s\n", info->device_name));
5024 	if (register_test(info) < 0) {
5025 		printk("register test failure %s addr=%08X\n",
5026 			info->device_name, info->phys_reg_addr);
5027 	} else if (irq_test(info) < 0) {
5028 		printk("IRQ test failure %s IRQ=%d\n",
5029 			info->device_name, info->irq_level);
5030 	} else if (loopback_test(info) < 0) {
5031 		printk("loopback test failure %s\n", info->device_name);
5032 	}
5033 	return info->init_error;
5034 }
5035 
5036 /*
5037  * transmit timeout handler
5038  */
tx_timeout(struct timer_list * t)5039 static void tx_timeout(struct timer_list *t)
5040 {
5041 	struct slgt_info *info = from_timer(info, t, tx_timer);
5042 	unsigned long flags;
5043 
5044 	DBGINFO(("%s tx_timeout\n", info->device_name));
5045 	if(info->tx_active && info->params.mode == MGSL_MODE_HDLC) {
5046 		info->icount.txtimeout++;
5047 	}
5048 	spin_lock_irqsave(&info->lock,flags);
5049 	tx_stop(info);
5050 	spin_unlock_irqrestore(&info->lock,flags);
5051 
5052 #if SYNCLINK_GENERIC_HDLC
5053 	if (info->netcount)
5054 		hdlcdev_tx_done(info);
5055 	else
5056 #endif
5057 		bh_transmit(info);
5058 }
5059 
5060 /*
5061  * receive buffer polling timer
5062  */
rx_timeout(struct timer_list * t)5063 static void rx_timeout(struct timer_list *t)
5064 {
5065 	struct slgt_info *info = from_timer(info, t, rx_timer);
5066 	unsigned long flags;
5067 
5068 	DBGINFO(("%s rx_timeout\n", info->device_name));
5069 	spin_lock_irqsave(&info->lock, flags);
5070 	info->pending_bh |= BH_RECEIVE;
5071 	spin_unlock_irqrestore(&info->lock, flags);
5072 	bh_handler(&info->task);
5073 }
5074 
5075