• Home
  • Raw
  • Download

Lines Matching refs: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()
1579 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_xmit() local
1589 info->tx_count = skb->len; in hdlcdev_xmit()
1590 tx_load_dma_buffer(info, skb->data, skb->len); in hdlcdev_xmit()
1603 spin_lock_irqsave(&info->lock,flags); in hdlcdev_xmit()
1604 if (!info->tx_active) in hdlcdev_xmit()
1605 tx_start(info); in hdlcdev_xmit()
1606 spin_unlock_irqrestore(&info->lock,flags); in hdlcdev_xmit()
1621 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_open() local
1634 spin_lock_irqsave(&info->netlock, flags); in hdlcdev_open()
1635 if (info->port.count != 0 || info->netcount != 0) { in hdlcdev_open()
1637 spin_unlock_irqrestore(&info->netlock, flags); in hdlcdev_open()
1640 info->netcount=1; in hdlcdev_open()
1641 spin_unlock_irqrestore(&info->netlock, flags); in hdlcdev_open()
1644 if ((rc = startup(info)) != 0) { in hdlcdev_open()
1645 spin_lock_irqsave(&info->netlock, flags); in hdlcdev_open()
1646 info->netcount=0; in hdlcdev_open()
1647 spin_unlock_irqrestore(&info->netlock, flags); in hdlcdev_open()
1652 info->serial_signals |= SerialSignal_RTS | SerialSignal_DTR; in hdlcdev_open()
1653 program_hw(info); in hdlcdev_open()
1660 spin_lock_irqsave(&info->lock, flags); in hdlcdev_open()
1661 get_signals(info); in hdlcdev_open()
1662 spin_unlock_irqrestore(&info->lock, flags); in hdlcdev_open()
1663 if (info->serial_signals & SerialSignal_DCD) in hdlcdev_open()
1680 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_close() local
1689 shutdown(info); in hdlcdev_close()
1693 spin_lock_irqsave(&info->netlock, flags); in hdlcdev_close()
1694 info->netcount=0; in hdlcdev_close()
1695 spin_unlock_irqrestore(&info->netlock, flags); in hdlcdev_close()
1713 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_ioctl() local
1720 if (info->port.count) in hdlcdev_ioctl()
1735 flags = info->params.flags & (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL | in hdlcdev_ioctl()
1749 new_line.clock_rate = info->params.clock_speed; in hdlcdev_ioctl()
1750 new_line.loopback = info->params.loopback ? 1:0; in hdlcdev_ioctl()
1769 case CLOCK_DEFAULT: flags = info->params.flags & in hdlcdev_ioctl()
1780 info->params.flags &= ~(HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL | in hdlcdev_ioctl()
1784 info->params.flags |= flags; in hdlcdev_ioctl()
1786 info->params.loopback = new_line.loopback; in hdlcdev_ioctl()
1789 info->params.clock_speed = new_line.clock_rate; in hdlcdev_ioctl()
1791 info->params.clock_speed = 0; in hdlcdev_ioctl()
1794 if (info->netcount) in hdlcdev_ioctl()
1795 program_hw(info); in hdlcdev_ioctl()
1809 SLMP_INFO *info = dev_to_port(dev); in hdlcdev_tx_timeout() local
1818 spin_lock_irqsave(&info->lock,flags); in hdlcdev_tx_timeout()
1819 tx_stop(info); in hdlcdev_tx_timeout()
1820 spin_unlock_irqrestore(&info->lock,flags); in hdlcdev_tx_timeout()
1831 static void hdlcdev_tx_done(SLMP_INFO *info) in hdlcdev_tx_done() argument
1833 if (netif_queue_stopped(info->netdev)) in hdlcdev_tx_done()
1834 netif_wake_queue(info->netdev); in hdlcdev_tx_done()
1845 static void hdlcdev_rx(SLMP_INFO *info, char *buf, int size) in hdlcdev_rx() argument
1848 struct net_device *dev = info->netdev; in hdlcdev_rx()
1886 static int hdlcdev_init(SLMP_INFO *info) in hdlcdev_init() argument
1894 dev = alloc_hdlcdev(info); in hdlcdev_init()
1901 dev->mem_start = info->phys_sca_base; in hdlcdev_init()
1902 dev->mem_end = info->phys_sca_base + SCA_BASE_SIZE - 1; in hdlcdev_init()
1903 dev->irq = info->irq_level; in hdlcdev_init()
1923 info->netdev = dev; in hdlcdev_init()
1933 static void hdlcdev_exit(SLMP_INFO *info) in hdlcdev_exit() argument
1935 unregister_hdlc_device(info->netdev); in hdlcdev_exit()
1936 free_netdev(info->netdev); in hdlcdev_exit()
1937 info->netdev = NULL; in hdlcdev_exit()
1946 static int bh_action(SLMP_INFO *info) in bh_action() argument
1951 spin_lock_irqsave(&info->lock,flags); in bh_action()
1953 if (info->pending_bh & BH_RECEIVE) { in bh_action()
1954 info->pending_bh &= ~BH_RECEIVE; in bh_action()
1956 } else if (info->pending_bh & BH_TRANSMIT) { in bh_action()
1957 info->pending_bh &= ~BH_TRANSMIT; in bh_action()
1959 } else if (info->pending_bh & BH_STATUS) { in bh_action()
1960 info->pending_bh &= ~BH_STATUS; in bh_action()
1966 info->bh_running = false; in bh_action()
1967 info->bh_requested = false; in bh_action()
1970 spin_unlock_irqrestore(&info->lock,flags); in bh_action()
1979 SLMP_INFO *info = container_of(work, SLMP_INFO, task); in bh_handler() local
1984 __FILE__,__LINE__,info->device_name); in bh_handler()
1986 info->bh_running = true; in bh_handler()
1988 while((action = bh_action(info)) != 0) { in bh_handler()
1993 __FILE__,__LINE__,info->device_name, action); in bh_handler()
1998 bh_receive(info); in bh_handler()
2001 bh_transmit(info); in bh_handler()
2004 bh_status(info); in bh_handler()
2009 __FILE__,__LINE__,info->device_name,action); in bh_handler()
2016 __FILE__,__LINE__,info->device_name); in bh_handler()
2019 static void bh_receive(SLMP_INFO *info) in bh_receive() argument
2023 __FILE__,__LINE__,info->device_name); in bh_receive()
2025 while( rx_get_frame(info) ); in bh_receive()
2028 static void bh_transmit(SLMP_INFO *info) in bh_transmit() argument
2030 struct tty_struct *tty = info->port.tty; in bh_transmit()
2034 __FILE__,__LINE__,info->device_name); in bh_transmit()
2040 static void bh_status(SLMP_INFO *info) in bh_status() argument
2044 __FILE__,__LINE__,info->device_name); in bh_status()
2046 info->ri_chkcount = 0; in bh_status()
2047 info->dsr_chkcount = 0; in bh_status()
2048 info->dcd_chkcount = 0; in bh_status()
2049 info->cts_chkcount = 0; in bh_status()
2052 static void isr_timer(SLMP_INFO * info) in isr_timer() argument
2054 unsigned char timer = (info->port_num & 1) ? TIMER2 : TIMER0; in isr_timer()
2057 write_reg(info, IER2, 0); in isr_timer()
2069 write_reg(info, (unsigned char)(timer + TMCS), 0); in isr_timer()
2071 info->irq_occurred = true; in isr_timer()
2075 __FILE__,__LINE__,info->device_name); in isr_timer()
2078 static void isr_rxint(SLMP_INFO * info) in isr_rxint() argument
2080 struct tty_struct *tty = info->port.tty; in isr_rxint()
2081 struct mgsl_icount *icount = &info->icount; in isr_rxint()
2082 unsigned char status = read_reg(info, SR1) & info->ie1_value & (FLGD + IDLD + CDCD + BRKD); in isr_rxint()
2083 unsigned char status2 = read_reg(info, SR2) & info->ie2_value & OVRN; in isr_rxint()
2087 write_reg(info, SR1, status); in isr_rxint()
2090 write_reg(info, SR2, status2); in isr_rxint()
2094 __FILE__,__LINE__,info->device_name,status,status2); in isr_rxint()
2096 if (info->params.mode == MGSL_MODE_ASYNC) { in isr_rxint()
2103 if (!(status & info->ignore_status_mask1)) { in isr_rxint()
2104 if (info->read_status_mask1 & BRKD) { in isr_rxint()
2105 tty_insert_flip_char(&info->port, 0, TTY_BREAK); in isr_rxint()
2106 if (tty && (info->port.flags & ASYNC_SAK)) in isr_rxint()
2115 info->icount.exithunt++; in isr_rxint()
2117 info->icount.rxidle++; in isr_rxint()
2118 wake_up_interruptible(&info->event_wait_q); in isr_rxint()
2126 get_signals( info ); in isr_rxint()
2127 isr_io_pin(info, in isr_rxint()
2128 MISCSTATUS_DCD_LATCHED|(info->serial_signals&SerialSignal_DCD)); in isr_rxint()
2135 static void isr_rxrdy(SLMP_INFO * info) in isr_rxrdy() argument
2139 struct mgsl_icount *icount = &info->icount; in isr_rxrdy()
2143 __FILE__,__LINE__,info->device_name); in isr_rxrdy()
2145 while((status = read_reg(info,CST0)) & BIT0) in isr_rxrdy()
2149 DataByte = read_reg(info,TRB); in isr_rxrdy()
2155 __FILE__,__LINE__,info->device_name,status); in isr_rxrdy()
2166 if (status & info->ignore_status_mask2) in isr_rxrdy()
2169 status &= info->read_status_mask2; in isr_rxrdy()
2184 tty_insert_flip_char(&info->port, DataByte, flag); in isr_rxrdy()
2186 tty_insert_flip_char(&info->port, 0, TTY_OVERRUN); in isr_rxrdy()
2191 __FILE__,__LINE__,info->device_name, in isr_rxrdy()
2196 tty_flip_buffer_push(&info->port); in isr_rxrdy()
2199 static void isr_txeom(SLMP_INFO * info, unsigned char status) in isr_txeom() argument
2203 __FILE__,__LINE__,info->device_name,status); in isr_txeom()
2205 write_reg(info, TXDMA + DIR, 0x00); /* disable Tx DMA IRQs */ in isr_txeom()
2206 write_reg(info, TXDMA + DSR, 0xc0); /* clear IRQs and disable DMA */ in isr_txeom()
2207 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in isr_txeom()
2210 write_reg(info, CMD, TXRESET); in isr_txeom()
2211 write_reg(info, CMD, TXENABLE); in isr_txeom()
2213 write_reg(info, CMD, TXBUFCLR); in isr_txeom()
2216 info->ie0_value &= ~TXRDYE; in isr_txeom()
2217 info->ie1_value &= ~(IDLE + UDRN); in isr_txeom()
2218 write_reg16(info, IE0, (unsigned short)((info->ie1_value << 8) + info->ie0_value)); in isr_txeom()
2219 write_reg(info, SR1, (unsigned char)(UDRN + IDLE)); in isr_txeom()
2221 if ( info->tx_active ) { in isr_txeom()
2222 if (info->params.mode != MGSL_MODE_ASYNC) { in isr_txeom()
2224 info->icount.txunder++; in isr_txeom()
2226 info->icount.txok++; in isr_txeom()
2229 info->tx_active = false; in isr_txeom()
2230 info->tx_count = info->tx_put = info->tx_get = 0; in isr_txeom()
2232 del_timer(&info->tx_timer); in isr_txeom()
2234 if (info->params.mode != MGSL_MODE_ASYNC && info->drop_rts_on_tx_done ) { in isr_txeom()
2235 info->serial_signals &= ~SerialSignal_RTS; in isr_txeom()
2236 info->drop_rts_on_tx_done = false; in isr_txeom()
2237 set_signals(info); in isr_txeom()
2241 if (info->netcount) in isr_txeom()
2242 hdlcdev_tx_done(info); in isr_txeom()
2246 if (info->port.tty && (info->port.tty->stopped || info->port.tty->hw_stopped)) { in isr_txeom()
2247 tx_stop(info); in isr_txeom()
2250 info->pending_bh |= BH_TRANSMIT; in isr_txeom()
2259 static void isr_txint(SLMP_INFO * info) in isr_txint() argument
2261 unsigned char status = read_reg(info, SR1) & info->ie1_value & (UDRN + IDLE + CCTS); in isr_txint()
2264 write_reg(info, SR1, status); in isr_txint()
2268 __FILE__,__LINE__,info->device_name,status); in isr_txint()
2271 isr_txeom(info, status); in isr_txint()
2277 get_signals( info ); in isr_txint()
2278 isr_io_pin(info, in isr_txint()
2279 MISCSTATUS_CTS_LATCHED|(info->serial_signals&SerialSignal_CTS)); in isr_txint()
2287 static void isr_txrdy(SLMP_INFO * info) in isr_txrdy() argument
2291 __FILE__,__LINE__,info->device_name,info->tx_count); in isr_txrdy()
2293 if (info->params.mode != MGSL_MODE_ASYNC) { in isr_txrdy()
2295 info->ie0_value &= ~TXRDYE; in isr_txrdy()
2296 info->ie1_value |= IDLE; in isr_txrdy()
2297 write_reg16(info, IE0, (unsigned short)((info->ie1_value << 8) + info->ie0_value)); in isr_txrdy()
2301 if (info->port.tty && (info->port.tty->stopped || info->port.tty->hw_stopped)) { in isr_txrdy()
2302 tx_stop(info); in isr_txrdy()
2306 if ( info->tx_count ) in isr_txrdy()
2307 tx_load_fifo( info ); in isr_txrdy()
2309 info->tx_active = false; in isr_txrdy()
2310 info->ie0_value &= ~TXRDYE; in isr_txrdy()
2311 write_reg(info, IE0, info->ie0_value); in isr_txrdy()
2314 if (info->tx_count < WAKEUP_CHARS) in isr_txrdy()
2315 info->pending_bh |= BH_TRANSMIT; in isr_txrdy()
2318 static void isr_rxdmaok(SLMP_INFO * info) in isr_rxdmaok() argument
2323 unsigned char status = read_reg(info,RXDMA + DSR) & 0xc0; in isr_rxdmaok()
2326 write_reg(info, RXDMA + DSR, (unsigned char)(status | 1)); in isr_rxdmaok()
2330 __FILE__,__LINE__,info->device_name,status); in isr_rxdmaok()
2332 info->pending_bh |= BH_RECEIVE; in isr_rxdmaok()
2335 static void isr_rxdmaerror(SLMP_INFO * info) in isr_rxdmaerror() argument
2340 unsigned char status = read_reg(info,RXDMA + DSR) & 0x30; in isr_rxdmaerror()
2343 write_reg(info, RXDMA + DSR, (unsigned char)(status | 1)); in isr_rxdmaerror()
2347 __FILE__,__LINE__,info->device_name,status); in isr_rxdmaerror()
2349 info->rx_overflow = true; in isr_rxdmaerror()
2350 info->pending_bh |= BH_RECEIVE; in isr_rxdmaerror()
2353 static void isr_txdmaok(SLMP_INFO * info) in isr_txdmaok() argument
2355 unsigned char status_reg1 = read_reg(info, SR1); in isr_txdmaok()
2357 write_reg(info, TXDMA + DIR, 0x00); /* disable Tx DMA IRQs */ in isr_txdmaok()
2358 write_reg(info, TXDMA + DSR, 0xc0); /* clear IRQs and disable DMA */ in isr_txdmaok()
2359 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in isr_txdmaok()
2363 __FILE__,__LINE__,info->device_name,status_reg1); in isr_txdmaok()
2366 write_reg16(info, TRC0, 0); in isr_txdmaok()
2367 info->ie0_value |= TXRDYE; in isr_txdmaok()
2368 write_reg(info, IE0, info->ie0_value); in isr_txdmaok()
2371 static void isr_txdmaerror(SLMP_INFO * info) in isr_txdmaerror() argument
2376 unsigned char status = read_reg(info,TXDMA + DSR) & 0x30; in isr_txdmaerror()
2379 write_reg(info, TXDMA + DSR, (unsigned char)(status | 1)); in isr_txdmaerror()
2383 __FILE__,__LINE__,info->device_name,status); in isr_txdmaerror()
2388 static void isr_io_pin( SLMP_INFO *info, u16 status ) in isr_io_pin() argument
2398 icount = &info->icount; in isr_io_pin()
2403 info->input_signal_events.ri_up++; in isr_io_pin()
2405 info->input_signal_events.ri_down++; in isr_io_pin()
2410 info->input_signal_events.dsr_up++; in isr_io_pin()
2412 info->input_signal_events.dsr_down++; in isr_io_pin()
2415 if ((info->dcd_chkcount)++ >= IO_PIN_SHUTDOWN_LIMIT) { in isr_io_pin()
2416 info->ie1_value &= ~CDCD; in isr_io_pin()
2417 write_reg(info, IE1, info->ie1_value); in isr_io_pin()
2421 info->input_signal_events.dcd_up++; in isr_io_pin()
2423 info->input_signal_events.dcd_down++; in isr_io_pin()
2425 if (info->netcount) { in isr_io_pin()
2427 netif_carrier_on(info->netdev); in isr_io_pin()
2429 netif_carrier_off(info->netdev); in isr_io_pin()
2435 if ((info->cts_chkcount)++ >= IO_PIN_SHUTDOWN_LIMIT) { in isr_io_pin()
2436 info->ie1_value &= ~CCTS; in isr_io_pin()
2437 write_reg(info, IE1, info->ie1_value); in isr_io_pin()
2441 info->input_signal_events.cts_up++; in isr_io_pin()
2443 info->input_signal_events.cts_down++; in isr_io_pin()
2445 wake_up_interruptible(&info->status_event_wait_q); in isr_io_pin()
2446 wake_up_interruptible(&info->event_wait_q); in isr_io_pin()
2448 if (tty_port_check_carrier(&info->port) && in isr_io_pin()
2451 printk("%s CD now %s...", info->device_name, in isr_io_pin()
2454 wake_up_interruptible(&info->port.open_wait); in isr_io_pin()
2458 if (info->port.tty) in isr_io_pin()
2459 tty_hangup(info->port.tty); in isr_io_pin()
2463 if (tty_port_cts_enabled(&info->port) && in isr_io_pin()
2465 if ( info->port.tty ) { in isr_io_pin()
2466 if (info->port.tty->hw_stopped) { in isr_io_pin()
2470 info->port.tty->hw_stopped = 0; in isr_io_pin()
2471 tx_start(info); in isr_io_pin()
2472 info->pending_bh |= BH_TRANSMIT; in isr_io_pin()
2479 info->port.tty->hw_stopped = 1; in isr_io_pin()
2480 tx_stop(info); in isr_io_pin()
2487 info->pending_bh |= BH_STATUS; in isr_io_pin()
2499 SLMP_INFO *info = dev_id; in synclinkmp_interrupt() local
2509 __FILE__, __LINE__, info->irq_level); in synclinkmp_interrupt()
2511 spin_lock(&info->lock); in synclinkmp_interrupt()
2516 tmp = read_reg16(info, ISR0); /* get ISR0 and ISR1 in one read */ in synclinkmp_interrupt()
2519 timerstatus0 = read_reg(info, ISR2); in synclinkmp_interrupt()
2523 __FILE__, __LINE__, info->device_name, in synclinkmp_interrupt()
2526 if (info->port_count == 4) { in synclinkmp_interrupt()
2528 tmp = read_reg16(info->port_array[2], ISR0); in synclinkmp_interrupt()
2531 timerstatus1 = read_reg(info->port_array[2], ISR2); in synclinkmp_interrupt()
2535 __FILE__,__LINE__,info->device_name, in synclinkmp_interrupt()
2543 for(i=0; i < info->port_count ; i++) { in synclinkmp_interrupt()
2544 if (info->port_array[i] == NULL) in synclinkmp_interrupt()
2557 isr_rxrdy(info->port_array[i]); in synclinkmp_interrupt()
2559 isr_txrdy(info->port_array[i]); in synclinkmp_interrupt()
2561 isr_rxint(info->port_array[i]); in synclinkmp_interrupt()
2563 isr_txint(info->port_array[i]); in synclinkmp_interrupt()
2566 isr_rxdmaerror(info->port_array[i]); in synclinkmp_interrupt()
2568 isr_rxdmaok(info->port_array[i]); in synclinkmp_interrupt()
2570 isr_txdmaerror(info->port_array[i]); in synclinkmp_interrupt()
2572 isr_txdmaok(info->port_array[i]); in synclinkmp_interrupt()
2576 isr_timer(info->port_array[0]); in synclinkmp_interrupt()
2578 isr_timer(info->port_array[1]); in synclinkmp_interrupt()
2580 isr_timer(info->port_array[2]); in synclinkmp_interrupt()
2582 isr_timer(info->port_array[3]); in synclinkmp_interrupt()
2585 for(i=0; i < info->port_count ; i++) { in synclinkmp_interrupt()
2586 SLMP_INFO * port = info->port_array[i]; in synclinkmp_interrupt()
2606 spin_unlock(&info->lock); in synclinkmp_interrupt()
2610 __FILE__, __LINE__, info->irq_level); in synclinkmp_interrupt()
2616 static int startup(SLMP_INFO * info) in startup() argument
2619 printk("%s(%d):%s tx_releaseup()\n",__FILE__,__LINE__,info->device_name); in startup()
2621 if (tty_port_initialized(&info->port)) in startup()
2624 if (!info->tx_buf) { in startup()
2625 info->tx_buf = kmalloc(info->max_frame_size, GFP_KERNEL); in startup()
2626 if (!info->tx_buf) { in startup()
2628 __FILE__,__LINE__,info->device_name); in startup()
2633 info->pending_bh = 0; in startup()
2635 memset(&info->icount, 0, sizeof(info->icount)); in startup()
2638 reset_port(info); in startup()
2640 change_params(info); in startup()
2642 mod_timer(&info->status_timer, jiffies + msecs_to_jiffies(10)); in startup()
2644 if (info->port.tty) in startup()
2645 clear_bit(TTY_IO_ERROR, &info->port.tty->flags); in startup()
2647 tty_port_set_initialized(&info->port, 1); in startup()
2654 static void shutdown(SLMP_INFO * info) in shutdown() argument
2658 if (!tty_port_initialized(&info->port)) in shutdown()
2663 __FILE__,__LINE__, info->device_name ); in shutdown()
2667 wake_up_interruptible(&info->status_event_wait_q); in shutdown()
2668 wake_up_interruptible(&info->event_wait_q); in shutdown()
2670 del_timer(&info->tx_timer); in shutdown()
2671 del_timer(&info->status_timer); in shutdown()
2673 kfree(info->tx_buf); in shutdown()
2674 info->tx_buf = NULL; in shutdown()
2676 spin_lock_irqsave(&info->lock,flags); in shutdown()
2678 reset_port(info); in shutdown()
2680 if (!info->port.tty || info->port.tty->termios.c_cflag & HUPCL) { in shutdown()
2681 info->serial_signals &= ~(SerialSignal_RTS | SerialSignal_DTR); in shutdown()
2682 set_signals(info); in shutdown()
2685 spin_unlock_irqrestore(&info->lock,flags); in shutdown()
2687 if (info->port.tty) in shutdown()
2688 set_bit(TTY_IO_ERROR, &info->port.tty->flags); in shutdown()
2690 tty_port_set_initialized(&info->port, 0); in shutdown()
2693 static void program_hw(SLMP_INFO *info) in program_hw() argument
2697 spin_lock_irqsave(&info->lock,flags); in program_hw()
2699 rx_stop(info); in program_hw()
2700 tx_stop(info); in program_hw()
2702 info->tx_count = info->tx_put = info->tx_get = 0; in program_hw()
2704 if (info->params.mode == MGSL_MODE_HDLC || info->netcount) in program_hw()
2705 hdlc_mode(info); in program_hw()
2707 async_mode(info); in program_hw()
2709 set_signals(info); in program_hw()
2711 info->dcd_chkcount = 0; in program_hw()
2712 info->cts_chkcount = 0; in program_hw()
2713 info->ri_chkcount = 0; in program_hw()
2714 info->dsr_chkcount = 0; in program_hw()
2716 info->ie1_value |= (CDCD|CCTS); in program_hw()
2717 write_reg(info, IE1, info->ie1_value); in program_hw()
2719 get_signals(info); in program_hw()
2721 if (info->netcount || (info->port.tty && info->port.tty->termios.c_cflag & CREAD) ) in program_hw()
2722 rx_start(info); in program_hw()
2724 spin_unlock_irqrestore(&info->lock,flags); in program_hw()
2729 static void change_params(SLMP_INFO *info) in change_params() argument
2734 if (!info->port.tty) in change_params()
2739 __FILE__,__LINE__, info->device_name ); in change_params()
2741 cflag = info->port.tty->termios.c_cflag; in change_params()
2746 info->serial_signals |= SerialSignal_RTS | SerialSignal_DTR; in change_params()
2748 info->serial_signals &= ~(SerialSignal_RTS | SerialSignal_DTR); in change_params()
2753 case CS5: info->params.data_bits = 5; break; in change_params()
2754 case CS6: info->params.data_bits = 6; break; in change_params()
2755 case CS7: info->params.data_bits = 7; break; in change_params()
2756 case CS8: info->params.data_bits = 8; break; in change_params()
2758 default: info->params.data_bits = 7; break; in change_params()
2762 info->params.stop_bits = 2; in change_params()
2764 info->params.stop_bits = 1; in change_params()
2766 info->params.parity = ASYNC_PARITY_NONE; in change_params()
2769 info->params.parity = ASYNC_PARITY_ODD; in change_params()
2771 info->params.parity = ASYNC_PARITY_EVEN; in change_params()
2774 info->params.parity = ASYNC_PARITY_SPACE; in change_params()
2781 bits_per_char = info->params.data_bits + in change_params()
2782 info->params.stop_bits + 1; in change_params()
2788 if (info->params.data_rate <= 460800) { in change_params()
2789 info->params.data_rate = tty_get_baud_rate(info->port.tty); in change_params()
2792 if ( info->params.data_rate ) { in change_params()
2793 info->timeout = (32*HZ*bits_per_char) / in change_params()
2794 info->params.data_rate; in change_params()
2796 info->timeout += HZ/50; /* Add .02 seconds of slop */ in change_params()
2798 tty_port_set_cts_flow(&info->port, cflag & CRTSCTS); in change_params()
2799 tty_port_set_check_carrier(&info->port, ~cflag & CLOCAL); in change_params()
2803 info->read_status_mask2 = OVRN; in change_params()
2804 if (I_INPCK(info->port.tty)) in change_params()
2805 info->read_status_mask2 |= PE | FRME; in change_params()
2806 if (I_BRKINT(info->port.tty) || I_PARMRK(info->port.tty)) in change_params()
2807 info->read_status_mask1 |= BRKD; in change_params()
2808 if (I_IGNPAR(info->port.tty)) in change_params()
2809 info->ignore_status_mask2 |= PE | FRME; in change_params()
2810 if (I_IGNBRK(info->port.tty)) { in change_params()
2811 info->ignore_status_mask1 |= BRKD; in change_params()
2815 if (I_IGNPAR(info->port.tty)) in change_params()
2816 info->ignore_status_mask2 |= OVRN; in change_params()
2819 program_hw(info); in change_params()
2822 static int get_stats(SLMP_INFO * info, struct mgsl_icount __user *user_icount) in get_stats() argument
2828 __FILE__,__LINE__, info->device_name); in get_stats()
2831 memset(&info->icount, 0, sizeof(info->icount)); in get_stats()
2833 mutex_lock(&info->port.mutex); in get_stats()
2834 COPY_TO_USER(err, user_icount, &info->icount, sizeof(struct mgsl_icount)); in get_stats()
2835 mutex_unlock(&info->port.mutex); in get_stats()
2843 static int get_params(SLMP_INFO * info, MGSL_PARAMS __user *user_params) in get_params() argument
2848 __FILE__,__LINE__, info->device_name); in get_params()
2850 mutex_lock(&info->port.mutex); in get_params()
2851 COPY_TO_USER(err,user_params, &info->params, sizeof(MGSL_PARAMS)); in get_params()
2852 mutex_unlock(&info->port.mutex); in get_params()
2856 __FILE__,__LINE__,info->device_name); in get_params()
2863 static int set_params(SLMP_INFO * info, MGSL_PARAMS __user *new_params) in set_params() argument
2871 __FILE__,__LINE__,info->device_name ); in set_params()
2876 __FILE__,__LINE__,info->device_name); in set_params()
2880 mutex_lock(&info->port.mutex); in set_params()
2881 spin_lock_irqsave(&info->lock,flags); in set_params()
2882 memcpy(&info->params,&tmp_params,sizeof(MGSL_PARAMS)); in set_params()
2883 spin_unlock_irqrestore(&info->lock,flags); in set_params()
2885 change_params(info); in set_params()
2886 mutex_unlock(&info->port.mutex); in set_params()
2891 static int get_txidle(SLMP_INFO * info, int __user *idle_mode) in get_txidle() argument
2897 __FILE__,__LINE__, info->device_name, info->idle_mode); in get_txidle()
2899 COPY_TO_USER(err,idle_mode, &info->idle_mode, sizeof(int)); in get_txidle()
2903 __FILE__,__LINE__,info->device_name); in get_txidle()
2910 static int set_txidle(SLMP_INFO * info, int idle_mode) in set_txidle() argument
2916 __FILE__,__LINE__,info->device_name, idle_mode ); in set_txidle()
2918 spin_lock_irqsave(&info->lock,flags); in set_txidle()
2919 info->idle_mode = idle_mode; in set_txidle()
2920 tx_set_idle( info ); in set_txidle()
2921 spin_unlock_irqrestore(&info->lock,flags); in set_txidle()
2925 static int tx_enable(SLMP_INFO * info, int enable) in tx_enable() argument
2931 __FILE__,__LINE__,info->device_name, enable); in tx_enable()
2933 spin_lock_irqsave(&info->lock,flags); in tx_enable()
2935 if ( !info->tx_enabled ) { in tx_enable()
2936 tx_start(info); in tx_enable()
2939 if ( info->tx_enabled ) in tx_enable()
2940 tx_stop(info); in tx_enable()
2942 spin_unlock_irqrestore(&info->lock,flags); in tx_enable()
2948 static int tx_abort(SLMP_INFO * info) in tx_abort() argument
2954 __FILE__,__LINE__,info->device_name); in tx_abort()
2956 spin_lock_irqsave(&info->lock,flags); in tx_abort()
2957 if ( info->tx_active && info->params.mode == MGSL_MODE_HDLC ) { in tx_abort()
2958 info->ie1_value &= ~UDRN; in tx_abort()
2959 info->ie1_value |= IDLE; in tx_abort()
2960 write_reg(info, IE1, info->ie1_value); /* disable tx status interrupts */ in tx_abort()
2961 write_reg(info, SR1, (unsigned char)(IDLE + UDRN)); /* clear pending */ in tx_abort()
2963 write_reg(info, TXDMA + DSR, 0); /* disable DMA channel */ in tx_abort()
2964 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in tx_abort()
2966 write_reg(info, CMD, TXABORT); in tx_abort()
2968 spin_unlock_irqrestore(&info->lock,flags); in tx_abort()
2972 static int rx_enable(SLMP_INFO * info, int enable) in rx_enable() argument
2978 __FILE__,__LINE__,info->device_name,enable); in rx_enable()
2980 spin_lock_irqsave(&info->lock,flags); in rx_enable()
2982 if ( !info->rx_enabled ) in rx_enable()
2983 rx_start(info); in rx_enable()
2985 if ( info->rx_enabled ) in rx_enable()
2986 rx_stop(info); in rx_enable()
2988 spin_unlock_irqrestore(&info->lock,flags); in rx_enable()
2994 static int wait_mgsl_event(SLMP_INFO * info, int __user *mask_ptr) in wait_mgsl_event() argument
3012 __FILE__,__LINE__,info->device_name,mask); in wait_mgsl_event()
3014 spin_lock_irqsave(&info->lock,flags); in wait_mgsl_event()
3017 get_signals(info); in wait_mgsl_event()
3018 s = info->serial_signals; in wait_mgsl_event()
3026 spin_unlock_irqrestore(&info->lock,flags); in wait_mgsl_event()
3031 cprev = info->icount; in wait_mgsl_event()
3032 oldsigs = info->input_signal_events; in wait_mgsl_event()
3036 unsigned char oldval = info->ie1_value; in wait_mgsl_event()
3041 info->ie1_value = newval; in wait_mgsl_event()
3042 write_reg(info, IE1, info->ie1_value); in wait_mgsl_event()
3047 add_wait_queue(&info->event_wait_q, &wait); in wait_mgsl_event()
3049 spin_unlock_irqrestore(&info->lock,flags); in wait_mgsl_event()
3059 spin_lock_irqsave(&info->lock,flags); in wait_mgsl_event()
3060 cnow = info->icount; in wait_mgsl_event()
3061 newsigs = info->input_signal_events; in wait_mgsl_event()
3063 spin_unlock_irqrestore(&info->lock,flags); in wait_mgsl_event()
3098 remove_wait_queue(&info->event_wait_q, &wait); in wait_mgsl_event()
3103 spin_lock_irqsave(&info->lock,flags); in wait_mgsl_event()
3104 if (!waitqueue_active(&info->event_wait_q)) { in wait_mgsl_event()
3106 info->ie1_value &= ~(FLGD|IDLD); in wait_mgsl_event()
3107 write_reg(info, IE1, info->ie1_value); in wait_mgsl_event()
3109 spin_unlock_irqrestore(&info->lock,flags); in wait_mgsl_event()
3118 static int modem_input_wait(SLMP_INFO *info,int arg) in modem_input_wait() argument
3126 spin_lock_irqsave(&info->lock,flags); in modem_input_wait()
3127 cprev = info->icount; in modem_input_wait()
3128 add_wait_queue(&info->status_event_wait_q, &wait); in modem_input_wait()
3130 spin_unlock_irqrestore(&info->lock,flags); in modem_input_wait()
3140 spin_lock_irqsave(&info->lock,flags); in modem_input_wait()
3141 cnow = info->icount; in modem_input_wait()
3143 spin_unlock_irqrestore(&info->lock,flags); in modem_input_wait()
3163 remove_wait_queue(&info->status_event_wait_q, &wait); in modem_input_wait()
3172 SLMP_INFO *info = tty->driver_data; in tiocmget() local
3176 spin_lock_irqsave(&info->lock,flags); in tiocmget()
3177 get_signals(info); in tiocmget()
3178 spin_unlock_irqrestore(&info->lock,flags); in tiocmget()
3180 result = ((info->serial_signals & SerialSignal_RTS) ? TIOCM_RTS : 0) | in tiocmget()
3181 ((info->serial_signals & SerialSignal_DTR) ? TIOCM_DTR : 0) | in tiocmget()
3182 ((info->serial_signals & SerialSignal_DCD) ? TIOCM_CAR : 0) | in tiocmget()
3183 ((info->serial_signals & SerialSignal_RI) ? TIOCM_RNG : 0) | in tiocmget()
3184 ((info->serial_signals & SerialSignal_DSR) ? TIOCM_DSR : 0) | in tiocmget()
3185 ((info->serial_signals & SerialSignal_CTS) ? TIOCM_CTS : 0); in tiocmget()
3189 __FILE__,__LINE__, info->device_name, result ); in tiocmget()
3198 SLMP_INFO *info = tty->driver_data; in tiocmset() local
3203 __FILE__,__LINE__,info->device_name, set, clear); in tiocmset()
3206 info->serial_signals |= SerialSignal_RTS; in tiocmset()
3208 info->serial_signals |= SerialSignal_DTR; in tiocmset()
3210 info->serial_signals &= ~SerialSignal_RTS; in tiocmset()
3212 info->serial_signals &= ~SerialSignal_DTR; in tiocmset()
3214 spin_lock_irqsave(&info->lock,flags); in tiocmset()
3215 set_signals(info); in tiocmset()
3216 spin_unlock_irqrestore(&info->lock,flags); in tiocmset()
3223 SLMP_INFO *info = container_of(port, SLMP_INFO, port); in carrier_raised() local
3226 spin_lock_irqsave(&info->lock,flags); in carrier_raised()
3227 get_signals(info); in carrier_raised()
3228 spin_unlock_irqrestore(&info->lock,flags); in carrier_raised()
3230 return (info->serial_signals & SerialSignal_DCD) ? 1 : 0; in carrier_raised()
3235 SLMP_INFO *info = container_of(port, SLMP_INFO, port); in dtr_rts() local
3238 spin_lock_irqsave(&info->lock,flags); in dtr_rts()
3240 info->serial_signals |= SerialSignal_RTS | SerialSignal_DTR; in dtr_rts()
3242 info->serial_signals &= ~(SerialSignal_RTS | SerialSignal_DTR); in dtr_rts()
3243 set_signals(info); in dtr_rts()
3244 spin_unlock_irqrestore(&info->lock,flags); in dtr_rts()
3250 SLMP_INFO *info) in block_til_ready() argument
3257 struct tty_port *port = &info->port; in block_til_ready()
3287 spin_lock_irqsave(&info->lock, flags); in block_til_ready()
3289 spin_unlock_irqrestore(&info->lock, flags); in block_til_ready()
3338 static int alloc_dma_bufs(SLMP_INFO *info) in alloc_dma_bufs() argument
3348 info->port_array[0]->last_mem_alloc = (SCA_MEM_SIZE/4) * info->port_num; in alloc_dma_bufs()
3355 BuffersPerFrame = (unsigned short)(info->max_frame_size/SCABUFSIZE); in alloc_dma_bufs()
3356 if ( info->max_frame_size % SCABUFSIZE ) in alloc_dma_bufs()
3370 info->tx_buf_count = BuffersPerFrame + 1; in alloc_dma_bufs()
3373 if (info->tx_buf_count > (BufferCount/2)) in alloc_dma_bufs()
3374 info->tx_buf_count = BufferCount/2; in alloc_dma_bufs()
3376 if (info->tx_buf_count > SCAMAXDESC) in alloc_dma_bufs()
3377 info->tx_buf_count = SCAMAXDESC; in alloc_dma_bufs()
3380 info->rx_buf_count = BufferCount - info->tx_buf_count; in alloc_dma_bufs()
3382 if (info->rx_buf_count > SCAMAXDESC) in alloc_dma_bufs()
3383 info->rx_buf_count = SCAMAXDESC; in alloc_dma_bufs()
3387 __FILE__,__LINE__, info->device_name, in alloc_dma_bufs()
3388 info->tx_buf_count,info->rx_buf_count); in alloc_dma_bufs()
3390 if ( alloc_buf_list( info ) < 0 || in alloc_dma_bufs()
3391 alloc_frame_bufs(info, in alloc_dma_bufs()
3392 info->rx_buf_list, in alloc_dma_bufs()
3393 info->rx_buf_list_ex, in alloc_dma_bufs()
3394 info->rx_buf_count) < 0 || in alloc_dma_bufs()
3395 alloc_frame_bufs(info, in alloc_dma_bufs()
3396 info->tx_buf_list, in alloc_dma_bufs()
3397 info->tx_buf_list_ex, in alloc_dma_bufs()
3398 info->tx_buf_count) < 0 || in alloc_dma_bufs()
3399 alloc_tmp_rx_buf(info) < 0 ) { in alloc_dma_bufs()
3401 __FILE__,__LINE__, info->device_name); in alloc_dma_bufs()
3405 rx_reset_buffers( info ); in alloc_dma_bufs()
3412 static int alloc_buf_list(SLMP_INFO *info) in alloc_buf_list() argument
3417 info->buffer_list = info->memory_base + info->port_array[0]->last_mem_alloc; in alloc_buf_list()
3418 info->buffer_list_phys = info->port_array[0]->last_mem_alloc; in alloc_buf_list()
3419 info->port_array[0]->last_mem_alloc += BUFFERLISTSIZE; in alloc_buf_list()
3421 memset(info->buffer_list, 0, BUFFERLISTSIZE); in alloc_buf_list()
3426 info->rx_buf_list = (SCADESC *)info->buffer_list; in alloc_buf_list()
3428 info->tx_buf_list = (SCADESC *)info->buffer_list; in alloc_buf_list()
3429 info->tx_buf_list += info->rx_buf_count; in alloc_buf_list()
3437 for ( i = 0; i < info->rx_buf_count; i++ ) { in alloc_buf_list()
3439 info->rx_buf_list_ex[i].phys_entry = in alloc_buf_list()
3440 info->buffer_list_phys + (i * SCABUFSIZE); in alloc_buf_list()
3444 info->rx_buf_list[i].next = info->buffer_list_phys; in alloc_buf_list()
3445 if ( i < info->rx_buf_count - 1 ) in alloc_buf_list()
3446 info->rx_buf_list[i].next += (i + 1) * sizeof(SCADESC); in alloc_buf_list()
3448 info->rx_buf_list[i].length = SCABUFSIZE; in alloc_buf_list()
3451 for ( i = 0; i < info->tx_buf_count; i++ ) { in alloc_buf_list()
3453 info->tx_buf_list_ex[i].phys_entry = info->buffer_list_phys + in alloc_buf_list()
3454 ((info->rx_buf_count + i) * sizeof(SCADESC)); in alloc_buf_list()
3459 info->tx_buf_list[i].next = info->buffer_list_phys + in alloc_buf_list()
3460 info->rx_buf_count * sizeof(SCADESC); in alloc_buf_list()
3462 if ( i < info->tx_buf_count - 1 ) in alloc_buf_list()
3463 info->tx_buf_list[i].next += (i + 1) * sizeof(SCADESC); in alloc_buf_list()
3471 static int alloc_frame_bufs(SLMP_INFO *info, SCADESC *buf_list,SCADESC_EX *buf_list_ex,int count) in alloc_frame_bufs() argument
3477 buf_list_ex[i].virt_addr = info->memory_base + info->port_array[0]->last_mem_alloc; in alloc_frame_bufs()
3478 phys_addr = info->port_array[0]->last_mem_alloc; in alloc_frame_bufs()
3479 info->port_array[0]->last_mem_alloc += SCABUFSIZE; in alloc_frame_bufs()
3488 static void free_dma_bufs(SLMP_INFO *info) in free_dma_bufs() argument
3490 info->buffer_list = NULL; in free_dma_bufs()
3491 info->rx_buf_list = NULL; in free_dma_bufs()
3492 info->tx_buf_list = NULL; in free_dma_bufs()
3498 static int alloc_tmp_rx_buf(SLMP_INFO *info) in alloc_tmp_rx_buf() argument
3500 info->tmp_rx_buf = kmalloc(info->max_frame_size, GFP_KERNEL); in alloc_tmp_rx_buf()
3501 if (info->tmp_rx_buf == NULL) in alloc_tmp_rx_buf()
3504 info->flag_buf = kzalloc(info->max_frame_size, GFP_KERNEL); in alloc_tmp_rx_buf()
3505 if (!info->flag_buf) { in alloc_tmp_rx_buf()
3506 kfree(info->tmp_rx_buf); in alloc_tmp_rx_buf()
3507 info->tmp_rx_buf = NULL; in alloc_tmp_rx_buf()
3513 static void free_tmp_rx_buf(SLMP_INFO *info) in free_tmp_rx_buf() argument
3515 kfree(info->tmp_rx_buf); in free_tmp_rx_buf()
3516 info->tmp_rx_buf = NULL; in free_tmp_rx_buf()
3517 kfree(info->flag_buf); in free_tmp_rx_buf()
3518 info->flag_buf = NULL; in free_tmp_rx_buf()
3521 static int claim_resources(SLMP_INFO *info) in claim_resources() argument
3523 if (request_mem_region(info->phys_memory_base,SCA_MEM_SIZE,"synclinkmp") == NULL) { in claim_resources()
3525 __FILE__,__LINE__,info->device_name, info->phys_memory_base); in claim_resources()
3526 info->init_error = DiagStatus_AddressConflict; in claim_resources()
3530 info->shared_mem_requested = true; in claim_resources()
3532 if (request_mem_region(info->phys_lcr_base + info->lcr_offset,128,"synclinkmp") == NULL) { in claim_resources()
3534 __FILE__,__LINE__,info->device_name, info->phys_lcr_base); in claim_resources()
3535 info->init_error = DiagStatus_AddressConflict; in claim_resources()
3539 info->lcr_mem_requested = true; in claim_resources()
3541 …if (request_mem_region(info->phys_sca_base + info->sca_offset,SCA_BASE_SIZE,"synclinkmp") == NULL)… in claim_resources()
3543 __FILE__,__LINE__,info->device_name, info->phys_sca_base); in claim_resources()
3544 info->init_error = DiagStatus_AddressConflict; in claim_resources()
3548 info->sca_base_requested = true; in claim_resources()
3550 …if (request_mem_region(info->phys_statctrl_base + info->statctrl_offset,SCA_REG_SIZE,"synclinkmp")… in claim_resources()
3552 __FILE__,__LINE__,info->device_name, info->phys_statctrl_base); in claim_resources()
3553 info->init_error = DiagStatus_AddressConflict; in claim_resources()
3557 info->sca_statctrl_requested = true; in claim_resources()
3559 info->memory_base = ioremap(info->phys_memory_base, in claim_resources()
3561 if (!info->memory_base) { in claim_resources()
3563 __FILE__,__LINE__,info->device_name, info->phys_memory_base ); in claim_resources()
3564 info->init_error = DiagStatus_CantAssignPciResources; in claim_resources()
3568 info->lcr_base = ioremap(info->phys_lcr_base, PAGE_SIZE); in claim_resources()
3569 if (!info->lcr_base) { in claim_resources()
3571 __FILE__,__LINE__,info->device_name, info->phys_lcr_base ); in claim_resources()
3572 info->init_error = DiagStatus_CantAssignPciResources; in claim_resources()
3575 info->lcr_base += info->lcr_offset; in claim_resources()
3577 info->sca_base = ioremap(info->phys_sca_base, PAGE_SIZE); in claim_resources()
3578 if (!info->sca_base) { in claim_resources()
3580 __FILE__,__LINE__,info->device_name, info->phys_sca_base ); in claim_resources()
3581 info->init_error = DiagStatus_CantAssignPciResources; in claim_resources()
3584 info->sca_base += info->sca_offset; in claim_resources()
3586 info->statctrl_base = ioremap(info->phys_statctrl_base, in claim_resources()
3588 if (!info->statctrl_base) { in claim_resources()
3590 __FILE__,__LINE__,info->device_name, info->phys_statctrl_base ); in claim_resources()
3591 info->init_error = DiagStatus_CantAssignPciResources; in claim_resources()
3594 info->statctrl_base += info->statctrl_offset; in claim_resources()
3596 if ( !memory_test(info) ) { in claim_resources()
3598 __FILE__,__LINE__,info->device_name, info->phys_memory_base ); in claim_resources()
3599 info->init_error = DiagStatus_MemoryError; in claim_resources()
3606 release_resources( info ); in claim_resources()
3610 static void release_resources(SLMP_INFO *info) in release_resources() argument
3614 __FILE__,__LINE__,info->device_name ); in release_resources()
3616 if ( info->irq_requested ) { in release_resources()
3617 free_irq(info->irq_level, info); in release_resources()
3618 info->irq_requested = false; in release_resources()
3621 if ( info->shared_mem_requested ) { in release_resources()
3622 release_mem_region(info->phys_memory_base,SCA_MEM_SIZE); in release_resources()
3623 info->shared_mem_requested = false; in release_resources()
3625 if ( info->lcr_mem_requested ) { in release_resources()
3626 release_mem_region(info->phys_lcr_base + info->lcr_offset,128); in release_resources()
3627 info->lcr_mem_requested = false; in release_resources()
3629 if ( info->sca_base_requested ) { in release_resources()
3630 release_mem_region(info->phys_sca_base + info->sca_offset,SCA_BASE_SIZE); in release_resources()
3631 info->sca_base_requested = false; in release_resources()
3633 if ( info->sca_statctrl_requested ) { in release_resources()
3634 release_mem_region(info->phys_statctrl_base + info->statctrl_offset,SCA_REG_SIZE); in release_resources()
3635 info->sca_statctrl_requested = false; in release_resources()
3638 if (info->memory_base){ in release_resources()
3639 iounmap(info->memory_base); in release_resources()
3640 info->memory_base = NULL; in release_resources()
3643 if (info->sca_base) { in release_resources()
3644 iounmap(info->sca_base - info->sca_offset); in release_resources()
3645 info->sca_base=NULL; in release_resources()
3648 if (info->statctrl_base) { in release_resources()
3649 iounmap(info->statctrl_base - info->statctrl_offset); in release_resources()
3650 info->statctrl_base=NULL; in release_resources()
3653 if (info->lcr_base){ in release_resources()
3654 iounmap(info->lcr_base - info->lcr_offset); in release_resources()
3655 info->lcr_base = NULL; in release_resources()
3660 __FILE__,__LINE__,info->device_name ); in release_resources()
3666 static int add_device(SLMP_INFO *info) in add_device() argument
3668 info->next_device = NULL; in add_device()
3669 info->line = synclinkmp_device_count; in add_device()
3670 sprintf(info->device_name,"ttySLM%dp%d",info->adapter_num,info->port_num); in add_device()
3672 if (info->line < MAX_DEVICES) { in add_device()
3673 if (maxframe[info->line]) in add_device()
3674 info->max_frame_size = maxframe[info->line]; in add_device()
3680 synclinkmp_device_list = info; in add_device()
3685 current_dev->next_device = info; in add_device()
3688 if ( info->max_frame_size < 4096 ) in add_device()
3689 info->max_frame_size = 4096; in add_device()
3690 else if ( info->max_frame_size > 65535 ) in add_device()
3691 info->max_frame_size = 65535; in add_device()
3695 info->device_name, in add_device()
3696 info->phys_sca_base, in add_device()
3697 info->phys_memory_base, in add_device()
3698 info->phys_statctrl_base, in add_device()
3699 info->phys_lcr_base, in add_device()
3700 info->irq_level, in add_device()
3701 info->max_frame_size ); in add_device()
3704 return hdlcdev_init(info); in add_device()
3721 SLMP_INFO *info; in alloc_dev() local
3723 info = kzalloc(sizeof(SLMP_INFO), in alloc_dev()
3726 if (!info) { in alloc_dev()
3730 tty_port_init(&info->port); in alloc_dev()
3731 info->port.ops = &port_ops; in alloc_dev()
3732 info->magic = MGSL_MAGIC; in alloc_dev()
3733 INIT_WORK(&info->task, bh_handler); in alloc_dev()
3734 info->max_frame_size = 4096; in alloc_dev()
3735 info->port.close_delay = 5*HZ/10; in alloc_dev()
3736 info->port.closing_wait = 30*HZ; in alloc_dev()
3737 init_waitqueue_head(&info->status_event_wait_q); in alloc_dev()
3738 init_waitqueue_head(&info->event_wait_q); in alloc_dev()
3739 spin_lock_init(&info->netlock); in alloc_dev()
3740 memcpy(&info->params,&default_params,sizeof(MGSL_PARAMS)); in alloc_dev()
3741 info->idle_mode = HDLC_TXIDLE_FLAGS; in alloc_dev()
3742 info->adapter_num = adapter_num; in alloc_dev()
3743 info->port_num = port_num; in alloc_dev()
3746 info->irq_level = pdev->irq; in alloc_dev()
3747 info->phys_lcr_base = pci_resource_start(pdev,0); in alloc_dev()
3748 info->phys_sca_base = pci_resource_start(pdev,2); in alloc_dev()
3749 info->phys_memory_base = pci_resource_start(pdev,3); in alloc_dev()
3750 info->phys_statctrl_base = pci_resource_start(pdev,4); in alloc_dev()
3756 info->lcr_offset = info->phys_lcr_base & (PAGE_SIZE-1); in alloc_dev()
3757 info->phys_lcr_base &= ~(PAGE_SIZE-1); in alloc_dev()
3759 info->sca_offset = info->phys_sca_base & (PAGE_SIZE-1); in alloc_dev()
3760 info->phys_sca_base &= ~(PAGE_SIZE-1); in alloc_dev()
3762 info->statctrl_offset = info->phys_statctrl_base & (PAGE_SIZE-1); in alloc_dev()
3763 info->phys_statctrl_base &= ~(PAGE_SIZE-1); in alloc_dev()
3765 info->bus_type = MGSL_BUS_TYPE_PCI; in alloc_dev()
3766 info->irq_flags = IRQF_SHARED; in alloc_dev()
3768 timer_setup(&info->tx_timer, tx_timeout, 0); in alloc_dev()
3769 timer_setup(&info->status_timer, status_timeout, 0); in alloc_dev()
3780 info->misc_ctrl_value = 0x087e4546; in alloc_dev()
3788 info->init_error = -1; in alloc_dev()
3791 return info; in alloc_dev()
3892 SLMP_INFO *info; in synclinkmp_cleanup() local
3906 info = synclinkmp_device_list; in synclinkmp_cleanup()
3907 while(info) { in synclinkmp_cleanup()
3908 reset_port(info); in synclinkmp_cleanup()
3909 info = info->next_device; in synclinkmp_cleanup()
3913 info = synclinkmp_device_list; in synclinkmp_cleanup()
3914 while(info) { in synclinkmp_cleanup()
3916 hdlcdev_exit(info); in synclinkmp_cleanup()
3918 free_dma_bufs(info); in synclinkmp_cleanup()
3919 free_tmp_rx_buf(info); in synclinkmp_cleanup()
3920 if ( info->port_num == 0 ) { in synclinkmp_cleanup()
3921 if (info->sca_base) in synclinkmp_cleanup()
3922 write_reg(info, LPR, 1); /* set low power mode */ in synclinkmp_cleanup()
3923 release_resources(info); in synclinkmp_cleanup()
3925 tmp = info; in synclinkmp_cleanup()
3926 info = info->next_device; in synclinkmp_cleanup()
4005 static void enable_loopback(SLMP_INFO *info, int enable) in enable_loopback() argument
4011 write_reg(info, MD2, (unsigned char)(read_reg(info, MD2) | (BIT1 + BIT0))); in enable_loopback()
4014 info->port_array[0]->ctrlreg_value |= (BIT0 << (info->port_num * 2)); in enable_loopback()
4015 write_control_reg(info); in enable_loopback()
4022 write_reg(info, RXS, 0x40); in enable_loopback()
4023 write_reg(info, TXS, 0x40); in enable_loopback()
4029 write_reg(info, MD2, (unsigned char)(read_reg(info, MD2) & ~(BIT1 + BIT0))); in enable_loopback()
4036 write_reg(info, RXS, 0x00); in enable_loopback()
4037 write_reg(info, TXS, 0x00); in enable_loopback()
4041 if (info->params.clock_speed) in enable_loopback()
4042 set_rate(info, info->params.clock_speed); in enable_loopback()
4044 set_rate(info, 3686400); in enable_loopback()
4052 static void set_rate( SLMP_INFO *info, u32 data_rate ) in set_rate() argument
4083 write_reg(info, TXS, in set_rate()
4084 (unsigned char)((read_reg(info, TXS) & 0xf0) | BRValue)); in set_rate()
4085 write_reg(info, RXS, in set_rate()
4086 (unsigned char)((read_reg(info, RXS) & 0xf0) | BRValue)); in set_rate()
4087 write_reg(info, TMC, (unsigned char)TMCValue); in set_rate()
4090 write_reg(info, TXS,0); in set_rate()
4091 write_reg(info, RXS,0); in set_rate()
4092 write_reg(info, TMC, 0); in set_rate()
4098 static void rx_stop(SLMP_INFO *info) in rx_stop() argument
4102 __FILE__,__LINE__, info->device_name ); in rx_stop()
4104 write_reg(info, CMD, RXRESET); in rx_stop()
4106 info->ie0_value &= ~RXRDYE; in rx_stop()
4107 write_reg(info, IE0, info->ie0_value); /* disable Rx data interrupts */ in rx_stop()
4109 write_reg(info, RXDMA + DSR, 0); /* disable Rx DMA */ in rx_stop()
4110 write_reg(info, RXDMA + DCMD, SWABORT); /* reset/init Rx DMA */ in rx_stop()
4111 write_reg(info, RXDMA + DIR, 0); /* disable Rx DMA interrupts */ in rx_stop()
4113 info->rx_enabled = false; in rx_stop()
4114 info->rx_overflow = false; in rx_stop()
4119 static void rx_start(SLMP_INFO *info) in rx_start() argument
4125 __FILE__,__LINE__, info->device_name ); in rx_start()
4127 write_reg(info, CMD, RXRESET); in rx_start()
4129 if ( info->params.mode == MGSL_MODE_HDLC ) { in rx_start()
4131 info->ie0_value &= ~RXRDYE; in rx_start()
4132 write_reg(info, IE0, info->ie0_value); in rx_start()
4135 write_reg(info, RXDMA + DSR, 0); /* disable Rx DMA */ in rx_start()
4136 write_reg(info, RXDMA + DCMD, SWABORT); /* reset/init Rx DMA */ in rx_start()
4138 for (i = 0; i < info->rx_buf_count; i++) { in rx_start()
4139 info->rx_buf_list[i].status = 0xff; in rx_start()
4144 read_status_reg(info); in rx_start()
4146 info->current_rx_buf = 0; in rx_start()
4149 write_reg16(info, RXDMA + CDA, in rx_start()
4150 info->rx_buf_list_ex[0].phys_entry); in rx_start()
4153 write_reg16(info, RXDMA + EDA, in rx_start()
4154 info->rx_buf_list_ex[info->rx_buf_count - 1].phys_entry); in rx_start()
4157 write_reg16(info, RXDMA + BFL, SCABUFSIZE); in rx_start()
4159 write_reg(info, RXDMA + DIR, 0x60); /* enable Rx DMA interrupts (EOM/BOF) */ in rx_start()
4160 write_reg(info, RXDMA + DSR, 0xf2); /* clear Rx DMA IRQs, enable Rx DMA */ in rx_start()
4163 info->ie0_value |= RXRDYE; in rx_start()
4164 write_reg(info, IE0, info->ie0_value); in rx_start()
4167 write_reg(info, CMD, RXENABLE); in rx_start()
4169 info->rx_overflow = false; in rx_start()
4170 info->rx_enabled = true; in rx_start()
4176 static void tx_start(SLMP_INFO *info) in tx_start() argument
4180 __FILE__,__LINE__, info->device_name,info->tx_count ); in tx_start()
4182 if (!info->tx_enabled ) { in tx_start()
4183 write_reg(info, CMD, TXRESET); in tx_start()
4184 write_reg(info, CMD, TXENABLE); in tx_start()
4185 info->tx_enabled = true; in tx_start()
4188 if ( info->tx_count ) { in tx_start()
4194 info->drop_rts_on_tx_done = false; in tx_start()
4196 if (info->params.mode != MGSL_MODE_ASYNC) { in tx_start()
4198 if ( info->params.flags & HDLC_FLAG_AUTO_RTS ) { in tx_start()
4199 get_signals( info ); in tx_start()
4200 if ( !(info->serial_signals & SerialSignal_RTS) ) { in tx_start()
4201 info->serial_signals |= SerialSignal_RTS; in tx_start()
4202 set_signals( info ); in tx_start()
4203 info->drop_rts_on_tx_done = true; in tx_start()
4207 write_reg16(info, TRC0, in tx_start()
4210 write_reg(info, TXDMA + DSR, 0); /* disable DMA channel */ in tx_start()
4211 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in tx_start()
4214 write_reg16(info, TXDMA + CDA, in tx_start()
4215 info->tx_buf_list_ex[0].phys_entry); in tx_start()
4218 write_reg16(info, TXDMA + EDA, in tx_start()
4219 info->tx_buf_list_ex[info->last_tx_buf].phys_entry); in tx_start()
4222 info->ie1_value &= ~IDLE; in tx_start()
4223 info->ie1_value |= UDRN; in tx_start()
4224 write_reg(info, IE1, info->ie1_value); in tx_start()
4225 write_reg(info, SR1, (unsigned char)(IDLE + UDRN)); in tx_start()
4227 write_reg(info, TXDMA + DIR, 0x40); /* enable Tx DMA interrupts (EOM) */ in tx_start()
4228 write_reg(info, TXDMA + DSR, 0xf2); /* clear Tx DMA IRQs, enable Tx DMA */ in tx_start()
4230 mod_timer(&info->tx_timer, jiffies + in tx_start()
4234 tx_load_fifo(info); in tx_start()
4236 info->ie0_value |= TXRDYE; in tx_start()
4237 write_reg(info, IE0, info->ie0_value); in tx_start()
4240 info->tx_active = true; in tx_start()
4246 static void tx_stop( SLMP_INFO *info ) in tx_stop() argument
4250 __FILE__,__LINE__, info->device_name ); in tx_stop()
4252 del_timer(&info->tx_timer); in tx_stop()
4254 write_reg(info, TXDMA + DSR, 0); /* disable DMA channel */ in tx_stop()
4255 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ in tx_stop()
4257 write_reg(info, CMD, TXRESET); in tx_stop()
4259 info->ie1_value &= ~(UDRN + IDLE); in tx_stop()
4260 write_reg(info, IE1, info->ie1_value); /* disable tx status interrupts */ in tx_stop()
4261 write_reg(info, SR1, (unsigned char)(IDLE + UDRN)); /* clear pending */ in tx_stop()
4263 info->ie0_value &= ~TXRDYE; in tx_stop()
4264 write_reg(info, IE0, info->ie0_value); /* disable tx data interrupts */ in tx_stop()
4266 info->tx_enabled = false; in tx_stop()
4267 info->tx_active = false; in tx_stop()
4273 static void tx_load_fifo(SLMP_INFO *info) in tx_load_fifo() argument
4279 if ( !info->tx_count && !info->x_char ) in tx_load_fifo()
4284 while( info->tx_count && (read_reg(info,SR0) & BIT1) ) { in tx_load_fifo()
4289 if ( (info->tx_count > 1) && !info->x_char ) { in tx_load_fifo()
4291 TwoBytes[0] = info->tx_buf[info->tx_get++]; in tx_load_fifo()
4292 if (info->tx_get >= info->max_frame_size) in tx_load_fifo()
4293 info->tx_get -= info->max_frame_size; in tx_load_fifo()
4294 TwoBytes[1] = 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()
4298 write_reg16(info, TRB, *((u16 *)TwoBytes)); in tx_load_fifo()
4300 info->tx_count -= 2; in tx_load_fifo()
4301 info->icount.tx += 2; in tx_load_fifo()
4305 if (info->x_char) { in tx_load_fifo()
4307 write_reg(info, TRB, info->x_char); in tx_load_fifo()
4308 info->x_char = 0; in tx_load_fifo()
4310 write_reg(info, TRB, info->tx_buf[info->tx_get++]); in tx_load_fifo()
4311 if (info->tx_get >= info->max_frame_size) in tx_load_fifo()
4312 info->tx_get -= info->max_frame_size; in tx_load_fifo()
4313 info->tx_count--; in tx_load_fifo()
4315 info->icount.tx++; in tx_load_fifo()
4322 static void reset_port(SLMP_INFO *info) in reset_port() argument
4324 if (info->sca_base) { in reset_port()
4326 tx_stop(info); in reset_port()
4327 rx_stop(info); in reset_port()
4329 info->serial_signals &= ~(SerialSignal_RTS | SerialSignal_DTR); in reset_port()
4330 set_signals(info); in reset_port()
4333 info->ie0_value = 0; in reset_port()
4334 info->ie1_value = 0; in reset_port()
4335 info->ie2_value = 0; in reset_port()
4336 write_reg(info, IE0, info->ie0_value); in reset_port()
4337 write_reg(info, IE1, info->ie1_value); in reset_port()
4338 write_reg(info, IE2, info->ie2_value); in reset_port()
4340 write_reg(info, CMD, CHRESET); in reset_port()
4346 static void reset_adapter(SLMP_INFO *info) in reset_adapter() argument
4351 if (info->port_array[i]) in reset_adapter()
4352 reset_port(info->port_array[i]); in reset_adapter()
4358 static void async_mode(SLMP_INFO *info) in async_mode() argument
4363 tx_stop(info); in async_mode()
4364 rx_stop(info); in async_mode()
4377 if (info->params.stop_bits != 1) in async_mode()
4379 write_reg(info, MD0, RegValue); in async_mode()
4391 switch (info->params.data_bits) { in async_mode()
4396 if (info->params.parity != ASYNC_PARITY_NONE) { in async_mode()
4398 if (info->params.parity == ASYNC_PARITY_ODD) in async_mode()
4401 write_reg(info, MD1, RegValue); in async_mode()
4411 if (info->params.loopback) in async_mode()
4413 write_reg(info, MD2, RegValue); in async_mode()
4422 write_reg(info, RXS, RegValue); in async_mode()
4431 write_reg(info, TXS, RegValue); in async_mode()
4437 info->port_array[0]->ctrlreg_value |= (BIT0 << (info->port_num * 2)); in async_mode()
4438 write_control_reg(info); in async_mode()
4440 tx_set_idle(info); in async_mode()
4447 write_reg(info, RRC, 0x00); in async_mode()
4454 write_reg(info, TRC0, 0x10); in async_mode()
4461 write_reg(info, TRC1, 0x1e); in async_mode()
4476 if (!(info->serial_signals & SerialSignal_RTS)) in async_mode()
4478 write_reg(info, CTL, RegValue); in async_mode()
4481 info->ie0_value |= TXINTE + RXINTE; in async_mode()
4482 write_reg(info, IE0, info->ie0_value); in async_mode()
4485 info->ie1_value = BRKD; in async_mode()
4486 write_reg(info, IE1, info->ie1_value); in async_mode()
4489 info->ie2_value = OVRN; in async_mode()
4490 write_reg(info, IE2, info->ie2_value); in async_mode()
4492 set_rate( info, info->params.data_rate * 16 ); in async_mode()
4497 static void hdlc_mode(SLMP_INFO *info) in hdlc_mode() argument
4506 info->params.flags &= ~(HDLC_FLAG_TXC_DPLL + HDLC_FLAG_RXC_DPLL); in hdlc_mode()
4509 write_reg(info, TXDMA + DIR, 0); in hdlc_mode()
4510 write_reg(info, RXDMA + DIR, 0); in hdlc_mode()
4524 if (info->params.flags & HDLC_FLAG_AUTO_CTS) in hdlc_mode()
4526 if (info->params.flags & HDLC_FLAG_AUTO_DCD) in hdlc_mode()
4528 if (info->params.crc_type == HDLC_CRC_16_CCITT) in hdlc_mode()
4530 write_reg(info, MD0, RegValue); in hdlc_mode()
4542 write_reg(info, MD1, RegValue); in hdlc_mode()
4555 switch(info->params.encoding) { in hdlc_mode()
4566 if ( info->params.flags & HDLC_FLAG_DPLL_DIV16 ) { in hdlc_mode()
4569 } else if ( info->params.flags & HDLC_FLAG_DPLL_DIV8 ) { in hdlc_mode()
4575 write_reg(info, MD2, RegValue); in hdlc_mode()
4585 if (info->params.flags & HDLC_FLAG_RXC_BRG) in hdlc_mode()
4587 if (info->params.flags & HDLC_FLAG_RXC_DPLL) in hdlc_mode()
4589 write_reg(info, RXS, RegValue); in hdlc_mode()
4598 if (info->params.flags & HDLC_FLAG_TXC_BRG) in hdlc_mode()
4600 if (info->params.flags & HDLC_FLAG_TXC_DPLL) in hdlc_mode()
4602 write_reg(info, TXS, RegValue); in hdlc_mode()
4604 if (info->params.flags & HDLC_FLAG_RXC_DPLL) in hdlc_mode()
4605 set_rate(info, info->params.clock_speed * DpllDivisor); in hdlc_mode()
4607 set_rate(info, info->params.clock_speed); in hdlc_mode()
4613 if (info->params.flags & HDLC_FLAG_TXC_BRG) in hdlc_mode()
4614 info->port_array[0]->ctrlreg_value |= (BIT0 << (info->port_num * 2)); in hdlc_mode()
4616 info->port_array[0]->ctrlreg_value &= ~(BIT0 << (info->port_num * 2)); in hdlc_mode()
4617 write_control_reg(info); in hdlc_mode()
4624 write_reg(info, RRC, rx_active_fifo_level); in hdlc_mode()
4631 write_reg(info, TRC0, tx_active_fifo_level); in hdlc_mode()
4638 write_reg(info, TRC1, (unsigned char)(tx_negate_fifo_level - 1)); in hdlc_mode()
4651 write_reg(info, TXDMA + DMR, 0x14); in hdlc_mode()
4652 write_reg(info, RXDMA + DMR, 0x14); in hdlc_mode()
4655 write_reg(info, RXDMA + CPB, in hdlc_mode()
4656 (unsigned char)(info->buffer_list_phys >> 16)); in hdlc_mode()
4659 write_reg(info, TXDMA + CPB, in hdlc_mode()
4660 (unsigned char)(info->buffer_list_phys >> 16)); in hdlc_mode()
4665 info->ie0_value |= TXINTE + RXINTE; in hdlc_mode()
4666 write_reg(info, IE0, info->ie0_value); in hdlc_mode()
4681 if (!(info->serial_signals & SerialSignal_RTS)) in hdlc_mode()
4683 write_reg(info, CTL, RegValue); in hdlc_mode()
4687 tx_set_idle(info); in hdlc_mode()
4688 tx_stop(info); in hdlc_mode()
4689 rx_stop(info); in hdlc_mode()
4691 set_rate(info, info->params.clock_speed); in hdlc_mode()
4693 if (info->params.loopback) in hdlc_mode()
4694 enable_loopback(info,1); in hdlc_mode()
4699 static void tx_set_idle(SLMP_INFO *info) in tx_set_idle() argument
4704 switch(info->idle_mode) { in tx_set_idle()
4714 write_reg(info, IDL, RegValue); in tx_set_idle()
4719 static void get_signals(SLMP_INFO *info) in get_signals() argument
4721 u16 status = read_reg(info, SR3); in get_signals()
4722 u16 gpstatus = read_status_reg(info); in get_signals()
4726 info->serial_signals &= SerialSignal_RTS | SerialSignal_DTR; in get_signals()
4731 info->serial_signals |= SerialSignal_CTS; in get_signals()
4734 info->serial_signals |= SerialSignal_DCD; in get_signals()
4736 testbit = BIT1 << (info->port_num * 2); // Port 0..3 RI is GPDATA<1,3,5,7> in get_signals()
4738 info->serial_signals |= SerialSignal_RI; in get_signals()
4740 testbit = BIT0 << (info->port_num * 2); // Port 0..3 DSR is GPDATA<0,2,4,6> in get_signals()
4742 info->serial_signals |= SerialSignal_DSR; in get_signals()
4748 static void set_signals(SLMP_INFO *info) in set_signals() argument
4753 RegValue = read_reg(info, CTL); in set_signals()
4754 if (info->serial_signals & SerialSignal_RTS) in set_signals()
4758 write_reg(info, CTL, RegValue); in set_signals()
4761 EnableBit = BIT1 << (info->port_num*2); in set_signals()
4762 if (info->serial_signals & SerialSignal_DTR) in set_signals()
4763 info->port_array[0]->ctrlreg_value &= ~EnableBit; in set_signals()
4765 info->port_array[0]->ctrlreg_value |= EnableBit; in set_signals()
4766 write_control_reg(info); in set_signals()
4777 static void rx_reset_buffers(SLMP_INFO *info) in rx_reset_buffers() argument
4779 rx_free_frame_buffers(info, 0, info->rx_buf_count - 1); in rx_reset_buffers()
4788 static void rx_free_frame_buffers(SLMP_INFO *info, unsigned int first, unsigned int last) in rx_free_frame_buffers() argument
4794 info->rx_buf_list[first].status = 0xff; in rx_free_frame_buffers()
4799 write_reg16(info, RXDMA + EDA, info->rx_buf_list_ex[first].phys_entry); in rx_free_frame_buffers()
4803 if (first == info->rx_buf_count) in rx_free_frame_buffers()
4808 info->current_rx_buf = first; in rx_free_frame_buffers()
4816 static bool rx_get_frame(SLMP_INFO *info) in rx_get_frame() argument
4823 struct tty_struct *tty = info->port.tty; in rx_get_frame()
4839 StartIndex = EndIndex = info->current_rx_buf; in rx_get_frame()
4842 desc = &info->rx_buf_list[EndIndex]; in rx_get_frame()
4843 desc_ex = &info->rx_buf_list_ex[EndIndex]; in rx_get_frame()
4848 if (framesize == 0 && info->params.addr_filter != 0xff) in rx_get_frame()
4858 if (EndIndex == info->rx_buf_count) in rx_get_frame()
4861 if (EndIndex == info->current_rx_buf) { in rx_get_frame()
4864 if ( info->rx_enabled ){ in rx_get_frame()
4865 spin_lock_irqsave(&info->lock,flags); in rx_get_frame()
4866 rx_start(info); in rx_get_frame()
4867 spin_unlock_irqrestore(&info->lock,flags); in rx_get_frame()
4890 if (info->params.crc_type == HDLC_CRC_NONE) in rx_get_frame()
4894 (addr_field != 0xff && addr_field != info->params.addr_filter)) { in rx_get_frame()
4898 rx_free_frame_buffers(info, StartIndex, EndIndex); in rx_get_frame()
4910 info->icount.rxshort++; in rx_get_frame()
4912 info->icount.rxabort++; in rx_get_frame()
4914 info->icount.rxover++; in rx_get_frame()
4916 info->icount.rxcrc++; in rx_get_frame()
4921 info->netdev->stats.rx_errors++; in rx_get_frame()
4922 info->netdev->stats.rx_frame_errors++; in rx_get_frame()
4929 __FILE__,__LINE__,info->device_name,status,framesize); in rx_get_frame()
4932 trace_block(info,info->rx_buf_list_ex[StartIndex].virt_addr, in rx_get_frame()
4936 if (framesize > info->max_frame_size) in rx_get_frame()
4937 info->icount.rxlong++; in rx_get_frame()
4942 unsigned char *ptmp = info->tmp_rx_buf; in rx_get_frame()
4943 info->tmp_rx_buf_count = framesize; in rx_get_frame()
4945 info->icount.rxok++; in rx_get_frame()
4950 info->rx_buf_list_ex[index].virt_addr, in rx_get_frame()
4955 if ( ++index == info->rx_buf_count ) in rx_get_frame()
4960 if (info->netcount) in rx_get_frame()
4961 hdlcdev_rx(info,info->tmp_rx_buf,framesize); in rx_get_frame()
4964 ldisc_receive_buf(tty,info->tmp_rx_buf, in rx_get_frame()
4965 info->flag_buf, framesize); in rx_get_frame()
4969 rx_free_frame_buffers( info, StartIndex, EndIndex ); in rx_get_frame()
4974 if ( info->rx_enabled && info->rx_overflow ) { in rx_get_frame()
4978 if (info->rx_buf_list[EndIndex].status == 0xff) { in rx_get_frame()
4979 spin_lock_irqsave(&info->lock,flags); in rx_get_frame()
4980 rx_start(info); in rx_get_frame()
4981 spin_unlock_irqrestore(&info->lock,flags); in rx_get_frame()
4990 static void tx_load_dma_buffer(SLMP_INFO *info, const char *buf, unsigned int count) in tx_load_dma_buffer() argument
4998 trace_block(info, buf, min_t(unsigned int, count, SCABUFSIZE), 1); in tx_load_dma_buffer()
5007 desc = &info->tx_buf_list[i]; in tx_load_dma_buffer()
5008 desc_ex = &info->tx_buf_list_ex[i]; in tx_load_dma_buffer()
5010 load_pci_memory(info, desc_ex->virt_addr,buf,copy_count); in tx_load_dma_buffer()
5022 if (i >= info->tx_buf_count) in tx_load_dma_buffer()
5026 info->tx_buf_list[i].status = 0x81; /* set EOM and EOT status */ in tx_load_dma_buffer()
5027 info->last_tx_buf = ++i; in tx_load_dma_buffer()
5030 static bool register_test(SLMP_INFO *info) in register_test() argument
5038 spin_lock_irqsave(&info->lock,flags); in register_test()
5039 reset_port(info); in register_test()
5042 info->init_error = DiagStatus_AddressFailure; in register_test()
5048 write_reg(info, TMC, testval[i]); in register_test()
5049 write_reg(info, IDL, testval[(i+1)%count]); in register_test()
5050 write_reg(info, SA0, testval[(i+2)%count]); in register_test()
5051 write_reg(info, SA1, testval[(i+3)%count]); in register_test()
5053 if ( (read_reg(info, TMC) != testval[i]) || in register_test()
5054 (read_reg(info, IDL) != testval[(i+1)%count]) || in register_test()
5055 (read_reg(info, SA0) != testval[(i+2)%count]) || in register_test()
5056 (read_reg(info, SA1) != testval[(i+3)%count]) ) in register_test()
5063 reset_port(info); in register_test()
5064 spin_unlock_irqrestore(&info->lock,flags); in register_test()
5069 static bool irq_test(SLMP_INFO *info) in irq_test() argument
5074 unsigned char timer = (info->port_num & 1) ? TIMER2 : TIMER0; in irq_test()
5076 spin_lock_irqsave(&info->lock,flags); in irq_test()
5077 reset_port(info); in irq_test()
5080 info->init_error = DiagStatus_IrqFailure; in irq_test()
5081 info->irq_occurred = false; in irq_test()
5086 write_reg(info, IER2, (unsigned char)((info->port_num & 1) ? BIT6 : BIT4)); in irq_test()
5088 write_reg(info, (unsigned char)(timer + TEPR), 0); /* timer expand prescale */ in irq_test()
5089 write_reg16(info, (unsigned char)(timer + TCONR), 1); /* timer constant */ in irq_test()
5102 write_reg(info, (unsigned char)(timer + TMCS), 0x50); in irq_test()
5104 spin_unlock_irqrestore(&info->lock,flags); in irq_test()
5107 while( timeout-- && !info->irq_occurred ) { in irq_test()
5111 spin_lock_irqsave(&info->lock,flags); in irq_test()
5112 reset_port(info); in irq_test()
5113 spin_unlock_irqrestore(&info->lock,flags); in irq_test()
5115 return info->irq_occurred; in irq_test()
5120 static bool sca_init(SLMP_INFO *info) in sca_init() argument
5123 write_reg(info, PABR0, 0); /* wait controller addr boundary 0 */ in sca_init()
5124 write_reg(info, PABR1, 0); /* wait controller addr boundary 1 */ in sca_init()
5125 write_reg(info, WCRL, 0); /* wait controller low range */ in sca_init()
5126 write_reg(info, WCRM, 0); /* wait controller mid range */ in sca_init()
5127 write_reg(info, WCRH, 0); /* wait controller high range */ in sca_init()
5138 write_reg(info, DPCR, dma_priority); in sca_init()
5141 write_reg(info, DMER, 0x80); in sca_init()
5144 write_reg(info, IER0, 0xff); /* TxRDY,RxRDY,TxINT,RxINT (ports 0-1) */ in sca_init()
5145 write_reg(info, IER1, 0xff); /* DMIB,DMIA (channels 0-3) */ in sca_init()
5146 write_reg(info, IER2, 0xf0); /* TIRQ (timers 0-3) */ in sca_init()
5154 write_reg(info, ITCR, 0); in sca_init()
5161 static bool init_adapter(SLMP_INFO *info) in init_adapter() argument
5166 volatile u32 *MiscCtrl = (u32 *)(info->lcr_base + 0x50); in init_adapter()
5169 info->misc_ctrl_value |= BIT30; in init_adapter()
5170 *MiscCtrl = info->misc_ctrl_value; in init_adapter()
5180 info->misc_ctrl_value &= ~BIT30; in init_adapter()
5181 *MiscCtrl = info->misc_ctrl_value; in init_adapter()
5184 info->ctrlreg_value = 0xaa; in init_adapter()
5185 write_control_reg(info); in init_adapter()
5188 volatile u32 *LCR1BRDR = (u32 *)(info->lcr_base + 0x2c); in init_adapter()
5211 sca_init(info->port_array[0]); in init_adapter()
5212 sca_init(info->port_array[2]); in init_adapter()
5220 static bool loopback_test(SLMP_INFO *info) in loopback_test() argument
5230 struct tty_struct *oldtty = info->port.tty; in loopback_test()
5231 u32 speed = info->params.clock_speed; in loopback_test()
5233 info->params.clock_speed = 3686400; in loopback_test()
5234 info->port.tty = NULL; in loopback_test()
5237 info->init_error = DiagStatus_DmaFailure; in loopback_test()
5243 memset(info->tmp_rx_buf,0,TESTFRAMESIZE); in loopback_test()
5246 spin_lock_irqsave(&info->lock,flags); in loopback_test()
5247 hdlc_mode(info); in loopback_test()
5248 enable_loopback(info,1); in loopback_test()
5249 rx_start(info); in loopback_test()
5250 info->tx_count = count; in loopback_test()
5251 tx_load_dma_buffer(info,buf,count); in loopback_test()
5252 tx_start(info); in loopback_test()
5253 spin_unlock_irqrestore(&info->lock,flags); in loopback_test()
5260 if (rx_get_frame(info)) { in loopback_test()
5268 ( info->tmp_rx_buf_count != count || in loopback_test()
5269 memcmp(buf, info->tmp_rx_buf,count))) { in loopback_test()
5273 spin_lock_irqsave(&info->lock,flags); in loopback_test()
5274 reset_adapter(info); in loopback_test()
5275 spin_unlock_irqrestore(&info->lock,flags); in loopback_test()
5277 info->params.clock_speed = speed; in loopback_test()
5278 info->port.tty = oldtty; in loopback_test()
5285 static int adapter_test( SLMP_INFO *info ) in adapter_test() argument
5290 __FILE__,__LINE__,info->device_name ); in adapter_test()
5292 spin_lock_irqsave(&info->lock,flags); in adapter_test()
5293 init_adapter(info); in adapter_test()
5294 spin_unlock_irqrestore(&info->lock,flags); in adapter_test()
5296 info->port_array[0]->port_count = 0; in adapter_test()
5298 if ( register_test(info->port_array[0]) && in adapter_test()
5299 register_test(info->port_array[1])) { in adapter_test()
5301 info->port_array[0]->port_count = 2; in adapter_test()
5303 if ( register_test(info->port_array[2]) && in adapter_test()
5304 register_test(info->port_array[3]) ) in adapter_test()
5305 info->port_array[0]->port_count += 2; in adapter_test()
5309 __FILE__,__LINE__,info->device_name, (unsigned long)(info->phys_sca_base)); in adapter_test()
5313 if ( !irq_test(info->port_array[0]) || in adapter_test()
5314 !irq_test(info->port_array[1]) || in adapter_test()
5315 (info->port_count == 4 && !irq_test(info->port_array[2])) || in adapter_test()
5316 (info->port_count == 4 && !irq_test(info->port_array[3]))) { in adapter_test()
5318 __FILE__,__LINE__,info->device_name, (unsigned short)(info->irq_level) ); in adapter_test()
5322 if (!loopback_test(info->port_array[0]) || in adapter_test()
5323 !loopback_test(info->port_array[1]) || in adapter_test()
5324 (info->port_count == 4 && !loopback_test(info->port_array[2])) || in adapter_test()
5325 (info->port_count == 4 && !loopback_test(info->port_array[3]))) { in adapter_test()
5327 __FILE__,__LINE__,info->device_name); in adapter_test()
5333 __FILE__,__LINE__,info->device_name ); in adapter_test()
5335 info->port_array[0]->init_error = 0; in adapter_test()
5336 info->port_array[1]->init_error = 0; in adapter_test()
5337 if ( info->port_count > 2 ) { in adapter_test()
5338 info->port_array[2]->init_error = 0; in adapter_test()
5339 info->port_array[3]->init_error = 0; in adapter_test()
5347 static bool memory_test(SLMP_INFO *info) in memory_test() argument
5354 unsigned long * addr = (unsigned long *)info->memory_base; in memory_test()
5372 addr = (unsigned long *)info->memory_base; in memory_test()
5380 memset( info->memory_base, 0, SCA_MEM_SIZE ); in memory_test()
5399 static void load_pci_memory(SLMP_INFO *info, char* dest, const char* src, unsigned short count) in load_pci_memory() argument
5410 read_status_reg(info); in load_pci_memory()
5418 static void trace_block(SLMP_INFO *info,const char* data, int count, int xmit) in trace_block() argument
5423 printk("%s tx data:\n",info->device_name); in trace_block()
5425 printk("%s rx data:\n",info->device_name); in trace_block()
5455 SLMP_INFO *info = from_timer(info, t, tx_timer); in tx_timeout() local
5460 __FILE__,__LINE__,info->device_name); in tx_timeout()
5461 if(info->tx_active && info->params.mode == MGSL_MODE_HDLC) { in tx_timeout()
5462 info->icount.txtimeout++; in tx_timeout()
5464 spin_lock_irqsave(&info->lock,flags); in tx_timeout()
5465 info->tx_active = false; in tx_timeout()
5466 info->tx_count = info->tx_put = info->tx_get = 0; in tx_timeout()
5468 spin_unlock_irqrestore(&info->lock,flags); in tx_timeout()
5471 if (info->netcount) in tx_timeout()
5472 hdlcdev_tx_done(info); in tx_timeout()
5475 bh_transmit(info); in tx_timeout()
5483 SLMP_INFO *info = from_timer(info, t, status_timer); in status_timeout() local
5488 spin_lock_irqsave(&info->lock,flags); in status_timeout()
5489 get_signals(info); in status_timeout()
5490 spin_unlock_irqrestore(&info->lock,flags); in status_timeout()
5494 delta = info->old_signals ^ info->serial_signals; in status_timeout()
5495 info->old_signals = info->serial_signals; in status_timeout()
5498 status |= MISCSTATUS_DSR_LATCHED|(info->serial_signals&SerialSignal_DSR); in status_timeout()
5501 status |= MISCSTATUS_RI_LATCHED|(info->serial_signals&SerialSignal_RI); in status_timeout()
5504 status |= MISCSTATUS_DCD_LATCHED|(info->serial_signals&SerialSignal_DCD); in status_timeout()
5507 status |= MISCSTATUS_CTS_LATCHED|(info->serial_signals&SerialSignal_CTS); in status_timeout()
5510 isr_io_pin(info,status); in status_timeout()
5512 mod_timer(&info->status_timer, jiffies + msecs_to_jiffies(10)); in status_timeout()
5520 unsigned char * RegAddr = (unsigned char*)(info->sca_base + Addr); \
5521 if (info->port_num > 1) \
5523 if ( info->port_num & 1) { \
5531 static unsigned char read_reg(SLMP_INFO * info, unsigned char Addr) in read_reg() argument
5536 static void write_reg(SLMP_INFO * info, unsigned char Addr, unsigned char Value) in write_reg() argument
5542 static u16 read_reg16(SLMP_INFO * info, unsigned char Addr) in read_reg16() argument
5548 static void write_reg16(SLMP_INFO * info, unsigned char Addr, u16 Value) in write_reg16() argument
5554 static unsigned char read_status_reg(SLMP_INFO * info) in read_status_reg() argument
5556 unsigned char *RegAddr = (unsigned char *)info->statctrl_base; in read_status_reg()
5560 static void write_control_reg(SLMP_INFO * info) in write_control_reg() argument
5562 unsigned char *RegAddr = (unsigned char *)info->statctrl_base; in write_control_reg()
5563 *RegAddr = info->port_array[0]->ctrlreg_value; in write_control_reg()