Lines Matching full:info

529 static void hdlcdev_tx_done(SLMP_INFO *info);
530 static void hdlcdev_rx(SLMP_INFO *info, char *buf, int size);
531 static int hdlcdev_init(SLMP_INFO *info);
532 static void hdlcdev_exit(SLMP_INFO *info);
537 static int get_stats(SLMP_INFO *info, struct mgsl_icount __user *user_icount);
538 static int get_params(SLMP_INFO *info, MGSL_PARAMS __user *params);
539 static int set_params(SLMP_INFO *info, MGSL_PARAMS __user *params);
540 static int get_txidle(SLMP_INFO *info, int __user *idle_mode);
541 static int set_txidle(SLMP_INFO *info, int idle_mode);
542 static int tx_enable(SLMP_INFO *info, int enable);
543 static int tx_abort(SLMP_INFO *info);
544 static int rx_enable(SLMP_INFO *info, int enable);
545 static int modem_input_wait(SLMP_INFO *info,int arg);
546 static int wait_mgsl_event(SLMP_INFO *info, int __user *mask_ptr);
552 static int add_device(SLMP_INFO *info);
554 static int claim_resources(SLMP_INFO *info);
555 static void release_resources(SLMP_INFO *info);
557 static int startup(SLMP_INFO *info);
558 static int block_til_ready(struct tty_struct *tty, struct file * filp,SLMP_INFO *info);
560 static void shutdown(SLMP_INFO *info);
561 static void program_hw(SLMP_INFO *info);
562 static void change_params(SLMP_INFO *info);
564 static bool init_adapter(SLMP_INFO *info);
565 static bool register_test(SLMP_INFO *info);
566 static bool irq_test(SLMP_INFO *info);
567 static bool loopback_test(SLMP_INFO *info);
568 static int adapter_test(SLMP_INFO *info);
569 static bool memory_test(SLMP_INFO *info);
571 static void reset_adapter(SLMP_INFO *info);
572 static void reset_port(SLMP_INFO *info);
573 static void async_mode(SLMP_INFO *info);
574 static void hdlc_mode(SLMP_INFO *info);
576 static void rx_stop(SLMP_INFO *info);
577 static void rx_start(SLMP_INFO *info);
578 static void rx_reset_buffers(SLMP_INFO *info);
579 static void rx_free_frame_buffers(SLMP_INFO *info, unsigned int first, unsigned int last);
580 static bool rx_get_frame(SLMP_INFO *info);
582 static void tx_start(SLMP_INFO *info);
583 static void tx_stop(SLMP_INFO *info);
584 static void tx_load_fifo(SLMP_INFO *info);
585 static void tx_set_idle(SLMP_INFO *info);
586 static void tx_load_dma_buffer(SLMP_INFO *info, const char *buf, unsigned int count);
588 static void get_signals(SLMP_INFO *info);
589 static void set_signals(SLMP_INFO *info);
590 static void enable_loopback(SLMP_INFO *info, int enable);
591 static void set_rate(SLMP_INFO *info, u32 data_rate);
593 static int bh_action(SLMP_INFO *info);
595 static void bh_receive(SLMP_INFO *info);
596 static void bh_transmit(SLMP_INFO *info);
597 static void bh_status(SLMP_INFO *info);
598 static void isr_timer(SLMP_INFO *info);
599 static void isr_rxint(SLMP_INFO *info);
600 static void isr_rxrdy(SLMP_INFO *info);
601 static void isr_txint(SLMP_INFO *info);
602 static void isr_txrdy(SLMP_INFO *info);
603 static void isr_rxdmaok(SLMP_INFO *info);
604 static void isr_rxdmaerror(SLMP_INFO *info);
605 static void isr_txdmaok(SLMP_INFO *info);
606 static void isr_txdmaerror(SLMP_INFO *info);
607 static void isr_io_pin(SLMP_INFO *info, u16 status);
609 static int alloc_dma_bufs(SLMP_INFO *info);
610 static void free_dma_bufs(SLMP_INFO *info);
611 static int alloc_buf_list(SLMP_INFO *info);
612 static int alloc_frame_bufs(SLMP_INFO *info, SCADESC *list, SCADESC_EX *list_ex,int count);
613 static int alloc_tmp_rx_buf(SLMP_INFO *info);
614 static void free_tmp_rx_buf(SLMP_INFO *info);
616 static void load_pci_memory(SLMP_INFO *info, char* dest, const char* src, unsigned short count);
617 static void trace_block(SLMP_INFO *info, const char* data, int count, int xmit);
621 static unsigned char read_reg(SLMP_INFO *info, unsigned char addr);
622 static void write_reg(SLMP_INFO *info, unsigned char addr, unsigned char val);
623 static u16 read_reg16(SLMP_INFO *info, unsigned char addr);
624 static void write_reg16(SLMP_INFO *info, unsigned char addr, u16 val);
625 static unsigned char read_status_reg(SLMP_INFO * info);
626 static void write_control_reg(SLMP_INFO * info);
664 static inline int sanity_check(SLMP_INFO *info, in sanity_check() argument
673 if (!info) { in sanity_check()
677 if (info->magic != MGSL_MAGIC) { in sanity_check()
682 if (!info) in sanity_check()
715 SLMP_INFO *info; in install() local
724 info = synclinkmp_device_list; in install()
725 while (info && info->line != line) in install()
726 info = info->next_device; in install()
727 if (sanity_check(info, tty->name, "open")) in install()
729 if (info->init_error) { in install()
731 __FILE__, __LINE__, info->device_name, in install()
732 info->init_error); in install()
736 tty->driver_data = info; in install()
738 return tty_port_install(&info->port, driver, tty); in install()
745 SLMP_INFO *info = tty->driver_data; in open() local
749 info->port.tty = tty; in open()
753 __FILE__,__LINE__,tty->driver->name, info->port.count); in open()
755 info->port.low_latency = (info->port.flags & ASYNC_LOW_LATENCY) ? 1 : 0; in open()
757 spin_lock_irqsave(&info->netlock, flags); in open()
758 if (info->netcount) { in open()
760 spin_unlock_irqrestore(&info->netlock, flags); in open()
763 info->port.count++; in open()
764 spin_unlock_irqrestore(&info->netlock, flags); in open()
766 if (info->port.count == 1) { in open()
768 retval = startup(info); in open()
773 retval = block_til_ready(tty, filp, info); in open()
777 __FILE__,__LINE__, info->device_name, retval); in open()
783 __FILE__,__LINE__, info->device_name); in open()
789 info->port.tty = NULL; /* tty layer will release tty struct */ in open()
790 if(info->port.count) in open()
791 info->port.count--; in open()
802 SLMP_INFO * info = tty->driver_data; in close() local
804 if (sanity_check(info, tty->name, "close")) in close()
809 __FILE__,__LINE__, info->device_name, info->port.count); in close()
811 if (tty_port_close_start(&info->port, tty, filp) == 0) in close()
814 mutex_lock(&info->port.mutex); in close()
815 if (tty_port_initialized(&info->port)) in close()
816 wait_until_sent(tty, info->timeout); in close()
820 shutdown(info); in close()
821 mutex_unlock(&info->port.mutex); in close()
823 tty_port_close_end(&info->port, tty); in close()
824 info->port.tty = NULL; in close()
828 tty->driver->name, info->port.count); in close()
836 SLMP_INFO *info = tty->driver_data; in hangup() local
841 __FILE__,__LINE__, info->device_name ); in hangup()
843 if (sanity_check(info, tty->name, "hangup")) in hangup()
846 mutex_lock(&info->port.mutex); in hangup()
848 shutdown(info); in hangup()
850 spin_lock_irqsave(&info->port.lock, flags); in hangup()
851 info->port.count = 0; in hangup()
852 info->port.tty = NULL; in hangup()
853 spin_unlock_irqrestore(&info->port.lock, flags); in hangup()
854 tty_port_set_active(&info->port, 1); in hangup()
855 mutex_unlock(&info->port.mutex); in hangup()
857 wake_up_interruptible(&info->port.open_wait); in hangup()
864 SLMP_INFO *info = tty->driver_data; in set_termios() local
871 change_params(info); in set_termios()
875 info->serial_signals &= ~(SerialSignal_RTS | SerialSignal_DTR); in set_termios()
876 spin_lock_irqsave(&info->lock,flags); in set_termios()
877 set_signals(info); in set_termios()
878 spin_unlock_irqrestore(&info->lock,flags); in set_termios()
883 info->serial_signals |= SerialSignal_DTR; in set_termios()
885 info->serial_signals |= SerialSignal_RTS; in set_termios()
886 spin_lock_irqsave(&info->lock,flags); in set_termios()
887 set_signals(info); in set_termios()
888 spin_unlock_irqrestore(&info->lock,flags); in set_termios()
912 SLMP_INFO *info = tty->driver_data; in write() local
917 __FILE__,__LINE__,info->device_name,count); in write()
919 if (sanity_check(info, tty->name, "write")) in write()
922 if (!info->tx_buf) in write()
925 if (info->params.mode == MGSL_MODE_HDLC) { in write()
926 if (count > info->max_frame_size) { in write()
930 if (info->tx_active) in write()
932 if (info->tx_count) { in write()
935 tx_load_dma_buffer(info, info->tx_buf, info->tx_count); in write()
938 ret = info->tx_count = count; in write()
939 tx_load_dma_buffer(info, buf, count); in write()
945 min(info->max_frame_size - info->tx_count - 1, in write()
946 info->max_frame_size - info->tx_put)); in write()
950 memcpy(info->tx_buf + info->tx_put, buf, c); in write()
952 spin_lock_irqsave(&info->lock,flags); in write()
953 info->tx_put += c; in write()
954 if (info->tx_put >= info->max_frame_size) in write()
955 info->tx_put -= info->max_frame_size; in write()
956 info->tx_count += c; in write()
957 spin_unlock_irqrestore(&info->lock,flags); in write()
964 if (info->params.mode == MGSL_MODE_HDLC) { in write()
966 ret = info->tx_count = 0; in write()
969 tx_load_dma_buffer(info, info->tx_buf, info->tx_count); in write()
972 if (info->tx_count && !tty->stopped && !tty->hw_stopped) { in write()
973 spin_lock_irqsave(&info->lock,flags); in write()
974 if (!info->tx_active) in write()
975 tx_start(info); in write()
976 spin_unlock_irqrestore(&info->lock,flags); in write()
982 __FILE__,__LINE__,info->device_name,ret); in write()
990 SLMP_INFO *info = tty->driver_data; in put_char() local
996 __FILE__,__LINE__,info->device_name,ch); in put_char()
999 if (sanity_check(info, tty->name, "put_char")) in put_char()
1002 if (!info->tx_buf) in put_char()
1005 spin_lock_irqsave(&info->lock,flags); in put_char()
1007 if ( (info->params.mode != MGSL_MODE_HDLC) || in put_char()
1008 !info->tx_active ) { in put_char()
1010 if (info->tx_count < info->max_frame_size - 1) { in put_char()
1011 info->tx_buf[info->tx_put++] = ch; in put_char()
1012 if (info->tx_put >= info->max_frame_size) in put_char()
1013 info->tx_put -= info->max_frame_size; in put_char()
1014 info->tx_count++; in put_char()
1019 spin_unlock_irqrestore(&info->lock,flags); in put_char()
1027 SLMP_INFO *info = tty->driver_data; in send_xchar() local
1032 __FILE__,__LINE__, info->device_name, ch ); in send_xchar()
1034 if (sanity_check(info, tty->name, "send_xchar")) in send_xchar()
1037 info->x_char = ch; in send_xchar()
1040 spin_lock_irqsave(&info->lock,flags); in send_xchar()
1041 if (!info->tx_enabled) in send_xchar()
1042 tx_start(info); in send_xchar()
1043 spin_unlock_irqrestore(&info->lock,flags); in send_xchar()
1051 SLMP_INFO * info = tty->driver_data; in wait_until_sent() local
1054 if (!info ) in wait_until_sent()
1059 __FILE__,__LINE__, info->device_name ); in wait_until_sent()
1061 if (sanity_check(info, tty->name, "wait_until_sent")) in wait_until_sent()
1064 if (!tty_port_initialized(&info->port)) in wait_until_sent()
1075 if ( info->params.data_rate ) { in wait_until_sent()
1076 char_time = info->timeout/(32 * 5); in wait_until_sent()
1085 if ( info->params.mode == MGSL_MODE_HDLC ) { in wait_until_sent()
1086 while (info->tx_active) { in wait_until_sent()
1098 while ( info->tx_active && info->tx_enabled) { in wait_until_sent()
1110 __FILE__,__LINE__, info->device_name ); in wait_until_sent()
1117 SLMP_INFO *info = tty->driver_data; in write_room() local
1120 if (sanity_check(info, tty->name, "write_room")) in write_room()
1123 if (info->params.mode == MGSL_MODE_HDLC) { in write_room()
1124 ret = (info->tx_active) ? 0 : HDLC_MAX_FRAME_SIZE; in write_room()
1126 ret = info->max_frame_size - info->tx_count - 1; in write_room()
1133 __FILE__, __LINE__, info->device_name, ret); in write_room()
1142 SLMP_INFO *info = tty->driver_data; in flush_chars() local
1147 __FILE__,__LINE__,info->device_name,info->tx_count); in flush_chars()
1149 if (sanity_check(info, tty->name, "flush_chars")) in flush_chars()
1152 if (info->tx_count <= 0 || tty->stopped || tty->hw_stopped || in flush_chars()
1153 !info->tx_buf) in flush_chars()
1158 __FILE__,__LINE__,info->device_name ); in flush_chars()
1160 spin_lock_irqsave(&info->lock,flags); in flush_chars()
1162 if (!info->tx_active) { in flush_chars()
1163 if ( (info->params.mode == MGSL_MODE_HDLC) && in flush_chars()
1164 info->tx_count ) { in flush_chars()
1168 tx_load_dma_buffer(info, in flush_chars()
1169 info->tx_buf,info->tx_count); in flush_chars()
1171 tx_start(info); in flush_chars()
1174 spin_unlock_irqrestore(&info->lock,flags); in flush_chars()
1181 SLMP_INFO *info = tty->driver_data; in flush_buffer() local
1186 __FILE__,__LINE__, info->device_name ); in flush_buffer()
1188 if (sanity_check(info, tty->name, "flush_buffer")) in flush_buffer()
1191 spin_lock_irqsave(&info->lock,flags); in flush_buffer()
1192 info->tx_count = info->tx_put = info->tx_get = 0; in flush_buffer()
1193 del_timer(&info->tx_timer); in flush_buffer()
1194 spin_unlock_irqrestore(&info->lock,flags); in flush_buffer()
1203 SLMP_INFO *info = tty->driver_data; in tx_hold() local
1206 if (sanity_check(info, tty->name, "tx_hold")) in tx_hold()
1211 __FILE__,__LINE__,info->device_name); in tx_hold()
1213 spin_lock_irqsave(&info->lock,flags); in tx_hold()
1214 if (info->tx_enabled) in tx_hold()
1215 tx_stop(info); in tx_hold()
1216 spin_unlock_irqrestore(&info->lock,flags); in tx_hold()
1223 SLMP_INFO *info = tty->driver_data; in tx_release() local
1226 if (sanity_check(info, tty->name, "tx_release")) in tx_release()
1231 __FILE__,__LINE__,info->device_name); in tx_release()
1233 spin_lock_irqsave(&info->lock,flags); in tx_release()
1234 if (!info->tx_enabled) in tx_release()
1235 tx_start(info); in tx_release()
1236 spin_unlock_irqrestore(&info->lock,flags); in tx_release()
1252 SLMP_INFO *info = tty->driver_data; in ioctl() local
1257 info->device_name, cmd ); in ioctl()
1259 if (sanity_check(info, tty->name, "ioctl")) in ioctl()
1269 return get_params(info, argp); in ioctl()
1271 return set_params(info, argp); in ioctl()
1273 return get_txidle(info, argp); in ioctl()
1275 return set_txidle(info, (int)arg); in ioctl()
1277 return tx_enable(info, (int)arg); in ioctl()
1279 return rx_enable(info, (int)arg); in ioctl()
1281 return tx_abort(info); in ioctl()
1283 return get_stats(info, argp); in ioctl()
1285 return wait_mgsl_event(info, argp); in ioctl()
1292 return modem_input_wait(info,(int)arg); in ioctl()
1309 SLMP_INFO *info = tty->driver_data; in get_icount() local
1313 spin_lock_irqsave(&info->lock,flags); in get_icount()
1314 cnow = info->icount; in get_icount()
1315 spin_unlock_irqrestore(&info->lock,flags); in get_icount()
1336 static inline void line_info(struct seq_file *m, SLMP_INFO *info) in line_info() argument
1343 info->device_name, in line_info()
1344 info->phys_sca_base, in line_info()
1345 info->phys_memory_base, in line_info()
1346 info->phys_statctrl_base, in line_info()
1347 info->phys_lcr_base, in line_info()
1348 info->irq_level, in line_info()
1349 info->max_frame_size ); in line_info()
1352 spin_lock_irqsave(&info->lock,flags); in line_info()
1353 get_signals(info); in line_info()
1354 spin_unlock_irqrestore(&info->lock,flags); in line_info()
1358 if (info->serial_signals & SerialSignal_RTS) in line_info()
1360 if (info->serial_signals & SerialSignal_CTS) in line_info()
1362 if (info->serial_signals & SerialSignal_DTR) in line_info()
1364 if (info->serial_signals & SerialSignal_DSR) in line_info()
1366 if (info->serial_signals & SerialSignal_DCD) in line_info()
1368 if (info->serial_signals & SerialSignal_RI) in line_info()
1371 if (info->params.mode == MGSL_MODE_HDLC) { in line_info()
1373 info->icount.txok, info->icount.rxok); in line_info()
1374 if (info->icount.txunder) in line_info()
1375 seq_printf(m, " txunder:%d", info->icount.txunder); in line_info()
1376 if (info->icount.txabort) in line_info()
1377 seq_printf(m, " txabort:%d", info->icount.txabort); in line_info()
1378 if (info->icount.rxshort) in line_info()
1379 seq_printf(m, " rxshort:%d", info->icount.rxshort); in line_info()
1380 if (info->icount.rxlong) in line_info()
1381 seq_printf(m, " rxlong:%d", info->icount.rxlong); in line_info()
1382 if (info->icount.rxover) in line_info()
1383 seq_printf(m, " rxover:%d", info->icount.rxover); in line_info()
1384 if (info->icount.rxcrc) in line_info()
1385 seq_printf(m, " rxlong:%d", info->icount.rxcrc); in line_info()
1388 info->icount.tx, info->icount.rx); in line_info()
1389 if (info->icount.frame) in line_info()
1390 seq_printf(m, " fe:%d", info->icount.frame); in line_info()
1391 if (info->icount.parity) in line_info()
1392 seq_printf(m, " pe:%d", info->icount.parity); in line_info()
1393 if (info->icount.brk) in line_info()
1394 seq_printf(m, " brk:%d", info->icount.brk); in line_info()
1395 if (info->icount.overrun) in line_info()
1396 seq_printf(m, " oe:%d", info->icount.overrun); in line_info()
1403 info->tx_active,info->bh_requested,info->bh_running, in line_info()
1404 info->pending_bh); in line_info()
1411 SLMP_INFO *info; in synclinkmp_proc_show() local
1415 info = synclinkmp_device_list; in synclinkmp_proc_show()
1416 while( info ) { in synclinkmp_proc_show()
1417 line_info(m, info); in synclinkmp_proc_show()
1418 info = info->next_device; in synclinkmp_proc_show()
1427 SLMP_INFO *info = tty->driver_data; in chars_in_buffer() local
1429 if (sanity_check(info, tty->name, "chars_in_buffer")) in chars_in_buffer()
1434 __FILE__, __LINE__, info->device_name, info->tx_count); in chars_in_buffer()
1436 return info->tx_count; in chars_in_buffer()
1443 SLMP_INFO *info = tty->driver_data; in throttle() local
1448 __FILE__,__LINE__, info->device_name ); in throttle()
1450 if (sanity_check(info, tty->name, "throttle")) in throttle()
1457 spin_lock_irqsave(&info->lock,flags); in throttle()
1458 info->serial_signals &= ~SerialSignal_RTS; in throttle()
1459 set_signals(info); in throttle()
1460 spin_unlock_irqrestore(&info->lock,flags); in throttle()
1468 SLMP_INFO *info = tty->driver_data; in unthrottle() local
1473 __FILE__,__LINE__, info->device_name ); in unthrottle()
1475 if (sanity_check(info, tty->name, "unthrottle")) in unthrottle()
1479 if (info->x_char) in unthrottle()
1480 info->x_char = 0; in unthrottle()
1486 spin_lock_irqsave(&info->lock,flags); in unthrottle()
1487 info->serial_signals |= SerialSignal_RTS; in unthrottle()
1488 set_signals(info); in unthrottle()
1489 spin_unlock_irqrestore(&info->lock,flags); in unthrottle()
1499 SLMP_INFO * info = tty->driver_data; in set_break() local
1504 __FILE__,__LINE__, info->device_name, break_state); in set_break()
1506 if (sanity_check(info, tty->name, "set_break")) in set_break()
1509 spin_lock_irqsave(&info->lock,flags); in set_break()
1510 RegValue = read_reg(info, CTL); in set_break()
1515 write_reg(info, CTL, RegValue); in set_break()
1516 spin_unlock_irqrestore(&info->lock,flags); in set_break()
1535 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_attach() local
1540 if (info->port.count) in hdlcdev_attach()
1561 info->params.encoding = new_encoding; in hdlcdev_attach()
1562 info->params.crc_type = new_crctype; in hdlcdev_attach()
1565 if (info->netcount) in hdlcdev_attach()
1566 program_hw(info); in hdlcdev_attach()
1580 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_xmit() local
1590 info->tx_count = skb->len; in hdlcdev_xmit()
1591 tx_load_dma_buffer(info, skb->data, skb->len); in hdlcdev_xmit()
1604 spin_lock_irqsave(&info->lock,flags); in hdlcdev_xmit()
1605 if (!info->tx_active) in hdlcdev_xmit()
1606 tx_start(info); in hdlcdev_xmit()
1607 spin_unlock_irqrestore(&info->lock,flags); in hdlcdev_xmit()
1622 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_open() local
1635 spin_lock_irqsave(&info->netlock, flags); in hdlcdev_open()
1636 if (info->port.count != 0 || info->netcount != 0) { in hdlcdev_open()
1638 spin_unlock_irqrestore(&info->netlock, flags); in hdlcdev_open()
1641 info->netcount=1; in hdlcdev_open()
1642 spin_unlock_irqrestore(&info->netlock, flags); in hdlcdev_open()
1645 if ((rc = startup(info)) != 0) { in hdlcdev_open()
1646 spin_lock_irqsave(&info->netlock, flags); in hdlcdev_open()
1647 info->netcount=0; in hdlcdev_open()
1648 spin_unlock_irqrestore(&info->netlock, flags); in hdlcdev_open()
1653 info->serial_signals |= SerialSignal_RTS | SerialSignal_DTR; in hdlcdev_open()
1654 program_hw(info); in hdlcdev_open()
1661 spin_lock_irqsave(&info->lock, flags); in hdlcdev_open()
1662 get_signals(info); in hdlcdev_open()
1663 spin_unlock_irqrestore(&info->lock, flags); in hdlcdev_open()
1664 if (info->serial_signals & SerialSignal_DCD) in hdlcdev_open()
1681 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_close() local
1690 shutdown(info); in hdlcdev_close()
1694 spin_lock_irqsave(&info->netlock, flags); in hdlcdev_close()
1695 info->netcount=0; in hdlcdev_close()
1696 spin_unlock_irqrestore(&info->netlock, flags); in hdlcdev_close()
1715 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_ioctl() local
1722 if (info->port.count) in hdlcdev_ioctl()
1737 flags = info->params.flags & (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL | in hdlcdev_ioctl()
1751 new_line.clock_rate = info->params.clock_speed; in hdlcdev_ioctl()
1752 new_line.loopback = info->params.loopback ? 1:0; in hdlcdev_ioctl()
1771 case CLOCK_DEFAULT: flags = info->params.flags & in hdlcdev_ioctl()
1782 info->params.flags &= ~(HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL | in hdlcdev_ioctl()
1786 info->params.flags |= flags; in hdlcdev_ioctl()
1788 info->params.loopback = new_line.loopback; in hdlcdev_ioctl()
1791 info->params.clock_speed = new_line.clock_rate; in hdlcdev_ioctl()
1793 info->params.clock_speed = 0; in hdlcdev_ioctl()
1796 if (info->netcount) in hdlcdev_ioctl()
1797 program_hw(info); in hdlcdev_ioctl()
1812 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_tx_timeout() local
1821 spin_lock_irqsave(&info->lock,flags); in hdlcdev_tx_timeout()
1822 tx_stop(info); in hdlcdev_tx_timeout()
1823 spin_unlock_irqrestore(&info->lock,flags); in hdlcdev_tx_timeout()
1832 * info pointer to device instance information
1834 static void hdlcdev_tx_done(SLMP_INFO *info) in hdlcdev_tx_done() argument
1836 if (netif_queue_stopped(info->netdev)) in hdlcdev_tx_done()
1837 netif_wake_queue(info->netdev); in hdlcdev_tx_done()
1844 * info pointer to device instance information
1848 static void hdlcdev_rx(SLMP_INFO *info, char *buf, int size) in hdlcdev_rx() argument
1851 struct net_device *dev = info->netdev; in hdlcdev_rx()
1885 * info pointer to device instance information
1889 static int hdlcdev_init(SLMP_INFO *info) in hdlcdev_init() argument
1897 dev = alloc_hdlcdev(info); in hdlcdev_init()
1904 dev->mem_start = info->phys_sca_base; in hdlcdev_init()
1905 dev->mem_end = info->phys_sca_base + SCA_BASE_SIZE - 1; in hdlcdev_init()
1906 dev->irq = info->irq_level; in hdlcdev_init()
1926 info->netdev = dev; in hdlcdev_init()
1934 * info pointer to device instance information
1936 static void hdlcdev_exit(SLMP_INFO *info) in hdlcdev_exit() argument
1938 unregister_hdlc_device(info->netdev); in hdlcdev_exit()
1939 free_netdev(info->netdev); in hdlcdev_exit()
1940 info->netdev = NULL; in hdlcdev_exit()
1949 static int bh_action(SLMP_INFO *info) in bh_action() argument
1954 spin_lock_irqsave(&info->lock,flags); in bh_action()
1956 if (info->pending_bh & BH_RECEIVE) { in bh_action()
1957 info->pending_bh &= ~BH_RECEIVE; in bh_action()
1959 } else if (info->pending_bh & BH_TRANSMIT) { in bh_action()
1960 info->pending_bh &= ~BH_TRANSMIT; in bh_action()
1962 } else if (info->pending_bh & BH_STATUS) { in bh_action()
1963 info->pending_bh &= ~BH_STATUS; in bh_action()
1969 info->bh_running = false; in bh_action()
1970 info->bh_requested = false; in bh_action()
1973 spin_unlock_irqrestore(&info->lock,flags); in bh_action()
1982 SLMP_INFO *info = container_of(work, SLMP_INFO, task); in bh_handler() local
1987 __FILE__,__LINE__,info->device_name); in bh_handler()
1989 info->bh_running = true; in bh_handler()
1991 while((action = bh_action(info)) != 0) { in bh_handler()
1996 __FILE__,__LINE__,info->device_name, action); in bh_handler()
2001 bh_receive(info); in bh_handler()
2004 bh_transmit(info); in bh_handler()
2007 bh_status(info); in bh_handler()
2012 __FILE__,__LINE__,info->device_name,action); in bh_handler()
2019 __FILE__,__LINE__,info->device_name); in bh_handler()
2022 static void bh_receive(SLMP_INFO *info) in bh_receive() argument
2026 __FILE__,__LINE__,info->device_name); in bh_receive()
2028 while( rx_get_frame(info) ); in bh_receive()
2031 static void bh_transmit(SLMP_INFO *info) in bh_transmit() argument
2033 struct tty_struct *tty = info->port.tty; in bh_transmit()
2037 __FILE__,__LINE__,info->device_name); in bh_transmit()
2043 static void bh_status(SLMP_INFO *info) in bh_status() argument
2047 __FILE__,__LINE__,info->device_name); in bh_status()
2049 info->ri_chkcount = 0; in bh_status()
2050 info->dsr_chkcount = 0; in bh_status()
2051 info->dcd_chkcount = 0; in bh_status()
2052 info->cts_chkcount = 0; in bh_status()
2055 static void isr_timer(SLMP_INFO * info) in isr_timer() argument
2057 unsigned char timer = (info->port_num & 1) ? TIMER2 : TIMER0; in isr_timer()
2060 write_reg(info, IER2, 0); in isr_timer()
2072 write_reg(info, (unsigned char)(timer + TMCS), 0); in isr_timer()
2074 info->irq_occurred = true; in isr_timer()
2078 __FILE__,__LINE__,info->device_name); in isr_timer()
2081 static void isr_rxint(SLMP_INFO * info) in isr_rxint() argument
2083 struct tty_struct *tty = info->port.tty; in isr_rxint()
2084 struct mgsl_icount *icount = &info->icount; in isr_rxint()
2085 unsigned char status = read_reg(info, SR1) & info->ie1_value & (FLGD + IDLD + CDCD + BRKD); in isr_rxint()
2086 unsigned char status2 = read_reg(info, SR2) & info->ie2_value & OVRN; in isr_rxint()
2090 write_reg(info, SR1, status); in isr_rxint()
2093 write_reg(info, SR2, status2); in isr_rxint()
2097 __FILE__,__LINE__,info->device_name,status,status2); in isr_rxint()
2099 if (info->params.mode == MGSL_MODE_ASYNC) { in isr_rxint()
2106 if (!(status & info->ignore_status_mask1)) { in isr_rxint()
2107 if (info->read_status_mask1 & BRKD) { in isr_rxint()
2108 tty_insert_flip_char(&info->port, 0, TTY_BREAK); in isr_rxint()
2109 if (tty && (info->port.flags & ASYNC_SAK)) in isr_rxint()
2118 info->icount.exithunt++; in isr_rxint()
2120 info->icount.rxidle++; in isr_rxint()
2121 wake_up_interruptible(&info->event_wait_q); in isr_rxint()
2129 get_signals( info ); in isr_rxint()
2130 isr_io_pin(info, in isr_rxint()
2131 MISCSTATUS_DCD_LATCHED|(info->serial_signals&SerialSignal_DCD)); in isr_rxint()
2138 static void isr_rxrdy(SLMP_INFO * info) in isr_rxrdy() argument
2142 struct mgsl_icount *icount = &info->icount; in isr_rxrdy()
2146 __FILE__,__LINE__,info->device_name); in isr_rxrdy()
2148 while((status = read_reg(info,CST0)) & BIT0) in isr_rxrdy()
2152 DataByte = read_reg(info,TRB); in isr_rxrdy()
2158 __FILE__,__LINE__,info->device_name,status); in isr_rxrdy()
2169 if (status & info->ignore_status_mask2) in isr_rxrdy()
2172 status &= info->read_status_mask2; in isr_rxrdy()
2187 tty_insert_flip_char(&info->port, DataByte, flag); in isr_rxrdy()
2189 tty_insert_flip_char(&info->port, 0, TTY_OVERRUN); in isr_rxrdy()
2194 __FILE__,__LINE__,info->device_name, in isr_rxrdy()
2199 tty_flip_buffer_push(&info->port); in isr_rxrdy()
2202 static void isr_txeom(SLMP_INFO * info, unsigned char status) in isr_txeom() argument
2206 __FILE__,__LINE__,info->device_name,status); in isr_txeom()
2208 write_reg(info, TXDMA + DIR, 0x00); /* disable Tx DMA IRQs */ in isr_txeom()
2209 write_reg(info, TXDMA + DSR, 0xc0); /* clear IRQs and disable DMA */ in isr_txeom()
2210 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in isr_txeom()
2213 write_reg(info, CMD, TXRESET); in isr_txeom()
2214 write_reg(info, CMD, TXENABLE); in isr_txeom()
2216 write_reg(info, CMD, TXBUFCLR); in isr_txeom()
2219 info->ie0_value &= ~TXRDYE; in isr_txeom()
2220 info->ie1_value &= ~(IDLE + UDRN); in isr_txeom()
2221 write_reg16(info, IE0, (unsigned short)((info->ie1_value << 8) + info->ie0_value)); in isr_txeom()
2222 write_reg(info, SR1, (unsigned char)(UDRN + IDLE)); in isr_txeom()
2224 if ( info->tx_active ) { in isr_txeom()
2225 if (info->params.mode != MGSL_MODE_ASYNC) { in isr_txeom()
2227 info->icount.txunder++; in isr_txeom()
2229 info->icount.txok++; in isr_txeom()
2232 info->tx_active = false; in isr_txeom()
2233 info->tx_count = info->tx_put = info->tx_get = 0; in isr_txeom()
2235 del_timer(&info->tx_timer); in isr_txeom()
2237 if (info->params.mode != MGSL_MODE_ASYNC && info->drop_rts_on_tx_done ) { in isr_txeom()
2238 info->serial_signals &= ~SerialSignal_RTS; in isr_txeom()
2239 info->drop_rts_on_tx_done = false; in isr_txeom()
2240 set_signals(info); in isr_txeom()
2244 if (info->netcount) in isr_txeom()
2245 hdlcdev_tx_done(info); in isr_txeom()
2249 if (info->port.tty && (info->port.tty->stopped || info->port.tty->hw_stopped)) { in isr_txeom()
2250 tx_stop(info); in isr_txeom()
2253 info->pending_bh |= BH_TRANSMIT; in isr_txeom()
2262 static void isr_txint(SLMP_INFO * info) in isr_txint() argument
2264 unsigned char status = read_reg(info, SR1) & info->ie1_value & (UDRN + IDLE + CCTS); in isr_txint()
2267 write_reg(info, SR1, status); in isr_txint()
2271 __FILE__,__LINE__,info->device_name,status); in isr_txint()
2274 isr_txeom(info, status); in isr_txint()
2280 get_signals( info ); in isr_txint()
2281 isr_io_pin(info, in isr_txint()
2282 MISCSTATUS_CTS_LATCHED|(info->serial_signals&SerialSignal_CTS)); in isr_txint()
2290 static void isr_txrdy(SLMP_INFO * info) in isr_txrdy() argument
2294 __FILE__,__LINE__,info->device_name,info->tx_count); in isr_txrdy()
2296 if (info->params.mode != MGSL_MODE_ASYNC) { in isr_txrdy()
2298 info->ie0_value &= ~TXRDYE; in isr_txrdy()
2299 info->ie1_value |= IDLE; in isr_txrdy()
2300 write_reg16(info, IE0, (unsigned short)((info->ie1_value << 8) + info->ie0_value)); in isr_txrdy()
2304 if (info->port.tty && (info->port.tty->stopped || info->port.tty->hw_stopped)) { in isr_txrdy()
2305 tx_stop(info); in isr_txrdy()
2309 if ( info->tx_count ) in isr_txrdy()
2310 tx_load_fifo( info ); in isr_txrdy()
2312 info->tx_active = false; in isr_txrdy()
2313 info->ie0_value &= ~TXRDYE; in isr_txrdy()
2314 write_reg(info, IE0, info->ie0_value); in isr_txrdy()
2317 if (info->tx_count < WAKEUP_CHARS) in isr_txrdy()
2318 info->pending_bh |= BH_TRANSMIT; in isr_txrdy()
2321 static void isr_rxdmaok(SLMP_INFO * info) in isr_rxdmaok() argument
2326 unsigned char status = read_reg(info,RXDMA + DSR) & 0xc0; in isr_rxdmaok()
2329 write_reg(info, RXDMA + DSR, (unsigned char)(status | 1)); in isr_rxdmaok()
2333 __FILE__,__LINE__,info->device_name,status); in isr_rxdmaok()
2335 info->pending_bh |= BH_RECEIVE; in isr_rxdmaok()
2338 static void isr_rxdmaerror(SLMP_INFO * info) in isr_rxdmaerror() argument
2343 unsigned char status = read_reg(info,RXDMA + DSR) & 0x30; in isr_rxdmaerror()
2346 write_reg(info, RXDMA + DSR, (unsigned char)(status | 1)); in isr_rxdmaerror()
2350 __FILE__,__LINE__,info->device_name,status); in isr_rxdmaerror()
2352 info->rx_overflow = true; in isr_rxdmaerror()
2353 info->pending_bh |= BH_RECEIVE; in isr_rxdmaerror()
2356 static void isr_txdmaok(SLMP_INFO * info) in isr_txdmaok() argument
2358 unsigned char status_reg1 = read_reg(info, SR1); in isr_txdmaok()
2360 write_reg(info, TXDMA + DIR, 0x00); /* disable Tx DMA IRQs */ in isr_txdmaok()
2361 write_reg(info, TXDMA + DSR, 0xc0); /* clear IRQs and disable DMA */ in isr_txdmaok()
2362 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in isr_txdmaok()
2366 __FILE__,__LINE__,info->device_name,status_reg1); in isr_txdmaok()
2369 write_reg16(info, TRC0, 0); in isr_txdmaok()
2370 info->ie0_value |= TXRDYE; in isr_txdmaok()
2371 write_reg(info, IE0, info->ie0_value); in isr_txdmaok()
2374 static void isr_txdmaerror(SLMP_INFO * info) in isr_txdmaerror() argument
2379 unsigned char status = read_reg(info,TXDMA + DSR) & 0x30; in isr_txdmaerror()
2382 write_reg(info, TXDMA + DSR, (unsigned char)(status | 1)); in isr_txdmaerror()
2386 __FILE__,__LINE__,info->device_name,status); in isr_txdmaerror()
2391 static void isr_io_pin( SLMP_INFO *info, u16 status ) in isr_io_pin() argument
2401 icount = &info->icount; in isr_io_pin()
2406 info->input_signal_events.ri_up++; in isr_io_pin()
2408 info->input_signal_events.ri_down++; in isr_io_pin()
2413 info->input_signal_events.dsr_up++; in isr_io_pin()
2415 info->input_signal_events.dsr_down++; in isr_io_pin()
2418 if ((info->dcd_chkcount)++ >= IO_PIN_SHUTDOWN_LIMIT) { in isr_io_pin()
2419 info->ie1_value &= ~CDCD; in isr_io_pin()
2420 write_reg(info, IE1, info->ie1_value); in isr_io_pin()
2424 info->input_signal_events.dcd_up++; in isr_io_pin()
2426 info->input_signal_events.dcd_down++; in isr_io_pin()
2428 if (info->netcount) { in isr_io_pin()
2430 netif_carrier_on(info->netdev); in isr_io_pin()
2432 netif_carrier_off(info->netdev); in isr_io_pin()
2438 if ((info->cts_chkcount)++ >= IO_PIN_SHUTDOWN_LIMIT) { in isr_io_pin()
2439 info->ie1_value &= ~CCTS; in isr_io_pin()
2440 write_reg(info, IE1, info->ie1_value); in isr_io_pin()
2444 info->input_signal_events.cts_up++; in isr_io_pin()
2446 info->input_signal_events.cts_down++; in isr_io_pin()
2448 wake_up_interruptible(&info->status_event_wait_q); in isr_io_pin()
2449 wake_up_interruptible(&info->event_wait_q); in isr_io_pin()
2451 if (tty_port_check_carrier(&info->port) && in isr_io_pin()
2454 printk("%s CD now %s...", info->device_name, in isr_io_pin()
2457 wake_up_interruptible(&info->port.open_wait); in isr_io_pin()
2461 if (info->port.tty) in isr_io_pin()
2462 tty_hangup(info->port.tty); in isr_io_pin()
2466 if (tty_port_cts_enabled(&info->port) && in isr_io_pin()
2468 if ( info->port.tty ) { in isr_io_pin()
2469 if (info->port.tty->hw_stopped) { in isr_io_pin()
2473 info->port.tty->hw_stopped = 0; in isr_io_pin()
2474 tx_start(info); in isr_io_pin()
2475 info->pending_bh |= BH_TRANSMIT; in isr_io_pin()
2482 info->port.tty->hw_stopped = 1; in isr_io_pin()
2483 tx_stop(info); in isr_io_pin()
2490 info->pending_bh |= BH_STATUS; in isr_io_pin()
2502 SLMP_INFO *info = dev_id; in synclinkmp_interrupt() local
2512 __FILE__, __LINE__, info->irq_level); in synclinkmp_interrupt()
2514 spin_lock(&info->lock); in synclinkmp_interrupt()
2519 tmp = read_reg16(info, ISR0); /* get ISR0 and ISR1 in one read */ in synclinkmp_interrupt()
2522 timerstatus0 = read_reg(info, ISR2); in synclinkmp_interrupt()
2526 __FILE__, __LINE__, info->device_name, in synclinkmp_interrupt()
2529 if (info->port_count == 4) { in synclinkmp_interrupt()
2531 tmp = read_reg16(info->port_array[2], ISR0); in synclinkmp_interrupt()
2534 timerstatus1 = read_reg(info->port_array[2], ISR2); in synclinkmp_interrupt()
2538 __FILE__,__LINE__,info->device_name, in synclinkmp_interrupt()
2546 for(i=0; i < info->port_count ; i++) { in synclinkmp_interrupt()
2547 if (info->port_array[i] == NULL) in synclinkmp_interrupt()
2560 isr_rxrdy(info->port_array[i]); in synclinkmp_interrupt()
2562 isr_txrdy(info->port_array[i]); in synclinkmp_interrupt()
2564 isr_rxint(info->port_array[i]); in synclinkmp_interrupt()
2566 isr_txint(info->port_array[i]); in synclinkmp_interrupt()
2569 isr_rxdmaerror(info->port_array[i]); in synclinkmp_interrupt()
2571 isr_rxdmaok(info->port_array[i]); in synclinkmp_interrupt()
2573 isr_txdmaerror(info->port_array[i]); in synclinkmp_interrupt()
2575 isr_txdmaok(info->port_array[i]); in synclinkmp_interrupt()
2579 isr_timer(info->port_array[0]); in synclinkmp_interrupt()
2581 isr_timer(info->port_array[1]); in synclinkmp_interrupt()
2583 isr_timer(info->port_array[2]); in synclinkmp_interrupt()
2585 isr_timer(info->port_array[3]); in synclinkmp_interrupt()
2588 for(i=0; i < info->port_count ; i++) { in synclinkmp_interrupt()
2589 SLMP_INFO * port = info->port_array[i]; in synclinkmp_interrupt()
2609 spin_unlock(&info->lock); in synclinkmp_interrupt()
2613 __FILE__, __LINE__, info->irq_level); in synclinkmp_interrupt()
2619 static int startup(SLMP_INFO * info) in startup() argument
2622 printk("%s(%d):%s tx_releaseup()\n",__FILE__,__LINE__,info->device_name); in startup()
2624 if (tty_port_initialized(&info->port)) in startup()
2627 if (!info->tx_buf) { in startup()
2628 info->tx_buf = kmalloc(info->max_frame_size, GFP_KERNEL); in startup()
2629 if (!info->tx_buf) { in startup()
2631 __FILE__,__LINE__,info->device_name); in startup()
2636 info->pending_bh = 0; in startup()
2638 memset(&info->icount, 0, sizeof(info->icount)); in startup()
2641 reset_port(info); in startup()
2643 change_params(info); in startup()
2645 mod_timer(&info->status_timer, jiffies + msecs_to_jiffies(10)); in startup()
2647 if (info->port.tty) in startup()
2648 clear_bit(TTY_IO_ERROR, &info->port.tty->flags); in startup()
2650 tty_port_set_initialized(&info->port, 1); in startup()
2657 static void shutdown(SLMP_INFO * info) in shutdown() argument
2661 if (!tty_port_initialized(&info->port)) in shutdown()
2666 __FILE__,__LINE__, info->device_name ); in shutdown()
2670 wake_up_interruptible(&info->status_event_wait_q); in shutdown()
2671 wake_up_interruptible(&info->event_wait_q); in shutdown()
2673 del_timer(&info->tx_timer); in shutdown()
2674 del_timer(&info->status_timer); in shutdown()
2676 kfree(info->tx_buf); in shutdown()
2677 info->tx_buf = NULL; in shutdown()
2679 spin_lock_irqsave(&info->lock,flags); in shutdown()
2681 reset_port(info); in shutdown()
2683 if (!info->port.tty || info->port.tty->termios.c_cflag & HUPCL) { in shutdown()
2684 info->serial_signals &= ~(SerialSignal_RTS | SerialSignal_DTR); in shutdown()
2685 set_signals(info); in shutdown()
2688 spin_unlock_irqrestore(&info->lock,flags); in shutdown()
2690 if (info->port.tty) in shutdown()
2691 set_bit(TTY_IO_ERROR, &info->port.tty->flags); in shutdown()
2693 tty_port_set_initialized(&info->port, 0); in shutdown()
2696 static void program_hw(SLMP_INFO *info) in program_hw() argument
2700 spin_lock_irqsave(&info->lock,flags); in program_hw()
2702 rx_stop(info); in program_hw()
2703 tx_stop(info); in program_hw()
2705 info->tx_count = info->tx_put = info->tx_get = 0; in program_hw()
2707 if (info->params.mode == MGSL_MODE_HDLC || info->netcount) in program_hw()
2708 hdlc_mode(info); in program_hw()
2710 async_mode(info); in program_hw()
2712 set_signals(info); in program_hw()
2714 info->dcd_chkcount = 0; in program_hw()
2715 info->cts_chkcount = 0; in program_hw()
2716 info->ri_chkcount = 0; in program_hw()
2717 info->dsr_chkcount = 0; in program_hw()
2719 info->ie1_value |= (CDCD|CCTS); in program_hw()
2720 write_reg(info, IE1, info->ie1_value); in program_hw()
2722 get_signals(info); in program_hw()
2724 if (info->netcount || (info->port.tty && info->port.tty->termios.c_cflag & CREAD) ) in program_hw()
2725 rx_start(info); in program_hw()
2727 spin_unlock_irqrestore(&info->lock,flags); in program_hw()
2732 static void change_params(SLMP_INFO *info) in change_params() argument
2737 if (!info->port.tty) in change_params()
2742 __FILE__,__LINE__, info->device_name ); in change_params()
2744 cflag = info->port.tty->termios.c_cflag; in change_params()
2749 info->serial_signals |= SerialSignal_RTS | SerialSignal_DTR; in change_params()
2751 info->serial_signals &= ~(SerialSignal_RTS | SerialSignal_DTR); in change_params()
2756 case CS5: info->params.data_bits = 5; break; in change_params()
2757 case CS6: info->params.data_bits = 6; break; in change_params()
2758 case CS7: info->params.data_bits = 7; break; in change_params()
2759 case CS8: info->params.data_bits = 8; break; in change_params()
2761 default: info->params.data_bits = 7; break; in change_params()
2765 info->params.stop_bits = 2; in change_params()
2767 info->params.stop_bits = 1; in change_params()
2769 info->params.parity = ASYNC_PARITY_NONE; in change_params()
2772 info->params.parity = ASYNC_PARITY_ODD; in change_params()
2774 info->params.parity = ASYNC_PARITY_EVEN; in change_params()
2777 info->params.parity = ASYNC_PARITY_SPACE; in change_params()
2784 bits_per_char = info->params.data_bits + in change_params()
2785 info->params.stop_bits + 1; in change_params()
2791 if (info->params.data_rate <= 460800) { in change_params()
2792 info->params.data_rate = tty_get_baud_rate(info->port.tty); in change_params()
2795 if ( info->params.data_rate ) { in change_params()
2796 info->timeout = (32*HZ*bits_per_char) / in change_params()
2797 info->params.data_rate; in change_params()
2799 info->timeout += HZ/50; /* Add .02 seconds of slop */ in change_params()
2801 tty_port_set_cts_flow(&info->port, cflag & CRTSCTS); in change_params()
2802 tty_port_set_check_carrier(&info->port, ~cflag & CLOCAL); in change_params()
2806 info->read_status_mask2 = OVRN; in change_params()
2807 if (I_INPCK(info->port.tty)) in change_params()
2808 info->read_status_mask2 |= PE | FRME; in change_params()
2809 if (I_BRKINT(info->port.tty) || I_PARMRK(info->port.tty)) in change_params()
2810 info->read_status_mask1 |= BRKD; in change_params()
2811 if (I_IGNPAR(info->port.tty)) in change_params()
2812 info->ignore_status_mask2 |= PE | FRME; in change_params()
2813 if (I_IGNBRK(info->port.tty)) { in change_params()
2814 info->ignore_status_mask1 |= BRKD; in change_params()
2818 if (I_IGNPAR(info->port.tty)) in change_params()
2819 info->ignore_status_mask2 |= OVRN; in change_params()
2822 program_hw(info); in change_params()
2825 static int get_stats(SLMP_INFO * info, struct mgsl_icount __user *user_icount) in get_stats() argument
2831 __FILE__,__LINE__, info->device_name); in get_stats()
2834 memset(&info->icount, 0, sizeof(info->icount)); in get_stats()
2836 mutex_lock(&info->port.mutex); in get_stats()
2837 COPY_TO_USER(err, user_icount, &info->icount, sizeof(struct mgsl_icount)); in get_stats()
2838 mutex_unlock(&info->port.mutex); in get_stats()
2846 static int get_params(SLMP_INFO * info, MGSL_PARAMS __user *user_params) in get_params() argument
2851 __FILE__,__LINE__, info->device_name); in get_params()
2853 mutex_lock(&info->port.mutex); in get_params()
2854 COPY_TO_USER(err,user_params, &info->params, sizeof(MGSL_PARAMS)); in get_params()
2855 mutex_unlock(&info->port.mutex); in get_params()
2859 __FILE__,__LINE__,info->device_name); in get_params()
2866 static int set_params(SLMP_INFO * info, MGSL_PARAMS __user *new_params) in set_params() argument
2874 __FILE__,__LINE__,info->device_name ); in set_params()
2879 __FILE__,__LINE__,info->device_name); in set_params()
2883 mutex_lock(&info->port.mutex); in set_params()
2884 spin_lock_irqsave(&info->lock,flags); in set_params()
2885 memcpy(&info->params,&tmp_params,sizeof(MGSL_PARAMS)); in set_params()
2886 spin_unlock_irqrestore(&info->lock,flags); in set_params()
2888 change_params(info); in set_params()
2889 mutex_unlock(&info->port.mutex); in set_params()
2894 static int get_txidle(SLMP_INFO * info, int __user *idle_mode) in get_txidle() argument
2900 __FILE__,__LINE__, info->device_name, info->idle_mode); in get_txidle()
2902 COPY_TO_USER(err,idle_mode, &info->idle_mode, sizeof(int)); in get_txidle()
2906 __FILE__,__LINE__,info->device_name); in get_txidle()
2913 static int set_txidle(SLMP_INFO * info, int idle_mode) in set_txidle() argument
2919 __FILE__,__LINE__,info->device_name, idle_mode ); in set_txidle()
2921 spin_lock_irqsave(&info->lock,flags); in set_txidle()
2922 info->idle_mode = idle_mode; in set_txidle()
2923 tx_set_idle( info ); in set_txidle()
2924 spin_unlock_irqrestore(&info->lock,flags); in set_txidle()
2928 static int tx_enable(SLMP_INFO * info, int enable) in tx_enable() argument
2934 __FILE__,__LINE__,info->device_name, enable); in tx_enable()
2936 spin_lock_irqsave(&info->lock,flags); in tx_enable()
2938 if ( !info->tx_enabled ) { in tx_enable()
2939 tx_start(info); in tx_enable()
2942 if ( info->tx_enabled ) in tx_enable()
2943 tx_stop(info); in tx_enable()
2945 spin_unlock_irqrestore(&info->lock,flags); in tx_enable()
2951 static int tx_abort(SLMP_INFO * info) in tx_abort() argument
2957 __FILE__,__LINE__,info->device_name); in tx_abort()
2959 spin_lock_irqsave(&info->lock,flags); in tx_abort()
2960 if ( info->tx_active && info->params.mode == MGSL_MODE_HDLC ) { in tx_abort()
2961 info->ie1_value &= ~UDRN; in tx_abort()
2962 info->ie1_value |= IDLE; in tx_abort()
2963 write_reg(info, IE1, info->ie1_value); /* disable tx status interrupts */ in tx_abort()
2964 write_reg(info, SR1, (unsigned char)(IDLE + UDRN)); /* clear pending */ in tx_abort()
2966 write_reg(info, TXDMA + DSR, 0); /* disable DMA channel */ in tx_abort()
2967 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in tx_abort()
2969 write_reg(info, CMD, TXABORT); in tx_abort()
2971 spin_unlock_irqrestore(&info->lock,flags); in tx_abort()
2975 static int rx_enable(SLMP_INFO * info, int enable) in rx_enable() argument
2981 __FILE__,__LINE__,info->device_name,enable); in rx_enable()
2983 spin_lock_irqsave(&info->lock,flags); in rx_enable()
2985 if ( !info->rx_enabled ) in rx_enable()
2986 rx_start(info); in rx_enable()
2988 if ( info->rx_enabled ) in rx_enable()
2989 rx_stop(info); in rx_enable()
2991 spin_unlock_irqrestore(&info->lock,flags); in rx_enable()
2997 static int wait_mgsl_event(SLMP_INFO * info, int __user *mask_ptr) in wait_mgsl_event() argument
3015 __FILE__,__LINE__,info->device_name,mask); in wait_mgsl_event()
3017 spin_lock_irqsave(&info->lock,flags); in wait_mgsl_event()
3020 get_signals(info); in wait_mgsl_event()
3021 s = info->serial_signals; in wait_mgsl_event()
3029 spin_unlock_irqrestore(&info->lock,flags); in wait_mgsl_event()
3034 cprev = info->icount; in wait_mgsl_event()
3035 oldsigs = info->input_signal_events; in wait_mgsl_event()
3039 unsigned char oldval = info->ie1_value; in wait_mgsl_event()
3044 info->ie1_value = newval; in wait_mgsl_event()
3045 write_reg(info, IE1, info->ie1_value); in wait_mgsl_event()
3050 add_wait_queue(&info->event_wait_q, &wait); in wait_mgsl_event()
3052 spin_unlock_irqrestore(&info->lock,flags); in wait_mgsl_event()
3062 spin_lock_irqsave(&info->lock,flags); in wait_mgsl_event()
3063 cnow = info->icount; in wait_mgsl_event()
3064 newsigs = info->input_signal_events; in wait_mgsl_event()
3066 spin_unlock_irqrestore(&info->lock,flags); in wait_mgsl_event()
3101 remove_wait_queue(&info->event_wait_q, &wait); in wait_mgsl_event()
3106 spin_lock_irqsave(&info->lock,flags); in wait_mgsl_event()
3107 if (!waitqueue_active(&info->event_wait_q)) { in wait_mgsl_event()
3109 info->ie1_value &= ~(FLGD|IDLD); in wait_mgsl_event()
3110 write_reg(info, IE1, info->ie1_value); in wait_mgsl_event()
3112 spin_unlock_irqrestore(&info->lock,flags); in wait_mgsl_event()
3121 static int modem_input_wait(SLMP_INFO *info,int arg) in modem_input_wait() argument
3129 spin_lock_irqsave(&info->lock,flags); in modem_input_wait()
3130 cprev = info->icount; in modem_input_wait()
3131 add_wait_queue(&info->status_event_wait_q, &wait); in modem_input_wait()
3133 spin_unlock_irqrestore(&info->lock,flags); in modem_input_wait()
3143 spin_lock_irqsave(&info->lock,flags); in modem_input_wait()
3144 cnow = info->icount; in modem_input_wait()
3146 spin_unlock_irqrestore(&info->lock,flags); in modem_input_wait()
3166 remove_wait_queue(&info->status_event_wait_q, &wait); in modem_input_wait()
3175 SLMP_INFO *info = tty->driver_data; in tiocmget() local
3179 spin_lock_irqsave(&info->lock,flags); in tiocmget()
3180 get_signals(info); in tiocmget()
3181 spin_unlock_irqrestore(&info->lock,flags); in tiocmget()
3183 result = ((info->serial_signals & SerialSignal_RTS) ? TIOCM_RTS : 0) | in tiocmget()
3184 ((info->serial_signals & SerialSignal_DTR) ? TIOCM_DTR : 0) | in tiocmget()
3185 ((info->serial_signals & SerialSignal_DCD) ? TIOCM_CAR : 0) | in tiocmget()
3186 ((info->serial_signals & SerialSignal_RI) ? TIOCM_RNG : 0) | in tiocmget()
3187 ((info->serial_signals & SerialSignal_DSR) ? TIOCM_DSR : 0) | in tiocmget()
3188 ((info->serial_signals & SerialSignal_CTS) ? TIOCM_CTS : 0); in tiocmget()
3192 __FILE__,__LINE__, info->device_name, result ); in tiocmget()
3201 SLMP_INFO *info = tty->driver_data; in tiocmset() local
3206 __FILE__,__LINE__,info->device_name, set, clear); in tiocmset()
3209 info->serial_signals |= SerialSignal_RTS; in tiocmset()
3211 info->serial_signals |= SerialSignal_DTR; in tiocmset()
3213 info->serial_signals &= ~SerialSignal_RTS; in tiocmset()
3215 info->serial_signals &= ~SerialSignal_DTR; in tiocmset()
3217 spin_lock_irqsave(&info->lock,flags); in tiocmset()
3218 set_signals(info); in tiocmset()
3219 spin_unlock_irqrestore(&info->lock,flags); in tiocmset()
3226 SLMP_INFO *info = container_of(port, SLMP_INFO, port); in carrier_raised() local
3229 spin_lock_irqsave(&info->lock,flags); in carrier_raised()
3230 get_signals(info); in carrier_raised()
3231 spin_unlock_irqrestore(&info->lock,flags); in carrier_raised()
3233 return (info->serial_signals & SerialSignal_DCD) ? 1 : 0; in carrier_raised()
3238 SLMP_INFO *info = container_of(port, SLMP_INFO, port); in dtr_rts() local
3241 spin_lock_irqsave(&info->lock,flags); in dtr_rts()
3243 info->serial_signals |= SerialSignal_RTS | SerialSignal_DTR; in dtr_rts()
3245 info->serial_signals &= ~(SerialSignal_RTS | SerialSignal_DTR); in dtr_rts()
3246 set_signals(info); in dtr_rts()
3247 spin_unlock_irqrestore(&info->lock,flags); in dtr_rts()
3253 SLMP_INFO *info) in block_til_ready() argument
3260 struct tty_port *port = &info->port; in block_til_ready()
3290 spin_lock_irqsave(&info->lock, flags); in block_til_ready()
3292 spin_unlock_irqrestore(&info->lock, flags); in block_til_ready()
3341 static int alloc_dma_bufs(SLMP_INFO *info) in alloc_dma_bufs() argument
3351 info->port_array[0]->last_mem_alloc = (SCA_MEM_SIZE/4) * info->port_num; in alloc_dma_bufs()
3358 BuffersPerFrame = (unsigned short)(info->max_frame_size/SCABUFSIZE); in alloc_dma_bufs()
3359 if ( info->max_frame_size % SCABUFSIZE ) in alloc_dma_bufs()
3373 info->tx_buf_count = BuffersPerFrame + 1; in alloc_dma_bufs()
3376 if (info->tx_buf_count > (BufferCount/2)) in alloc_dma_bufs()
3377 info->tx_buf_count = BufferCount/2; in alloc_dma_bufs()
3379 if (info->tx_buf_count > SCAMAXDESC) in alloc_dma_bufs()
3380 info->tx_buf_count = SCAMAXDESC; in alloc_dma_bufs()
3383 info->rx_buf_count = BufferCount - info->tx_buf_count; in alloc_dma_bufs()
3385 if (info->rx_buf_count > SCAMAXDESC) in alloc_dma_bufs()
3386 info->rx_buf_count = SCAMAXDESC; in alloc_dma_bufs()
3390 __FILE__,__LINE__, info->device_name, in alloc_dma_bufs()
3391 info->tx_buf_count,info->rx_buf_count); in alloc_dma_bufs()
3393 if ( alloc_buf_list( info ) < 0 || in alloc_dma_bufs()
3394 alloc_frame_bufs(info, in alloc_dma_bufs()
3395 info->rx_buf_list, in alloc_dma_bufs()
3396 info->rx_buf_list_ex, in alloc_dma_bufs()
3397 info->rx_buf_count) < 0 || in alloc_dma_bufs()
3398 alloc_frame_bufs(info, in alloc_dma_bufs()
3399 info->tx_buf_list, in alloc_dma_bufs()
3400 info->tx_buf_list_ex, in alloc_dma_bufs()
3401 info->tx_buf_count) < 0 || in alloc_dma_bufs()
3402 alloc_tmp_rx_buf(info) < 0 ) { in alloc_dma_bufs()
3404 __FILE__,__LINE__, info->device_name); in alloc_dma_bufs()
3408 rx_reset_buffers( info ); in alloc_dma_bufs()
3415 static int alloc_buf_list(SLMP_INFO *info) in alloc_buf_list() argument
3420 info->buffer_list = info->memory_base + info->port_array[0]->last_mem_alloc; in alloc_buf_list()
3421 info->buffer_list_phys = info->port_array[0]->last_mem_alloc; in alloc_buf_list()
3422 info->port_array[0]->last_mem_alloc += BUFFERLISTSIZE; in alloc_buf_list()
3424 memset(info->buffer_list, 0, BUFFERLISTSIZE); in alloc_buf_list()
3429 info->rx_buf_list = (SCADESC *)info->buffer_list; in alloc_buf_list()
3431 info->tx_buf_list = (SCADESC *)info->buffer_list; in alloc_buf_list()
3432 info->tx_buf_list += info->rx_buf_count; in alloc_buf_list()
3440 for ( i = 0; i < info->rx_buf_count; i++ ) { in alloc_buf_list()
3442 info->rx_buf_list_ex[i].phys_entry = in alloc_buf_list()
3443 info->buffer_list_phys + (i * SCABUFSIZE); in alloc_buf_list()
3447 info->rx_buf_list[i].next = info->buffer_list_phys; in alloc_buf_list()
3448 if ( i < info->rx_buf_count - 1 ) in alloc_buf_list()
3449 info->rx_buf_list[i].next += (i + 1) * sizeof(SCADESC); in alloc_buf_list()
3451 info->rx_buf_list[i].length = SCABUFSIZE; in alloc_buf_list()
3454 for ( i = 0; i < info->tx_buf_count; i++ ) { in alloc_buf_list()
3456 info->tx_buf_list_ex[i].phys_entry = info->buffer_list_phys + in alloc_buf_list()
3457 ((info->rx_buf_count + i) * sizeof(SCADESC)); in alloc_buf_list()
3462 info->tx_buf_list[i].next = info->buffer_list_phys + in alloc_buf_list()
3463 info->rx_buf_count * sizeof(SCADESC); in alloc_buf_list()
3465 if ( i < info->tx_buf_count - 1 ) in alloc_buf_list()
3466 info->tx_buf_list[i].next += (i + 1) * sizeof(SCADESC); in alloc_buf_list()
3474 static int alloc_frame_bufs(SLMP_INFO *info, SCADESC *buf_list,SCADESC_EX *buf_list_ex,int count) in alloc_frame_bufs() argument
3480 buf_list_ex[i].virt_addr = info->memory_base + info->port_array[0]->last_mem_alloc; in alloc_frame_bufs()
3481 phys_addr = info->port_array[0]->last_mem_alloc; in alloc_frame_bufs()
3482 info->port_array[0]->last_mem_alloc += SCABUFSIZE; in alloc_frame_bufs()
3491 static void free_dma_bufs(SLMP_INFO *info) in free_dma_bufs() argument
3493 info->buffer_list = NULL; in free_dma_bufs()
3494 info->rx_buf_list = NULL; in free_dma_bufs()
3495 info->tx_buf_list = NULL; in free_dma_bufs()
3501 static int alloc_tmp_rx_buf(SLMP_INFO *info) in alloc_tmp_rx_buf() argument
3503 info->tmp_rx_buf = kmalloc(info->max_frame_size, GFP_KERNEL); in alloc_tmp_rx_buf()
3504 if (info->tmp_rx_buf == NULL) in alloc_tmp_rx_buf()
3507 info->flag_buf = kzalloc(info->max_frame_size, GFP_KERNEL); in alloc_tmp_rx_buf()
3508 if (!info->flag_buf) { in alloc_tmp_rx_buf()
3509 kfree(info->tmp_rx_buf); in alloc_tmp_rx_buf()
3510 info->tmp_rx_buf = NULL; in alloc_tmp_rx_buf()
3516 static void free_tmp_rx_buf(SLMP_INFO *info) in free_tmp_rx_buf() argument
3518 kfree(info->tmp_rx_buf); in free_tmp_rx_buf()
3519 info->tmp_rx_buf = NULL; in free_tmp_rx_buf()
3520 kfree(info->flag_buf); in free_tmp_rx_buf()
3521 info->flag_buf = NULL; in free_tmp_rx_buf()
3524 static int claim_resources(SLMP_INFO *info) in claim_resources() argument
3526 if (request_mem_region(info->phys_memory_base,SCA_MEM_SIZE,"synclinkmp") == NULL) { in claim_resources()
3528 __FILE__,__LINE__,info->device_name, info->phys_memory_base); in claim_resources()
3529 info->init_error = DiagStatus_AddressConflict; in claim_resources()
3533 info->shared_mem_requested = true; in claim_resources()
3535 if (request_mem_region(info->phys_lcr_base + info->lcr_offset,128,"synclinkmp") == NULL) { in claim_resources()
3537 __FILE__,__LINE__,info->device_name, info->phys_lcr_base); in claim_resources()
3538 info->init_error = DiagStatus_AddressConflict; in claim_resources()
3542 info->lcr_mem_requested = true; in claim_resources()
3544 …if (request_mem_region(info->phys_sca_base + info->sca_offset,SCA_BASE_SIZE,"synclinkmp") == NULL)… in claim_resources()
3546 __FILE__,__LINE__,info->device_name, info->phys_sca_base); in claim_resources()
3547 info->init_error = DiagStatus_AddressConflict; in claim_resources()
3551 info->sca_base_requested = true; in claim_resources()
3553 …if (request_mem_region(info->phys_statctrl_base + info->statctrl_offset,SCA_REG_SIZE,"synclinkmp")… in claim_resources()
3555 __FILE__,__LINE__,info->device_name, info->phys_statctrl_base); in claim_resources()
3556 info->init_error = DiagStatus_AddressConflict; in claim_resources()
3560 info->sca_statctrl_requested = true; in claim_resources()
3562 info->memory_base = ioremap_nocache(info->phys_memory_base, in claim_resources()
3564 if (!info->memory_base) { in claim_resources()
3566 __FILE__,__LINE__,info->device_name, info->phys_memory_base ); in claim_resources()
3567 info->init_error = DiagStatus_CantAssignPciResources; in claim_resources()
3571 info->lcr_base = ioremap_nocache(info->phys_lcr_base, PAGE_SIZE); in claim_resources()
3572 if (!info->lcr_base) { in claim_resources()
3574 __FILE__,__LINE__,info->device_name, info->phys_lcr_base ); in claim_resources()
3575 info->init_error = DiagStatus_CantAssignPciResources; in claim_resources()
3578 info->lcr_base += info->lcr_offset; in claim_resources()
3580 info->sca_base = ioremap_nocache(info->phys_sca_base, PAGE_SIZE); in claim_resources()
3581 if (!info->sca_base) { in claim_resources()
3583 __FILE__,__LINE__,info->device_name, info->phys_sca_base ); in claim_resources()
3584 info->init_error = DiagStatus_CantAssignPciResources; in claim_resources()
3587 info->sca_base += info->sca_offset; in claim_resources()
3589 info->statctrl_base = ioremap_nocache(info->phys_statctrl_base, in claim_resources()
3591 if (!info->statctrl_base) { in claim_resources()
3593 __FILE__,__LINE__,info->device_name, info->phys_statctrl_base ); in claim_resources()
3594 info->init_error = DiagStatus_CantAssignPciResources; in claim_resources()
3597 info->statctrl_base += info->statctrl_offset; in claim_resources()
3599 if ( !memory_test(info) ) { in claim_resources()
3601 __FILE__,__LINE__,info->device_name, info->phys_memory_base ); in claim_resources()
3602 info->init_error = DiagStatus_MemoryError; in claim_resources()
3609 release_resources( info ); in claim_resources()
3613 static void release_resources(SLMP_INFO *info) in release_resources() argument
3617 __FILE__,__LINE__,info->device_name ); in release_resources()
3619 if ( info->irq_requested ) { in release_resources()
3620 free_irq(info->irq_level, info); in release_resources()
3621 info->irq_requested = false; in release_resources()
3624 if ( info->shared_mem_requested ) { in release_resources()
3625 release_mem_region(info->phys_memory_base,SCA_MEM_SIZE); in release_resources()
3626 info->shared_mem_requested = false; in release_resources()
3628 if ( info->lcr_mem_requested ) { in release_resources()
3629 release_mem_region(info->phys_lcr_base + info->lcr_offset,128); in release_resources()
3630 info->lcr_mem_requested = false; in release_resources()
3632 if ( info->sca_base_requested ) { in release_resources()
3633 release_mem_region(info->phys_sca_base + info->sca_offset,SCA_BASE_SIZE); in release_resources()
3634 info->sca_base_requested = false; in release_resources()
3636 if ( info->sca_statctrl_requested ) { in release_resources()
3637 release_mem_region(info->phys_statctrl_base + info->statctrl_offset,SCA_REG_SIZE); in release_resources()
3638 info->sca_statctrl_requested = false; in release_resources()
3641 if (info->memory_base){ in release_resources()
3642 iounmap(info->memory_base); in release_resources()
3643 info->memory_base = NULL; in release_resources()
3646 if (info->sca_base) { in release_resources()
3647 iounmap(info->sca_base - info->sca_offset); in release_resources()
3648 info->sca_base=NULL; in release_resources()
3651 if (info->statctrl_base) { in release_resources()
3652 iounmap(info->statctrl_base - info->statctrl_offset); in release_resources()
3653 info->statctrl_base=NULL; in release_resources()
3656 if (info->lcr_base){ in release_resources()
3657 iounmap(info->lcr_base - info->lcr_offset); in release_resources()
3658 info->lcr_base = NULL; in release_resources()
3663 __FILE__,__LINE__,info->device_name ); in release_resources()
3669 static int add_device(SLMP_INFO *info) in add_device() argument
3671 info->next_device = NULL; in add_device()
3672 info->line = synclinkmp_device_count; in add_device()
3673 sprintf(info->device_name,"ttySLM%dp%d",info->adapter_num,info->port_num); in add_device()
3675 if (info->line < MAX_DEVICES) { in add_device()
3676 if (maxframe[info->line]) in add_device()
3677 info->max_frame_size = maxframe[info->line]; in add_device()
3683 synclinkmp_device_list = info; in add_device()
3688 current_dev->next_device = info; in add_device()
3691 if ( info->max_frame_size < 4096 ) in add_device()
3692 info->max_frame_size = 4096; in add_device()
3693 else if ( info->max_frame_size > 65535 ) in add_device()
3694 info->max_frame_size = 65535; in add_device()
3698 info->device_name, in add_device()
3699 info->phys_sca_base, in add_device()
3700 info->phys_memory_base, in add_device()
3701 info->phys_statctrl_base, in add_device()
3702 info->phys_lcr_base, in add_device()
3703 info->irq_level, in add_device()
3704 info->max_frame_size ); in add_device()
3707 return hdlcdev_init(info); in add_device()
3724 SLMP_INFO *info; in alloc_dev() local
3726 info = kzalloc(sizeof(SLMP_INFO), in alloc_dev()
3729 if (!info) { in alloc_dev()
3733 tty_port_init(&info->port); in alloc_dev()
3734 info->port.ops = &port_ops; in alloc_dev()
3735 info->magic = MGSL_MAGIC; in alloc_dev()
3736 INIT_WORK(&info->task, bh_handler); in alloc_dev()
3737 info->max_frame_size = 4096; in alloc_dev()
3738 info->port.close_delay = 5*HZ/10; in alloc_dev()
3739 info->port.closing_wait = 30*HZ; in alloc_dev()
3740 init_waitqueue_head(&info->status_event_wait_q); in alloc_dev()
3741 init_waitqueue_head(&info->event_wait_q); in alloc_dev()
3742 spin_lock_init(&info->netlock); in alloc_dev()
3743 memcpy(&info->params,&default_params,sizeof(MGSL_PARAMS)); in alloc_dev()
3744 info->idle_mode = HDLC_TXIDLE_FLAGS; in alloc_dev()
3745 info->adapter_num = adapter_num; in alloc_dev()
3746 info->port_num = port_num; in alloc_dev()
3748 /* Copy configuration info to device instance data */ in alloc_dev()
3749 info->irq_level = pdev->irq; in alloc_dev()
3750 info->phys_lcr_base = pci_resource_start(pdev,0); in alloc_dev()
3751 info->phys_sca_base = pci_resource_start(pdev,2); in alloc_dev()
3752 info->phys_memory_base = pci_resource_start(pdev,3); in alloc_dev()
3753 info->phys_statctrl_base = pci_resource_start(pdev,4); in alloc_dev()
3759 info->lcr_offset = info->phys_lcr_base & (PAGE_SIZE-1); in alloc_dev()
3760 info->phys_lcr_base &= ~(PAGE_SIZE-1); in alloc_dev()
3762 info->sca_offset = info->phys_sca_base & (PAGE_SIZE-1); in alloc_dev()
3763 info->phys_sca_base &= ~(PAGE_SIZE-1); in alloc_dev()
3765 info->statctrl_offset = info->phys_statctrl_base & (PAGE_SIZE-1); in alloc_dev()
3766 info->phys_statctrl_base &= ~(PAGE_SIZE-1); in alloc_dev()
3768 info->bus_type = MGSL_BUS_TYPE_PCI; in alloc_dev()
3769 info->irq_flags = IRQF_SHARED; in alloc_dev()
3771 timer_setup(&info->tx_timer, tx_timeout, 0); in alloc_dev()
3772 timer_setup(&info->status_timer, status_timeout, 0); in alloc_dev()
3783 info->misc_ctrl_value = 0x087e4546; in alloc_dev()
3791 info->init_error = -1; in alloc_dev()
3794 return info; in alloc_dev()
3895 SLMP_INFO *info; in synclinkmp_cleanup() local
3909 info = synclinkmp_device_list; in synclinkmp_cleanup()
3910 while(info) { in synclinkmp_cleanup()
3911 reset_port(info); in synclinkmp_cleanup()
3912 info = info->next_device; in synclinkmp_cleanup()
3916 info = synclinkmp_device_list; in synclinkmp_cleanup()
3917 while(info) { in synclinkmp_cleanup()
3919 hdlcdev_exit(info); in synclinkmp_cleanup()
3921 free_dma_bufs(info); in synclinkmp_cleanup()
3922 free_tmp_rx_buf(info); in synclinkmp_cleanup()
3923 if ( info->port_num == 0 ) { in synclinkmp_cleanup()
3924 if (info->sca_base) in synclinkmp_cleanup()
3925 write_reg(info, LPR, 1); /* set low power mode */ in synclinkmp_cleanup()
3926 release_resources(info); in synclinkmp_cleanup()
3928 tmp = info; in synclinkmp_cleanup()
3929 info = info->next_device; in synclinkmp_cleanup()
4008 static void enable_loopback(SLMP_INFO *info, int enable) in enable_loopback() argument
4014 write_reg(info, MD2, (unsigned char)(read_reg(info, MD2) | (BIT1 + BIT0))); in enable_loopback()
4017 info->port_array[0]->ctrlreg_value |= (BIT0 << (info->port_num * 2)); in enable_loopback()
4018 write_control_reg(info); in enable_loopback()
4025 write_reg(info, RXS, 0x40); in enable_loopback()
4026 write_reg(info, TXS, 0x40); in enable_loopback()
4032 write_reg(info, MD2, (unsigned char)(read_reg(info, MD2) & ~(BIT1 + BIT0))); in enable_loopback()
4039 write_reg(info, RXS, 0x00); in enable_loopback()
4040 write_reg(info, TXS, 0x00); in enable_loopback()
4044 if (info->params.clock_speed) in enable_loopback()
4045 set_rate(info, info->params.clock_speed); in enable_loopback()
4047 set_rate(info, 3686400); in enable_loopback()
4055 static void set_rate( SLMP_INFO *info, u32 data_rate ) in set_rate() argument
4086 write_reg(info, TXS, in set_rate()
4087 (unsigned char)((read_reg(info, TXS) & 0xf0) | BRValue)); in set_rate()
4088 write_reg(info, RXS, in set_rate()
4089 (unsigned char)((read_reg(info, RXS) & 0xf0) | BRValue)); in set_rate()
4090 write_reg(info, TMC, (unsigned char)TMCValue); in set_rate()
4093 write_reg(info, TXS,0); in set_rate()
4094 write_reg(info, RXS,0); in set_rate()
4095 write_reg(info, TMC, 0); in set_rate()
4101 static void rx_stop(SLMP_INFO *info) in rx_stop() argument
4105 __FILE__,__LINE__, info->device_name ); in rx_stop()
4107 write_reg(info, CMD, RXRESET); in rx_stop()
4109 info->ie0_value &= ~RXRDYE; in rx_stop()
4110 write_reg(info, IE0, info->ie0_value); /* disable Rx data interrupts */ in rx_stop()
4112 write_reg(info, RXDMA + DSR, 0); /* disable Rx DMA */ in rx_stop()
4113 write_reg(info, RXDMA + DCMD, SWABORT); /* reset/init Rx DMA */ in rx_stop()
4114 write_reg(info, RXDMA + DIR, 0); /* disable Rx DMA interrupts */ in rx_stop()
4116 info->rx_enabled = false; in rx_stop()
4117 info->rx_overflow = false; in rx_stop()
4122 static void rx_start(SLMP_INFO *info) in rx_start() argument
4128 __FILE__,__LINE__, info->device_name ); in rx_start()
4130 write_reg(info, CMD, RXRESET); in rx_start()
4132 if ( info->params.mode == MGSL_MODE_HDLC ) { in rx_start()
4134 info->ie0_value &= ~RXRDYE; in rx_start()
4135 write_reg(info, IE0, info->ie0_value); in rx_start()
4138 write_reg(info, RXDMA + DSR, 0); /* disable Rx DMA */ in rx_start()
4139 write_reg(info, RXDMA + DCMD, SWABORT); /* reset/init Rx DMA */ in rx_start()
4141 for (i = 0; i < info->rx_buf_count; i++) { in rx_start()
4142 info->rx_buf_list[i].status = 0xff; in rx_start()
4147 read_status_reg(info); in rx_start()
4149 info->current_rx_buf = 0; in rx_start()
4152 write_reg16(info, RXDMA + CDA, in rx_start()
4153 info->rx_buf_list_ex[0].phys_entry); in rx_start()
4156 write_reg16(info, RXDMA + EDA, in rx_start()
4157 info->rx_buf_list_ex[info->rx_buf_count - 1].phys_entry); in rx_start()
4160 write_reg16(info, RXDMA + BFL, SCABUFSIZE); in rx_start()
4162 write_reg(info, RXDMA + DIR, 0x60); /* enable Rx DMA interrupts (EOM/BOF) */ in rx_start()
4163 write_reg(info, RXDMA + DSR, 0xf2); /* clear Rx DMA IRQs, enable Rx DMA */ in rx_start()
4166 info->ie0_value |= RXRDYE; in rx_start()
4167 write_reg(info, IE0, info->ie0_value); in rx_start()
4170 write_reg(info, CMD, RXENABLE); in rx_start()
4172 info->rx_overflow = false; in rx_start()
4173 info->rx_enabled = true; in rx_start()
4179 static void tx_start(SLMP_INFO *info) in tx_start() argument
4183 __FILE__,__LINE__, info->device_name,info->tx_count ); in tx_start()
4185 if (!info->tx_enabled ) { in tx_start()
4186 write_reg(info, CMD, TXRESET); in tx_start()
4187 write_reg(info, CMD, TXENABLE); in tx_start()
4188 info->tx_enabled = true; in tx_start()
4191 if ( info->tx_count ) { in tx_start()
4197 info->drop_rts_on_tx_done = false; in tx_start()
4199 if (info->params.mode != MGSL_MODE_ASYNC) { in tx_start()
4201 if ( info->params.flags & HDLC_FLAG_AUTO_RTS ) { in tx_start()
4202 get_signals( info ); in tx_start()
4203 if ( !(info->serial_signals & SerialSignal_RTS) ) { in tx_start()
4204 info->serial_signals |= SerialSignal_RTS; in tx_start()
4205 set_signals( info ); in tx_start()
4206 info->drop_rts_on_tx_done = true; in tx_start()
4210 write_reg16(info, TRC0, in tx_start()
4213 write_reg(info, TXDMA + DSR, 0); /* disable DMA channel */ in tx_start()
4214 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in tx_start()
4217 write_reg16(info, TXDMA + CDA, in tx_start()
4218 info->tx_buf_list_ex[0].phys_entry); in tx_start()
4221 write_reg16(info, TXDMA + EDA, in tx_start()
4222 info->tx_buf_list_ex[info->last_tx_buf].phys_entry); in tx_start()
4225 info->ie1_value &= ~IDLE; in tx_start()
4226 info->ie1_value |= UDRN; in tx_start()
4227 write_reg(info, IE1, info->ie1_value); in tx_start()
4228 write_reg(info, SR1, (unsigned char)(IDLE + UDRN)); in tx_start()
4230 write_reg(info, TXDMA + DIR, 0x40); /* enable Tx DMA interrupts (EOM) */ in tx_start()
4231 write_reg(info, TXDMA + DSR, 0xf2); /* clear Tx DMA IRQs, enable Tx DMA */ in tx_start()
4233 mod_timer(&info->tx_timer, jiffies + in tx_start()
4237 tx_load_fifo(info); in tx_start()
4239 info->ie0_value |= TXRDYE; in tx_start()
4240 write_reg(info, IE0, info->ie0_value); in tx_start()
4243 info->tx_active = true; in tx_start()
4249 static void tx_stop( SLMP_INFO *info ) in tx_stop() argument
4253 __FILE__,__LINE__, info->device_name ); in tx_stop()
4255 del_timer(&info->tx_timer); in tx_stop()
4257 write_reg(info, TXDMA + DSR, 0); /* disable DMA channel */ in tx_stop()
4258 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in tx_stop()
4260 write_reg(info, CMD, TXRESET); in tx_stop()
4262 info->ie1_value &= ~(UDRN + IDLE); in tx_stop()
4263 write_reg(info, IE1, info->ie1_value); /* disable tx status interrupts */ in tx_stop()
4264 write_reg(info, SR1, (unsigned char)(IDLE + UDRN)); /* clear pending */ in tx_stop()
4266 info->ie0_value &= ~TXRDYE; in tx_stop()
4267 write_reg(info, IE0, info->ie0_value); /* disable tx data interrupts */ in tx_stop()
4269 info->tx_enabled = false; in tx_stop()
4270 info->tx_active = false; in tx_stop()
4276 static void tx_load_fifo(SLMP_INFO *info) in tx_load_fifo() argument
4282 if ( !info->tx_count && !info->x_char ) in tx_load_fifo()
4287 while( info->tx_count && (read_reg(info,SR0) & BIT1) ) { in tx_load_fifo()
4292 if ( (info->tx_count > 1) && !info->x_char ) { in tx_load_fifo()
4294 TwoBytes[0] = info->tx_buf[info->tx_get++]; in tx_load_fifo()
4295 if (info->tx_get >= info->max_frame_size) in tx_load_fifo()
4296 info->tx_get -= info->max_frame_size; in tx_load_fifo()
4297 TwoBytes[1] = info->tx_buf[info->tx_get++]; in tx_load_fifo()
4298 if (info->tx_get >= info->max_frame_size) in tx_load_fifo()
4299 info->tx_get -= info->max_frame_size; in tx_load_fifo()
4301 write_reg16(info, TRB, *((u16 *)TwoBytes)); in tx_load_fifo()
4303 info->tx_count -= 2; in tx_load_fifo()
4304 info->icount.tx += 2; in tx_load_fifo()
4308 if (info->x_char) { in tx_load_fifo()
4310 write_reg(info, TRB, info->x_char); in tx_load_fifo()
4311 info->x_char = 0; in tx_load_fifo()
4313 write_reg(info, TRB, info->tx_buf[info->tx_get++]); in tx_load_fifo()
4314 if (info->tx_get >= info->max_frame_size) in tx_load_fifo()
4315 info->tx_get -= info->max_frame_size; in tx_load_fifo()
4316 info->tx_count--; in tx_load_fifo()
4318 info->icount.tx++; in tx_load_fifo()
4325 static void reset_port(SLMP_INFO *info) in reset_port() argument
4327 if (info->sca_base) { in reset_port()
4329 tx_stop(info); in reset_port()
4330 rx_stop(info); in reset_port()
4332 info->serial_signals &= ~(SerialSignal_RTS | SerialSignal_DTR); in reset_port()
4333 set_signals(info); in reset_port()
4336 info->ie0_value = 0; in reset_port()
4337 info->ie1_value = 0; in reset_port()
4338 info->ie2_value = 0; in reset_port()
4339 write_reg(info, IE0, info->ie0_value); in reset_port()
4340 write_reg(info, IE1, info->ie1_value); in reset_port()
4341 write_reg(info, IE2, info->ie2_value); in reset_port()
4343 write_reg(info, CMD, CHRESET); in reset_port()
4349 static void reset_adapter(SLMP_INFO *info) in reset_adapter() argument
4354 if (info->port_array[i]) in reset_adapter()
4355 reset_port(info->port_array[i]); in reset_adapter()
4361 static void async_mode(SLMP_INFO *info) in async_mode() argument
4366 tx_stop(info); in async_mode()
4367 rx_stop(info); in async_mode()
4380 if (info->params.stop_bits != 1) in async_mode()
4382 write_reg(info, MD0, RegValue); in async_mode()
4394 switch (info->params.data_bits) { in async_mode()
4399 if (info->params.parity != ASYNC_PARITY_NONE) { in async_mode()
4401 if (info->params.parity == ASYNC_PARITY_ODD) in async_mode()
4404 write_reg(info, MD1, RegValue); in async_mode()
4414 if (info->params.loopback) in async_mode()
4416 write_reg(info, MD2, RegValue); in async_mode()
4425 write_reg(info, RXS, RegValue); in async_mode()
4434 write_reg(info, TXS, RegValue); in async_mode()
4440 info->port_array[0]->ctrlreg_value |= (BIT0 << (info->port_num * 2)); in async_mode()
4441 write_control_reg(info); in async_mode()
4443 tx_set_idle(info); in async_mode()
4450 write_reg(info, RRC, 0x00); in async_mode()
4457 write_reg(info, TRC0, 0x10); in async_mode()
4464 write_reg(info, TRC1, 0x1e); in async_mode()
4479 if (!(info->serial_signals & SerialSignal_RTS)) in async_mode()
4481 write_reg(info, CTL, RegValue); in async_mode()
4484 info->ie0_value |= TXINTE + RXINTE; in async_mode()
4485 write_reg(info, IE0, info->ie0_value); in async_mode()
4488 info->ie1_value = BRKD; in async_mode()
4489 write_reg(info, IE1, info->ie1_value); in async_mode()
4492 info->ie2_value = OVRN; in async_mode()
4493 write_reg(info, IE2, info->ie2_value); in async_mode()
4495 set_rate( info, info->params.data_rate * 16 ); in async_mode()
4500 static void hdlc_mode(SLMP_INFO *info) in hdlc_mode() argument
4509 info->params.flags &= ~(HDLC_FLAG_TXC_DPLL + HDLC_FLAG_RXC_DPLL); in hdlc_mode()
4512 write_reg(info, TXDMA + DIR, 0); in hdlc_mode()
4513 write_reg(info, RXDMA + DIR, 0); in hdlc_mode()
4527 if (info->params.flags & HDLC_FLAG_AUTO_CTS) in hdlc_mode()
4529 if (info->params.flags & HDLC_FLAG_AUTO_DCD) in hdlc_mode()
4531 if (info->params.crc_type == HDLC_CRC_16_CCITT) in hdlc_mode()
4533 write_reg(info, MD0, RegValue); in hdlc_mode()
4545 write_reg(info, MD1, RegValue); in hdlc_mode()
4558 switch(info->params.encoding) { in hdlc_mode()
4569 if ( info->params.flags & HDLC_FLAG_DPLL_DIV16 ) { in hdlc_mode()
4572 } else if ( info->params.flags & HDLC_FLAG_DPLL_DIV8 ) { in hdlc_mode()
4578 write_reg(info, MD2, RegValue); in hdlc_mode()
4588 if (info->params.flags & HDLC_FLAG_RXC_BRG) in hdlc_mode()
4590 if (info->params.flags & HDLC_FLAG_RXC_DPLL) in hdlc_mode()
4592 write_reg(info, RXS, RegValue); in hdlc_mode()
4601 if (info->params.flags & HDLC_FLAG_TXC_BRG) in hdlc_mode()
4603 if (info->params.flags & HDLC_FLAG_TXC_DPLL) in hdlc_mode()
4605 write_reg(info, TXS, RegValue); in hdlc_mode()
4607 if (info->params.flags & HDLC_FLAG_RXC_DPLL) in hdlc_mode()
4608 set_rate(info, info->params.clock_speed * DpllDivisor); in hdlc_mode()
4610 set_rate(info, info->params.clock_speed); in hdlc_mode()
4616 if (info->params.flags & HDLC_FLAG_TXC_BRG) in hdlc_mode()
4617 info->port_array[0]->ctrlreg_value |= (BIT0 << (info->port_num * 2)); in hdlc_mode()
4619 info->port_array[0]->ctrlreg_value &= ~(BIT0 << (info->port_num * 2)); in hdlc_mode()
4620 write_control_reg(info); in hdlc_mode()
4627 write_reg(info, RRC, rx_active_fifo_level); in hdlc_mode()
4634 write_reg(info, TRC0, tx_active_fifo_level); in hdlc_mode()
4641 write_reg(info, TRC1, (unsigned char)(tx_negate_fifo_level - 1)); in hdlc_mode()
4654 write_reg(info, TXDMA + DMR, 0x14); in hdlc_mode()
4655 write_reg(info, RXDMA + DMR, 0x14); in hdlc_mode()
4658 write_reg(info, RXDMA + CPB, in hdlc_mode()
4659 (unsigned char)(info->buffer_list_phys >> 16)); in hdlc_mode()
4662 write_reg(info, TXDMA + CPB, in hdlc_mode()
4663 (unsigned char)(info->buffer_list_phys >> 16)); in hdlc_mode()
4668 info->ie0_value |= TXINTE + RXINTE; in hdlc_mode()
4669 write_reg(info, IE0, info->ie0_value); in hdlc_mode()
4684 if (!(info->serial_signals & SerialSignal_RTS)) in hdlc_mode()
4686 write_reg(info, CTL, RegValue); in hdlc_mode()
4690 tx_set_idle(info); in hdlc_mode()
4691 tx_stop(info); in hdlc_mode()
4692 rx_stop(info); in hdlc_mode()
4694 set_rate(info, info->params.clock_speed); in hdlc_mode()
4696 if (info->params.loopback) in hdlc_mode()
4697 enable_loopback(info,1); in hdlc_mode()
4702 static void tx_set_idle(SLMP_INFO *info) in tx_set_idle() argument
4707 switch(info->idle_mode) { in tx_set_idle()
4717 write_reg(info, IDL, RegValue); in tx_set_idle()
4722 static void get_signals(SLMP_INFO *info) in get_signals() argument
4724 u16 status = read_reg(info, SR3); in get_signals()
4725 u16 gpstatus = read_status_reg(info); in get_signals()
4729 info->serial_signals &= SerialSignal_RTS | SerialSignal_DTR; in get_signals()
4734 info->serial_signals |= SerialSignal_CTS; in get_signals()
4737 info->serial_signals |= SerialSignal_DCD; in get_signals()
4739 testbit = BIT1 << (info->port_num * 2); // Port 0..3 RI is GPDATA<1,3,5,7> in get_signals()
4741 info->serial_signals |= SerialSignal_RI; in get_signals()
4743 testbit = BIT0 << (info->port_num * 2); // Port 0..3 DSR is GPDATA<0,2,4,6> in get_signals()
4745 info->serial_signals |= SerialSignal_DSR; in get_signals()
4751 static void set_signals(SLMP_INFO *info) in set_signals() argument
4756 RegValue = read_reg(info, CTL); in set_signals()
4757 if (info->serial_signals & SerialSignal_RTS) in set_signals()
4761 write_reg(info, CTL, RegValue); in set_signals()
4764 EnableBit = BIT1 << (info->port_num*2); in set_signals()
4765 if (info->serial_signals & SerialSignal_DTR) in set_signals()
4766 info->port_array[0]->ctrlreg_value &= ~EnableBit; in set_signals()
4768 info->port_array[0]->ctrlreg_value |= EnableBit; in set_signals()
4769 write_control_reg(info); in set_signals()
4780 static void rx_reset_buffers(SLMP_INFO *info) in rx_reset_buffers() argument
4782 rx_free_frame_buffers(info, 0, info->rx_buf_count - 1); in rx_reset_buffers()
4787 * info pointer to device instance data
4791 static void rx_free_frame_buffers(SLMP_INFO *info, unsigned int first, unsigned int last) in rx_free_frame_buffers() argument
4797 info->rx_buf_list[first].status = 0xff; in rx_free_frame_buffers()
4802 write_reg16(info, RXDMA + EDA, info->rx_buf_list_ex[first].phys_entry); in rx_free_frame_buffers()
4806 if (first == info->rx_buf_count) in rx_free_frame_buffers()
4811 info->current_rx_buf = first; in rx_free_frame_buffers()
4819 static bool rx_get_frame(SLMP_INFO *info) in rx_get_frame() argument
4826 struct tty_struct *tty = info->port.tty; in rx_get_frame()
4842 StartIndex = EndIndex = info->current_rx_buf; in rx_get_frame()
4845 desc = &info->rx_buf_list[EndIndex]; in rx_get_frame()
4846 desc_ex = &info->rx_buf_list_ex[EndIndex]; in rx_get_frame()
4851 if (framesize == 0 && info->params.addr_filter != 0xff) in rx_get_frame()
4861 if (EndIndex == info->rx_buf_count) in rx_get_frame()
4864 if (EndIndex == info->current_rx_buf) { in rx_get_frame()
4867 if ( info->rx_enabled ){ in rx_get_frame()
4868 spin_lock_irqsave(&info->lock,flags); in rx_get_frame()
4869 rx_start(info); in rx_get_frame()
4870 spin_unlock_irqrestore(&info->lock,flags); in rx_get_frame()
4893 if (info->params.crc_type == HDLC_CRC_NONE) in rx_get_frame()
4897 (addr_field != 0xff && addr_field != info->params.addr_filter)) { in rx_get_frame()
4901 rx_free_frame_buffers(info, StartIndex, EndIndex); in rx_get_frame()
4913 info->icount.rxshort++; in rx_get_frame()
4915 info->icount.rxabort++; in rx_get_frame()
4917 info->icount.rxover++; in rx_get_frame()
4919 info->icount.rxcrc++; in rx_get_frame()
4924 info->netdev->stats.rx_errors++; in rx_get_frame()
4925 info->netdev->stats.rx_frame_errors++; in rx_get_frame()
4932 __FILE__,__LINE__,info->device_name,status,framesize); in rx_get_frame()
4935 trace_block(info,info->rx_buf_list_ex[StartIndex].virt_addr, in rx_get_frame()
4939 if (framesize > info->max_frame_size) in rx_get_frame()
4940 info->icount.rxlong++; in rx_get_frame()
4945 unsigned char *ptmp = info->tmp_rx_buf; in rx_get_frame()
4946 info->tmp_rx_buf_count = framesize; in rx_get_frame()
4948 info->icount.rxok++; in rx_get_frame()
4953 info->rx_buf_list_ex[index].virt_addr, in rx_get_frame()
4958 if ( ++index == info->rx_buf_count ) in rx_get_frame()
4963 if (info->netcount) in rx_get_frame()
4964 hdlcdev_rx(info,info->tmp_rx_buf,framesize); in rx_get_frame()
4967 ldisc_receive_buf(tty,info->tmp_rx_buf, in rx_get_frame()
4968 info->flag_buf, framesize); in rx_get_frame()
4972 rx_free_frame_buffers( info, StartIndex, EndIndex ); in rx_get_frame()
4977 if ( info->rx_enabled && info->rx_overflow ) { in rx_get_frame()
4981 if (info->rx_buf_list[EndIndex].status == 0xff) { in rx_get_frame()
4982 spin_lock_irqsave(&info->lock,flags); in rx_get_frame()
4983 rx_start(info); in rx_get_frame()
4984 spin_unlock_irqrestore(&info->lock,flags); in rx_get_frame()
4993 static void tx_load_dma_buffer(SLMP_INFO *info, const char *buf, unsigned int count) in tx_load_dma_buffer() argument
5001 trace_block(info, buf, min_t(unsigned int, count, SCABUFSIZE), 1); in tx_load_dma_buffer()
5010 desc = &info->tx_buf_list[i]; in tx_load_dma_buffer()
5011 desc_ex = &info->tx_buf_list_ex[i]; in tx_load_dma_buffer()
5013 load_pci_memory(info, desc_ex->virt_addr,buf,copy_count); in tx_load_dma_buffer()
5025 if (i >= info->tx_buf_count) in tx_load_dma_buffer()
5029 info->tx_buf_list[i].status = 0x81; /* set EOM and EOT status */ in tx_load_dma_buffer()
5030 info->last_tx_buf = ++i; in tx_load_dma_buffer()
5033 static bool register_test(SLMP_INFO *info) in register_test() argument
5041 spin_lock_irqsave(&info->lock,flags); in register_test()
5042 reset_port(info); in register_test()
5045 info->init_error = DiagStatus_AddressFailure; in register_test()
5051 write_reg(info, TMC, testval[i]); in register_test()
5052 write_reg(info, IDL, testval[(i+1)%count]); in register_test()
5053 write_reg(info, SA0, testval[(i+2)%count]); in register_test()
5054 write_reg(info, SA1, testval[(i+3)%count]); in register_test()
5056 if ( (read_reg(info, TMC) != testval[i]) || in register_test()
5057 (read_reg(info, IDL) != testval[(i+1)%count]) || in register_test()
5058 (read_reg(info, SA0) != testval[(i+2)%count]) || in register_test()
5059 (read_reg(info, SA1) != testval[(i+3)%count]) ) in register_test()
5066 reset_port(info); in register_test()
5067 spin_unlock_irqrestore(&info->lock,flags); in register_test()
5072 static bool irq_test(SLMP_INFO *info) in irq_test() argument
5077 unsigned char timer = (info->port_num & 1) ? TIMER2 : TIMER0; in irq_test()
5079 spin_lock_irqsave(&info->lock,flags); in irq_test()
5080 reset_port(info); in irq_test()
5083 info->init_error = DiagStatus_IrqFailure; in irq_test()
5084 info->irq_occurred = false; in irq_test()
5089 write_reg(info, IER2, (unsigned char)((info->port_num & 1) ? BIT6 : BIT4)); in irq_test()
5091 write_reg(info, (unsigned char)(timer + TEPR), 0); /* timer expand prescale */ in irq_test()
5092 write_reg16(info, (unsigned char)(timer + TCONR), 1); /* timer constant */ in irq_test()
5105 write_reg(info, (unsigned char)(timer + TMCS), 0x50); in irq_test()
5107 spin_unlock_irqrestore(&info->lock,flags); in irq_test()
5110 while( timeout-- && !info->irq_occurred ) { in irq_test()
5114 spin_lock_irqsave(&info->lock,flags); in irq_test()
5115 reset_port(info); in irq_test()
5116 spin_unlock_irqrestore(&info->lock,flags); in irq_test()
5118 return info->irq_occurred; in irq_test()
5123 static bool sca_init(SLMP_INFO *info) in sca_init() argument
5126 write_reg(info, PABR0, 0); /* wait controller addr boundary 0 */ in sca_init()
5127 write_reg(info, PABR1, 0); /* wait controller addr boundary 1 */ in sca_init()
5128 write_reg(info, WCRL, 0); /* wait controller low range */ in sca_init()
5129 write_reg(info, WCRM, 0); /* wait controller mid range */ in sca_init()
5130 write_reg(info, WCRH, 0); /* wait controller high range */ in sca_init()
5141 write_reg(info, DPCR, dma_priority); in sca_init()
5144 write_reg(info, DMER, 0x80); in sca_init()
5147 write_reg(info, IER0, 0xff); /* TxRDY,RxRDY,TxINT,RxINT (ports 0-1) */ in sca_init()
5148 write_reg(info, IER1, 0xff); /* DMIB,DMIA (channels 0-3) */ in sca_init()
5149 write_reg(info, IER2, 0xf0); /* TIRQ (timers 0-3) */ in sca_init()
5157 write_reg(info, ITCR, 0); in sca_init()
5164 static bool init_adapter(SLMP_INFO *info) in init_adapter() argument
5169 volatile u32 *MiscCtrl = (u32 *)(info->lcr_base + 0x50); in init_adapter()
5172 info->misc_ctrl_value |= BIT30; in init_adapter()
5173 *MiscCtrl = info->misc_ctrl_value; in init_adapter()
5183 info->misc_ctrl_value &= ~BIT30; in init_adapter()
5184 *MiscCtrl = info->misc_ctrl_value; in init_adapter()
5187 info->ctrlreg_value = 0xaa; in init_adapter()
5188 write_control_reg(info); in init_adapter()
5191 volatile u32 *LCR1BRDR = (u32 *)(info->lcr_base + 0x2c); in init_adapter()
5214 sca_init(info->port_array[0]); in init_adapter()
5215 sca_init(info->port_array[2]); in init_adapter()
5223 static bool loopback_test(SLMP_INFO *info) in loopback_test() argument
5233 struct tty_struct *oldtty = info->port.tty; in loopback_test()
5234 u32 speed = info->params.clock_speed; in loopback_test()
5236 info->params.clock_speed = 3686400; in loopback_test()
5237 info->port.tty = NULL; in loopback_test()
5240 info->init_error = DiagStatus_DmaFailure; in loopback_test()
5246 memset(info->tmp_rx_buf,0,TESTFRAMESIZE); in loopback_test()
5249 spin_lock_irqsave(&info->lock,flags); in loopback_test()
5250 hdlc_mode(info); in loopback_test()
5251 enable_loopback(info,1); in loopback_test()
5252 rx_start(info); in loopback_test()
5253 info->tx_count = count; in loopback_test()
5254 tx_load_dma_buffer(info,buf,count); in loopback_test()
5255 tx_start(info); in loopback_test()
5256 spin_unlock_irqrestore(&info->lock,flags); in loopback_test()
5263 if (rx_get_frame(info)) { in loopback_test()
5271 ( info->tmp_rx_buf_count != count || in loopback_test()
5272 memcmp(buf, info->tmp_rx_buf,count))) { in loopback_test()
5276 spin_lock_irqsave(&info->lock,flags); in loopback_test()
5277 reset_adapter(info); in loopback_test()
5278 spin_unlock_irqrestore(&info->lock,flags); in loopback_test()
5280 info->params.clock_speed = speed; in loopback_test()
5281 info->port.tty = oldtty; in loopback_test()
5288 static int adapter_test( SLMP_INFO *info ) in adapter_test() argument
5293 __FILE__,__LINE__,info->device_name ); in adapter_test()
5295 spin_lock_irqsave(&info->lock,flags); in adapter_test()
5296 init_adapter(info); in adapter_test()
5297 spin_unlock_irqrestore(&info->lock,flags); in adapter_test()
5299 info->port_array[0]->port_count = 0; in adapter_test()
5301 if ( register_test(info->port_array[0]) && in adapter_test()
5302 register_test(info->port_array[1])) { in adapter_test()
5304 info->port_array[0]->port_count = 2; in adapter_test()
5306 if ( register_test(info->port_array[2]) && in adapter_test()
5307 register_test(info->port_array[3]) ) in adapter_test()
5308 info->port_array[0]->port_count += 2; in adapter_test()
5312 __FILE__,__LINE__,info->device_name, (unsigned long)(info->phys_sca_base)); in adapter_test()
5316 if ( !irq_test(info->port_array[0]) || in adapter_test()
5317 !irq_test(info->port_array[1]) || in adapter_test()
5318 (info->port_count == 4 && !irq_test(info->port_array[2])) || in adapter_test()
5319 (info->port_count == 4 && !irq_test(info->port_array[3]))) { in adapter_test()
5321 __FILE__,__LINE__,info->device_name, (unsigned short)(info->irq_level) ); in adapter_test()
5325 if (!loopback_test(info->port_array[0]) || in adapter_test()
5326 !loopback_test(info->port_array[1]) || in adapter_test()
5327 (info->port_count == 4 && !loopback_test(info->port_array[2])) || in adapter_test()
5328 (info->port_count == 4 && !loopback_test(info->port_array[3]))) { in adapter_test()
5330 __FILE__,__LINE__,info->device_name); in adapter_test()
5336 __FILE__,__LINE__,info->device_name ); in adapter_test()
5338 info->port_array[0]->init_error = 0; in adapter_test()
5339 info->port_array[1]->init_error = 0; in adapter_test()
5340 if ( info->port_count > 2 ) { in adapter_test()
5341 info->port_array[2]->init_error = 0; in adapter_test()
5342 info->port_array[3]->init_error = 0; in adapter_test()
5350 static bool memory_test(SLMP_INFO *info) in memory_test() argument
5357 unsigned long * addr = (unsigned long *)info->memory_base; in memory_test()
5375 addr = (unsigned long *)info->memory_base; in memory_test()
5383 memset( info->memory_base, 0, SCA_MEM_SIZE ); in memory_test()
5402 static void load_pci_memory(SLMP_INFO *info, char* dest, const char* src, unsigned short count) in load_pci_memory() argument
5413 read_status_reg(info); in load_pci_memory()
5421 static void trace_block(SLMP_INFO *info,const char* data, int count, int xmit) in trace_block() argument
5426 printk("%s tx data:\n",info->device_name); in trace_block()
5428 printk("%s rx data:\n",info->device_name); in trace_block()
5458 SLMP_INFO *info = from_timer(info, t, tx_timer); in tx_timeout() local
5463 __FILE__,__LINE__,info->device_name); in tx_timeout()
5464 if(info->tx_active && info->params.mode == MGSL_MODE_HDLC) { in tx_timeout()
5465 info->icount.txtimeout++; in tx_timeout()
5467 spin_lock_irqsave(&info->lock,flags); in tx_timeout()
5468 info->tx_active = false; in tx_timeout()
5469 info->tx_count = info->tx_put = info->tx_get = 0; in tx_timeout()
5471 spin_unlock_irqrestore(&info->lock,flags); in tx_timeout()
5474 if (info->netcount) in tx_timeout()
5475 hdlcdev_tx_done(info); in tx_timeout()
5478 bh_transmit(info); in tx_timeout()
5486 SLMP_INFO *info = from_timer(info, t, status_timer); in status_timeout() local
5491 spin_lock_irqsave(&info->lock,flags); in status_timeout()
5492 get_signals(info); in status_timeout()
5493 spin_unlock_irqrestore(&info->lock,flags); in status_timeout()
5497 delta = info->old_signals ^ info->serial_signals; in status_timeout()
5498 info->old_signals = info->serial_signals; in status_timeout()
5501 status |= MISCSTATUS_DSR_LATCHED|(info->serial_signals&SerialSignal_DSR); in status_timeout()
5504 status |= MISCSTATUS_RI_LATCHED|(info->serial_signals&SerialSignal_RI); in status_timeout()
5507 status |= MISCSTATUS_DCD_LATCHED|(info->serial_signals&SerialSignal_DCD); in status_timeout()
5510 status |= MISCSTATUS_CTS_LATCHED|(info->serial_signals&SerialSignal_CTS); in status_timeout()
5513 isr_io_pin(info,status); in status_timeout()
5515 mod_timer(&info->status_timer, jiffies + msecs_to_jiffies(10)); in status_timeout()
5523 unsigned char * RegAddr = (unsigned char*)(info->sca_base + Addr); \
5524 if (info->port_num > 1) \
5526 if ( info->port_num & 1) { \
5534 static unsigned char read_reg(SLMP_INFO * info, unsigned char Addr) in read_reg() argument
5539 static void write_reg(SLMP_INFO * info, unsigned char Addr, unsigned char Value) in write_reg() argument
5545 static u16 read_reg16(SLMP_INFO * info, unsigned char Addr) in read_reg16() argument
5551 static void write_reg16(SLMP_INFO * info, unsigned char Addr, u16 Value) in write_reg16() argument
5557 static unsigned char read_status_reg(SLMP_INFO * info) in read_status_reg() argument
5559 unsigned char *RegAddr = (unsigned char *)info->statctrl_base; in read_status_reg()
5563 static void write_control_reg(SLMP_INFO * info) in write_control_reg() argument
5565 unsigned char *RegAddr = (unsigned char *)info->statctrl_base; in write_control_reg()
5566 *RegAddr = info->port_array[0]->ctrlreg_value; in write_control_reg()