Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
1
fork

Configure Feed

Select the types of activity you want to include in your feed.

at v2.6.27-rc4 5633 lines 152 kB view raw
1/* 2 * $Id: synclinkmp.c,v 4.38 2005/07/15 13:29:44 paulkf Exp $ 3 * 4 * Device driver for Microgate SyncLink Multiport 5 * high speed multiprotocol serial adapter. 6 * 7 * written by Paul Fulghum for Microgate Corporation 8 * paulkf@microgate.com 9 * 10 * Microgate and SyncLink are trademarks of Microgate Corporation 11 * 12 * Derived from serial.c written by Theodore Ts'o and Linus Torvalds 13 * This code is released under the GNU General Public License (GPL) 14 * 15 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED 16 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 18 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 19 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 20 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 21 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 23 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 24 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED 25 * OF THE POSSIBILITY OF SUCH DAMAGE. 26 */ 27 28#define VERSION(ver,rel,seq) (((ver)<<16) | ((rel)<<8) | (seq)) 29#if defined(__i386__) 30# define BREAKPOINT() asm(" int $3"); 31#else 32# define BREAKPOINT() { } 33#endif 34 35#define MAX_DEVICES 12 36 37#include <linux/module.h> 38#include <linux/errno.h> 39#include <linux/signal.h> 40#include <linux/sched.h> 41#include <linux/timer.h> 42#include <linux/interrupt.h> 43#include <linux/pci.h> 44#include <linux/tty.h> 45#include <linux/tty_flip.h> 46#include <linux/serial.h> 47#include <linux/major.h> 48#include <linux/string.h> 49#include <linux/fcntl.h> 50#include <linux/ptrace.h> 51#include <linux/ioport.h> 52#include <linux/mm.h> 53#include <linux/slab.h> 54#include <linux/netdevice.h> 55#include <linux/vmalloc.h> 56#include <linux/init.h> 57#include <linux/delay.h> 58#include <linux/ioctl.h> 59 60#include <asm/system.h> 61#include <asm/io.h> 62#include <asm/irq.h> 63#include <asm/dma.h> 64#include <linux/bitops.h> 65#include <asm/types.h> 66#include <linux/termios.h> 67#include <linux/workqueue.h> 68#include <linux/hdlc.h> 69#include <linux/synclink.h> 70 71#if defined(CONFIG_HDLC) || (defined(CONFIG_HDLC_MODULE) && defined(CONFIG_SYNCLINKMP_MODULE)) 72#define SYNCLINK_GENERIC_HDLC 1 73#else 74#define SYNCLINK_GENERIC_HDLC 0 75#endif 76 77#define GET_USER(error,value,addr) error = get_user(value,addr) 78#define COPY_FROM_USER(error,dest,src,size) error = copy_from_user(dest,src,size) ? -EFAULT : 0 79#define PUT_USER(error,value,addr) error = put_user(value,addr) 80#define COPY_TO_USER(error,dest,src,size) error = copy_to_user(dest,src,size) ? -EFAULT : 0 81 82#include <asm/uaccess.h> 83 84static MGSL_PARAMS default_params = { 85 MGSL_MODE_HDLC, /* unsigned long mode */ 86 0, /* unsigned char loopback; */ 87 HDLC_FLAG_UNDERRUN_ABORT15, /* unsigned short flags; */ 88 HDLC_ENCODING_NRZI_SPACE, /* unsigned char encoding; */ 89 0, /* unsigned long clock_speed; */ 90 0xff, /* unsigned char addr_filter; */ 91 HDLC_CRC_16_CCITT, /* unsigned short crc_type; */ 92 HDLC_PREAMBLE_LENGTH_8BITS, /* unsigned char preamble_length; */ 93 HDLC_PREAMBLE_PATTERN_NONE, /* unsigned char preamble; */ 94 9600, /* unsigned long data_rate; */ 95 8, /* unsigned char data_bits; */ 96 1, /* unsigned char stop_bits; */ 97 ASYNC_PARITY_NONE /* unsigned char parity; */ 98}; 99 100/* size in bytes of DMA data buffers */ 101#define SCABUFSIZE 1024 102#define SCA_MEM_SIZE 0x40000 103#define SCA_BASE_SIZE 512 104#define SCA_REG_SIZE 16 105#define SCA_MAX_PORTS 4 106#define SCAMAXDESC 128 107 108#define BUFFERLISTSIZE 4096 109 110/* SCA-I style DMA buffer descriptor */ 111typedef struct _SCADESC 112{ 113 u16 next; /* lower l6 bits of next descriptor addr */ 114 u16 buf_ptr; /* lower 16 bits of buffer addr */ 115 u8 buf_base; /* upper 8 bits of buffer addr */ 116 u8 pad1; 117 u16 length; /* length of buffer */ 118 u8 status; /* status of buffer */ 119 u8 pad2; 120} SCADESC, *PSCADESC; 121 122typedef struct _SCADESC_EX 123{ 124 /* device driver bookkeeping section */ 125 char *virt_addr; /* virtual address of data buffer */ 126 u16 phys_entry; /* lower 16-bits of physical address of this descriptor */ 127} SCADESC_EX, *PSCADESC_EX; 128 129/* The queue of BH actions to be performed */ 130 131#define BH_RECEIVE 1 132#define BH_TRANSMIT 2 133#define BH_STATUS 4 134 135#define IO_PIN_SHUTDOWN_LIMIT 100 136 137struct _input_signal_events { 138 int ri_up; 139 int ri_down; 140 int dsr_up; 141 int dsr_down; 142 int dcd_up; 143 int dcd_down; 144 int cts_up; 145 int cts_down; 146}; 147 148/* 149 * Device instance data structure 150 */ 151typedef struct _synclinkmp_info { 152 void *if_ptr; /* General purpose pointer (used by SPPP) */ 153 int magic; 154 struct tty_port port; 155 int line; 156 unsigned short close_delay; 157 unsigned short closing_wait; /* time to wait before closing */ 158 159 struct mgsl_icount icount; 160 161 int timeout; 162 int x_char; /* xon/xoff character */ 163 u16 read_status_mask1; /* break detection (SR1 indications) */ 164 u16 read_status_mask2; /* parity/framing/overun (SR2 indications) */ 165 unsigned char ignore_status_mask1; /* break detection (SR1 indications) */ 166 unsigned char ignore_status_mask2; /* parity/framing/overun (SR2 indications) */ 167 unsigned char *tx_buf; 168 int tx_put; 169 int tx_get; 170 int tx_count; 171 172 wait_queue_head_t status_event_wait_q; 173 wait_queue_head_t event_wait_q; 174 struct timer_list tx_timer; /* HDLC transmit timeout timer */ 175 struct _synclinkmp_info *next_device; /* device list link */ 176 struct timer_list status_timer; /* input signal status check timer */ 177 178 spinlock_t lock; /* spinlock for synchronizing with ISR */ 179 struct work_struct task; /* task structure for scheduling bh */ 180 181 u32 max_frame_size; /* as set by device config */ 182 183 u32 pending_bh; 184 185 bool bh_running; /* Protection from multiple */ 186 int isr_overflow; 187 bool bh_requested; 188 189 int dcd_chkcount; /* check counts to prevent */ 190 int cts_chkcount; /* too many IRQs if a signal */ 191 int dsr_chkcount; /* is floating */ 192 int ri_chkcount; 193 194 char *buffer_list; /* virtual address of Rx & Tx buffer lists */ 195 unsigned long buffer_list_phys; 196 197 unsigned int rx_buf_count; /* count of total allocated Rx buffers */ 198 SCADESC *rx_buf_list; /* list of receive buffer entries */ 199 SCADESC_EX rx_buf_list_ex[SCAMAXDESC]; /* list of receive buffer entries */ 200 unsigned int current_rx_buf; 201 202 unsigned int tx_buf_count; /* count of total allocated Tx buffers */ 203 SCADESC *tx_buf_list; /* list of transmit buffer entries */ 204 SCADESC_EX tx_buf_list_ex[SCAMAXDESC]; /* list of transmit buffer entries */ 205 unsigned int last_tx_buf; 206 207 unsigned char *tmp_rx_buf; 208 unsigned int tmp_rx_buf_count; 209 210 bool rx_enabled; 211 bool rx_overflow; 212 213 bool tx_enabled; 214 bool tx_active; 215 u32 idle_mode; 216 217 unsigned char ie0_value; 218 unsigned char ie1_value; 219 unsigned char ie2_value; 220 unsigned char ctrlreg_value; 221 unsigned char old_signals; 222 223 char device_name[25]; /* device instance name */ 224 225 int port_count; 226 int adapter_num; 227 int port_num; 228 229 struct _synclinkmp_info *port_array[SCA_MAX_PORTS]; 230 231 unsigned int bus_type; /* expansion bus type (ISA,EISA,PCI) */ 232 233 unsigned int irq_level; /* interrupt level */ 234 unsigned long irq_flags; 235 bool irq_requested; /* true if IRQ requested */ 236 237 MGSL_PARAMS params; /* communications parameters */ 238 239 unsigned char serial_signals; /* current serial signal states */ 240 241 bool irq_occurred; /* for diagnostics use */ 242 unsigned int init_error; /* Initialization startup error */ 243 244 u32 last_mem_alloc; 245 unsigned char* memory_base; /* shared memory address (PCI only) */ 246 u32 phys_memory_base; 247 int shared_mem_requested; 248 249 unsigned char* sca_base; /* HD64570 SCA Memory address */ 250 u32 phys_sca_base; 251 u32 sca_offset; 252 bool sca_base_requested; 253 254 unsigned char* lcr_base; /* local config registers (PCI only) */ 255 u32 phys_lcr_base; 256 u32 lcr_offset; 257 int lcr_mem_requested; 258 259 unsigned char* statctrl_base; /* status/control register memory */ 260 u32 phys_statctrl_base; 261 u32 statctrl_offset; 262 bool sca_statctrl_requested; 263 264 u32 misc_ctrl_value; 265 char flag_buf[MAX_ASYNC_BUFFER_SIZE]; 266 char char_buf[MAX_ASYNC_BUFFER_SIZE]; 267 bool drop_rts_on_tx_done; 268 269 struct _input_signal_events input_signal_events; 270 271 /* SPPP/Cisco HDLC device parts */ 272 int netcount; 273 spinlock_t netlock; 274 275#if SYNCLINK_GENERIC_HDLC 276 struct net_device *netdev; 277#endif 278 279} SLMP_INFO; 280 281#define MGSL_MAGIC 0x5401 282 283/* 284 * define serial signal status change macros 285 */ 286#define MISCSTATUS_DCD_LATCHED (SerialSignal_DCD<<8) /* indicates change in DCD */ 287#define MISCSTATUS_RI_LATCHED (SerialSignal_RI<<8) /* indicates change in RI */ 288#define MISCSTATUS_CTS_LATCHED (SerialSignal_CTS<<8) /* indicates change in CTS */ 289#define MISCSTATUS_DSR_LATCHED (SerialSignal_DSR<<8) /* change in DSR */ 290 291/* Common Register macros */ 292#define LPR 0x00 293#define PABR0 0x02 294#define PABR1 0x03 295#define WCRL 0x04 296#define WCRM 0x05 297#define WCRH 0x06 298#define DPCR 0x08 299#define DMER 0x09 300#define ISR0 0x10 301#define ISR1 0x11 302#define ISR2 0x12 303#define IER0 0x14 304#define IER1 0x15 305#define IER2 0x16 306#define ITCR 0x18 307#define INTVR 0x1a 308#define IMVR 0x1c 309 310/* MSCI Register macros */ 311#define TRB 0x20 312#define TRBL 0x20 313#define TRBH 0x21 314#define SR0 0x22 315#define SR1 0x23 316#define SR2 0x24 317#define SR3 0x25 318#define FST 0x26 319#define IE0 0x28 320#define IE1 0x29 321#define IE2 0x2a 322#define FIE 0x2b 323#define CMD 0x2c 324#define MD0 0x2e 325#define MD1 0x2f 326#define MD2 0x30 327#define CTL 0x31 328#define SA0 0x32 329#define SA1 0x33 330#define IDL 0x34 331#define TMC 0x35 332#define RXS 0x36 333#define TXS 0x37 334#define TRC0 0x38 335#define TRC1 0x39 336#define RRC 0x3a 337#define CST0 0x3c 338#define CST1 0x3d 339 340/* Timer Register Macros */ 341#define TCNT 0x60 342#define TCNTL 0x60 343#define TCNTH 0x61 344#define TCONR 0x62 345#define TCONRL 0x62 346#define TCONRH 0x63 347#define TMCS 0x64 348#define TEPR 0x65 349 350/* DMA Controller Register macros */ 351#define DARL 0x80 352#define DARH 0x81 353#define DARB 0x82 354#define BAR 0x80 355#define BARL 0x80 356#define BARH 0x81 357#define BARB 0x82 358#define SAR 0x84 359#define SARL 0x84 360#define SARH 0x85 361#define SARB 0x86 362#define CPB 0x86 363#define CDA 0x88 364#define CDAL 0x88 365#define CDAH 0x89 366#define EDA 0x8a 367#define EDAL 0x8a 368#define EDAH 0x8b 369#define BFL 0x8c 370#define BFLL 0x8c 371#define BFLH 0x8d 372#define BCR 0x8e 373#define BCRL 0x8e 374#define BCRH 0x8f 375#define DSR 0x90 376#define DMR 0x91 377#define FCT 0x93 378#define DIR 0x94 379#define DCMD 0x95 380 381/* combine with timer or DMA register address */ 382#define TIMER0 0x00 383#define TIMER1 0x08 384#define TIMER2 0x10 385#define TIMER3 0x18 386#define RXDMA 0x00 387#define TXDMA 0x20 388 389/* SCA Command Codes */ 390#define NOOP 0x00 391#define TXRESET 0x01 392#define TXENABLE 0x02 393#define TXDISABLE 0x03 394#define TXCRCINIT 0x04 395#define TXCRCEXCL 0x05 396#define TXEOM 0x06 397#define TXABORT 0x07 398#define MPON 0x08 399#define TXBUFCLR 0x09 400#define RXRESET 0x11 401#define RXENABLE 0x12 402#define RXDISABLE 0x13 403#define RXCRCINIT 0x14 404#define RXREJECT 0x15 405#define SEARCHMP 0x16 406#define RXCRCEXCL 0x17 407#define RXCRCCALC 0x18 408#define CHRESET 0x21 409#define HUNT 0x31 410 411/* DMA command codes */ 412#define SWABORT 0x01 413#define FEICLEAR 0x02 414 415/* IE0 */ 416#define TXINTE BIT7 417#define RXINTE BIT6 418#define TXRDYE BIT1 419#define RXRDYE BIT0 420 421/* IE1 & SR1 */ 422#define UDRN BIT7 423#define IDLE BIT6 424#define SYNCD BIT4 425#define FLGD BIT4 426#define CCTS BIT3 427#define CDCD BIT2 428#define BRKD BIT1 429#define ABTD BIT1 430#define GAPD BIT1 431#define BRKE BIT0 432#define IDLD BIT0 433 434/* IE2 & SR2 */ 435#define EOM BIT7 436#define PMP BIT6 437#define SHRT BIT6 438#define PE BIT5 439#define ABT BIT5 440#define FRME BIT4 441#define RBIT BIT4 442#define OVRN BIT3 443#define CRCE BIT2 444 445 446/* 447 * Global linked list of SyncLink devices 448 */ 449static SLMP_INFO *synclinkmp_device_list = NULL; 450static int synclinkmp_adapter_count = -1; 451static int synclinkmp_device_count = 0; 452 453/* 454 * Set this param to non-zero to load eax with the 455 * .text section address and breakpoint on module load. 456 * This is useful for use with gdb and add-symbol-file command. 457 */ 458static int break_on_load = 0; 459 460/* 461 * Driver major number, defaults to zero to get auto 462 * assigned major number. May be forced as module parameter. 463 */ 464static int ttymajor = 0; 465 466/* 467 * Array of user specified options for ISA adapters. 468 */ 469static int debug_level = 0; 470static int maxframe[MAX_DEVICES] = {0,}; 471 472module_param(break_on_load, bool, 0); 473module_param(ttymajor, int, 0); 474module_param(debug_level, int, 0); 475module_param_array(maxframe, int, NULL, 0); 476 477static char *driver_name = "SyncLink MultiPort driver"; 478static char *driver_version = "$Revision: 4.38 $"; 479 480static int synclinkmp_init_one(struct pci_dev *dev,const struct pci_device_id *ent); 481static void synclinkmp_remove_one(struct pci_dev *dev); 482 483static struct pci_device_id synclinkmp_pci_tbl[] = { 484 { PCI_VENDOR_ID_MICROGATE, PCI_DEVICE_ID_MICROGATE_SCA, PCI_ANY_ID, PCI_ANY_ID, }, 485 { 0, }, /* terminate list */ 486}; 487MODULE_DEVICE_TABLE(pci, synclinkmp_pci_tbl); 488 489MODULE_LICENSE("GPL"); 490 491static struct pci_driver synclinkmp_pci_driver = { 492 .name = "synclinkmp", 493 .id_table = synclinkmp_pci_tbl, 494 .probe = synclinkmp_init_one, 495 .remove = __devexit_p(synclinkmp_remove_one), 496}; 497 498 499static struct tty_driver *serial_driver; 500 501/* number of characters left in xmit buffer before we ask for more */ 502#define WAKEUP_CHARS 256 503 504 505/* tty callbacks */ 506 507static int open(struct tty_struct *tty, struct file * filp); 508static void close(struct tty_struct *tty, struct file * filp); 509static void hangup(struct tty_struct *tty); 510static void set_termios(struct tty_struct *tty, struct ktermios *old_termios); 511 512static int write(struct tty_struct *tty, const unsigned char *buf, int count); 513static int put_char(struct tty_struct *tty, unsigned char ch); 514static void send_xchar(struct tty_struct *tty, char ch); 515static void wait_until_sent(struct tty_struct *tty, int timeout); 516static int write_room(struct tty_struct *tty); 517static void flush_chars(struct tty_struct *tty); 518static void flush_buffer(struct tty_struct *tty); 519static void tx_hold(struct tty_struct *tty); 520static void tx_release(struct tty_struct *tty); 521 522static int ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg); 523static int read_proc(char *page, char **start, off_t off, int count,int *eof, void *data); 524static int chars_in_buffer(struct tty_struct *tty); 525static void throttle(struct tty_struct * tty); 526static void unthrottle(struct tty_struct * tty); 527static int set_break(struct tty_struct *tty, int break_state); 528 529#if SYNCLINK_GENERIC_HDLC 530#define dev_to_port(D) (dev_to_hdlc(D)->priv) 531static void hdlcdev_tx_done(SLMP_INFO *info); 532static void hdlcdev_rx(SLMP_INFO *info, char *buf, int size); 533static int hdlcdev_init(SLMP_INFO *info); 534static void hdlcdev_exit(SLMP_INFO *info); 535#endif 536 537/* ioctl handlers */ 538 539static int get_stats(SLMP_INFO *info, struct mgsl_icount __user *user_icount); 540static int get_params(SLMP_INFO *info, MGSL_PARAMS __user *params); 541static int set_params(SLMP_INFO *info, MGSL_PARAMS __user *params); 542static int get_txidle(SLMP_INFO *info, int __user *idle_mode); 543static int set_txidle(SLMP_INFO *info, int idle_mode); 544static int tx_enable(SLMP_INFO *info, int enable); 545static int tx_abort(SLMP_INFO *info); 546static int rx_enable(SLMP_INFO *info, int enable); 547static int modem_input_wait(SLMP_INFO *info,int arg); 548static int wait_mgsl_event(SLMP_INFO *info, int __user *mask_ptr); 549static int tiocmget(struct tty_struct *tty, struct file *file); 550static int tiocmset(struct tty_struct *tty, struct file *file, 551 unsigned int set, unsigned int clear); 552static int set_break(struct tty_struct *tty, int break_state); 553 554static void add_device(SLMP_INFO *info); 555static void device_init(int adapter_num, struct pci_dev *pdev); 556static int claim_resources(SLMP_INFO *info); 557static void release_resources(SLMP_INFO *info); 558 559static int startup(SLMP_INFO *info); 560static int block_til_ready(struct tty_struct *tty, struct file * filp,SLMP_INFO *info); 561static void shutdown(SLMP_INFO *info); 562static void program_hw(SLMP_INFO *info); 563static void change_params(SLMP_INFO *info); 564 565static bool init_adapter(SLMP_INFO *info); 566static bool register_test(SLMP_INFO *info); 567static bool irq_test(SLMP_INFO *info); 568static bool loopback_test(SLMP_INFO *info); 569static int adapter_test(SLMP_INFO *info); 570static bool memory_test(SLMP_INFO *info); 571 572static void reset_adapter(SLMP_INFO *info); 573static void reset_port(SLMP_INFO *info); 574static void async_mode(SLMP_INFO *info); 575static void hdlc_mode(SLMP_INFO *info); 576 577static void rx_stop(SLMP_INFO *info); 578static void rx_start(SLMP_INFO *info); 579static void rx_reset_buffers(SLMP_INFO *info); 580static void rx_free_frame_buffers(SLMP_INFO *info, unsigned int first, unsigned int last); 581static bool rx_get_frame(SLMP_INFO *info); 582 583static void tx_start(SLMP_INFO *info); 584static void tx_stop(SLMP_INFO *info); 585static void tx_load_fifo(SLMP_INFO *info); 586static void tx_set_idle(SLMP_INFO *info); 587static void tx_load_dma_buffer(SLMP_INFO *info, const char *buf, unsigned int count); 588 589static void get_signals(SLMP_INFO *info); 590static void set_signals(SLMP_INFO *info); 591static void enable_loopback(SLMP_INFO *info, int enable); 592static void set_rate(SLMP_INFO *info, u32 data_rate); 593 594static int bh_action(SLMP_INFO *info); 595static void bh_handler(struct work_struct *work); 596static void bh_receive(SLMP_INFO *info); 597static void bh_transmit(SLMP_INFO *info); 598static void bh_status(SLMP_INFO *info); 599static void isr_timer(SLMP_INFO *info); 600static void isr_rxint(SLMP_INFO *info); 601static void isr_rxrdy(SLMP_INFO *info); 602static void isr_txint(SLMP_INFO *info); 603static void isr_txrdy(SLMP_INFO *info); 604static void isr_rxdmaok(SLMP_INFO *info); 605static void isr_rxdmaerror(SLMP_INFO *info); 606static void isr_txdmaok(SLMP_INFO *info); 607static void isr_txdmaerror(SLMP_INFO *info); 608static void isr_io_pin(SLMP_INFO *info, u16 status); 609 610static int alloc_dma_bufs(SLMP_INFO *info); 611static void free_dma_bufs(SLMP_INFO *info); 612static int alloc_buf_list(SLMP_INFO *info); 613static int alloc_frame_bufs(SLMP_INFO *info, SCADESC *list, SCADESC_EX *list_ex,int count); 614static int alloc_tmp_rx_buf(SLMP_INFO *info); 615static void free_tmp_rx_buf(SLMP_INFO *info); 616 617static void load_pci_memory(SLMP_INFO *info, char* dest, const char* src, unsigned short count); 618static void trace_block(SLMP_INFO *info, const char* data, int count, int xmit); 619static void tx_timeout(unsigned long context); 620static void status_timeout(unsigned long context); 621 622static unsigned char read_reg(SLMP_INFO *info, unsigned char addr); 623static void write_reg(SLMP_INFO *info, unsigned char addr, unsigned char val); 624static u16 read_reg16(SLMP_INFO *info, unsigned char addr); 625static void write_reg16(SLMP_INFO *info, unsigned char addr, u16 val); 626static unsigned char read_status_reg(SLMP_INFO * info); 627static void write_control_reg(SLMP_INFO * info); 628 629 630static unsigned char rx_active_fifo_level = 16; // rx request FIFO activation level in bytes 631static unsigned char tx_active_fifo_level = 16; // tx request FIFO activation level in bytes 632static unsigned char tx_negate_fifo_level = 32; // tx request FIFO negation level in bytes 633 634static u32 misc_ctrl_value = 0x007e4040; 635static u32 lcr1_brdr_value = 0x00800028; 636 637static u32 read_ahead_count = 8; 638 639/* DPCR, DMA Priority Control 640 * 641 * 07..05 Not used, must be 0 642 * 04 BRC, bus release condition: 0=all transfers complete 643 * 1=release after 1 xfer on all channels 644 * 03 CCC, channel change condition: 0=every cycle 645 * 1=after each channel completes all xfers 646 * 02..00 PR<2..0>, priority 100=round robin 647 * 648 * 00000100 = 0x00 649 */ 650static unsigned char dma_priority = 0x04; 651 652// Number of bytes that can be written to shared RAM 653// in a single write operation 654static u32 sca_pci_load_interval = 64; 655 656/* 657 * 1st function defined in .text section. Calling this function in 658 * init_module() followed by a breakpoint allows a remote debugger 659 * (gdb) to get the .text address for the add-symbol-file command. 660 * This allows remote debugging of dynamically loadable modules. 661 */ 662static void* synclinkmp_get_text_ptr(void); 663static void* synclinkmp_get_text_ptr(void) {return synclinkmp_get_text_ptr;} 664 665static inline int sanity_check(SLMP_INFO *info, 666 char *name, const char *routine) 667{ 668#ifdef SANITY_CHECK 669 static const char *badmagic = 670 "Warning: bad magic number for synclinkmp_struct (%s) in %s\n"; 671 static const char *badinfo = 672 "Warning: null synclinkmp_struct for (%s) in %s\n"; 673 674 if (!info) { 675 printk(badinfo, name, routine); 676 return 1; 677 } 678 if (info->magic != MGSL_MAGIC) { 679 printk(badmagic, name, routine); 680 return 1; 681 } 682#else 683 if (!info) 684 return 1; 685#endif 686 return 0; 687} 688 689/** 690 * line discipline callback wrappers 691 * 692 * The wrappers maintain line discipline references 693 * while calling into the line discipline. 694 * 695 * ldisc_receive_buf - pass receive data to line discipline 696 */ 697 698static void ldisc_receive_buf(struct tty_struct *tty, 699 const __u8 *data, char *flags, int count) 700{ 701 struct tty_ldisc *ld; 702 if (!tty) 703 return; 704 ld = tty_ldisc_ref(tty); 705 if (ld) { 706 if (ld->ops->receive_buf) 707 ld->ops->receive_buf(tty, data, flags, count); 708 tty_ldisc_deref(ld); 709 } 710} 711 712/* tty callbacks */ 713 714/* Called when a port is opened. Init and enable port. 715 */ 716static int open(struct tty_struct *tty, struct file *filp) 717{ 718 SLMP_INFO *info; 719 int retval, line; 720 unsigned long flags; 721 722 line = tty->index; 723 if ((line < 0) || (line >= synclinkmp_device_count)) { 724 printk("%s(%d): open with invalid line #%d.\n", 725 __FILE__,__LINE__,line); 726 return -ENODEV; 727 } 728 729 info = synclinkmp_device_list; 730 while(info && info->line != line) 731 info = info->next_device; 732 if (sanity_check(info, tty->name, "open")) 733 return -ENODEV; 734 if ( info->init_error ) { 735 printk("%s(%d):%s device is not allocated, init error=%d\n", 736 __FILE__,__LINE__,info->device_name,info->init_error); 737 return -ENODEV; 738 } 739 740 tty->driver_data = info; 741 info->port.tty = tty; 742 743 if (debug_level >= DEBUG_LEVEL_INFO) 744 printk("%s(%d):%s open(), old ref count = %d\n", 745 __FILE__,__LINE__,tty->driver->name, info->port.count); 746 747 /* If port is closing, signal caller to try again */ 748 if (tty_hung_up_p(filp) || info->port.flags & ASYNC_CLOSING){ 749 if (info->port.flags & ASYNC_CLOSING) 750 interruptible_sleep_on(&info->port.close_wait); 751 retval = ((info->port.flags & ASYNC_HUP_NOTIFY) ? 752 -EAGAIN : -ERESTARTSYS); 753 goto cleanup; 754 } 755 756 info->port.tty->low_latency = (info->port.flags & ASYNC_LOW_LATENCY) ? 1 : 0; 757 758 spin_lock_irqsave(&info->netlock, flags); 759 if (info->netcount) { 760 retval = -EBUSY; 761 spin_unlock_irqrestore(&info->netlock, flags); 762 goto cleanup; 763 } 764 info->port.count++; 765 spin_unlock_irqrestore(&info->netlock, flags); 766 767 if (info->port.count == 1) { 768 /* 1st open on this device, init hardware */ 769 retval = startup(info); 770 if (retval < 0) 771 goto cleanup; 772 } 773 774 retval = block_til_ready(tty, filp, info); 775 if (retval) { 776 if (debug_level >= DEBUG_LEVEL_INFO) 777 printk("%s(%d):%s block_til_ready() returned %d\n", 778 __FILE__,__LINE__, info->device_name, retval); 779 goto cleanup; 780 } 781 782 if (debug_level >= DEBUG_LEVEL_INFO) 783 printk("%s(%d):%s open() success\n", 784 __FILE__,__LINE__, info->device_name); 785 retval = 0; 786 787cleanup: 788 if (retval) { 789 if (tty->count == 1) 790 info->port.tty = NULL; /* tty layer will release tty struct */ 791 if(info->port.count) 792 info->port.count--; 793 } 794 795 return retval; 796} 797 798/* Called when port is closed. Wait for remaining data to be 799 * sent. Disable port and free resources. 800 */ 801static void close(struct tty_struct *tty, struct file *filp) 802{ 803 SLMP_INFO * info = (SLMP_INFO *)tty->driver_data; 804 805 if (sanity_check(info, tty->name, "close")) 806 return; 807 808 if (debug_level >= DEBUG_LEVEL_INFO) 809 printk("%s(%d):%s close() entry, count=%d\n", 810 __FILE__,__LINE__, info->device_name, info->port.count); 811 812 if (!info->port.count) 813 return; 814 815 if (tty_hung_up_p(filp)) 816 goto cleanup; 817 818 if ((tty->count == 1) && (info->port.count != 1)) { 819 /* 820 * tty->count is 1 and the tty structure will be freed. 821 * info->port.count should be one in this case. 822 * if it's not, correct it so that the port is shutdown. 823 */ 824 printk("%s(%d):%s close: bad refcount; tty->count is 1, " 825 "info->port.count is %d\n", 826 __FILE__,__LINE__, info->device_name, info->port.count); 827 info->port.count = 1; 828 } 829 830 info->port.count--; 831 832 /* if at least one open remaining, leave hardware active */ 833 if (info->port.count) 834 goto cleanup; 835 836 info->port.flags |= ASYNC_CLOSING; 837 838 /* set tty->closing to notify line discipline to 839 * only process XON/XOFF characters. Only the N_TTY 840 * discipline appears to use this (ppp does not). 841 */ 842 tty->closing = 1; 843 844 /* wait for transmit data to clear all layers */ 845 846 if (info->port.closing_wait != ASYNC_CLOSING_WAIT_NONE) { 847 if (debug_level >= DEBUG_LEVEL_INFO) 848 printk("%s(%d):%s close() calling tty_wait_until_sent\n", 849 __FILE__,__LINE__, info->device_name ); 850 tty_wait_until_sent(tty, info->port.closing_wait); 851 } 852 853 if (info->port.flags & ASYNC_INITIALIZED) 854 wait_until_sent(tty, info->timeout); 855 856 flush_buffer(tty); 857 858 tty_ldisc_flush(tty); 859 860 shutdown(info); 861 862 tty->closing = 0; 863 info->port.tty = NULL; 864 865 if (info->port.blocked_open) { 866 if (info->port.close_delay) { 867 msleep_interruptible(jiffies_to_msecs(info->port.close_delay)); 868 } 869 wake_up_interruptible(&info->port.open_wait); 870 } 871 872 info->port.flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING); 873 874 wake_up_interruptible(&info->port.close_wait); 875 876cleanup: 877 if (debug_level >= DEBUG_LEVEL_INFO) 878 printk("%s(%d):%s close() exit, count=%d\n", __FILE__,__LINE__, 879 tty->driver->name, info->port.count); 880} 881 882/* Called by tty_hangup() when a hangup is signaled. 883 * This is the same as closing all open descriptors for the port. 884 */ 885static void hangup(struct tty_struct *tty) 886{ 887 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 888 889 if (debug_level >= DEBUG_LEVEL_INFO) 890 printk("%s(%d):%s hangup()\n", 891 __FILE__,__LINE__, info->device_name ); 892 893 if (sanity_check(info, tty->name, "hangup")) 894 return; 895 896 flush_buffer(tty); 897 shutdown(info); 898 899 info->port.count = 0; 900 info->port.flags &= ~ASYNC_NORMAL_ACTIVE; 901 info->port.tty = NULL; 902 903 wake_up_interruptible(&info->port.open_wait); 904} 905 906/* Set new termios settings 907 */ 908static void set_termios(struct tty_struct *tty, struct ktermios *old_termios) 909{ 910 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 911 unsigned long flags; 912 913 if (debug_level >= DEBUG_LEVEL_INFO) 914 printk("%s(%d):%s set_termios()\n", __FILE__,__LINE__, 915 tty->driver->name ); 916 917 change_params(info); 918 919 /* Handle transition to B0 status */ 920 if (old_termios->c_cflag & CBAUD && 921 !(tty->termios->c_cflag & CBAUD)) { 922 info->serial_signals &= ~(SerialSignal_RTS + SerialSignal_DTR); 923 spin_lock_irqsave(&info->lock,flags); 924 set_signals(info); 925 spin_unlock_irqrestore(&info->lock,flags); 926 } 927 928 /* Handle transition away from B0 status */ 929 if (!(old_termios->c_cflag & CBAUD) && 930 tty->termios->c_cflag & CBAUD) { 931 info->serial_signals |= SerialSignal_DTR; 932 if (!(tty->termios->c_cflag & CRTSCTS) || 933 !test_bit(TTY_THROTTLED, &tty->flags)) { 934 info->serial_signals |= SerialSignal_RTS; 935 } 936 spin_lock_irqsave(&info->lock,flags); 937 set_signals(info); 938 spin_unlock_irqrestore(&info->lock,flags); 939 } 940 941 /* Handle turning off CRTSCTS */ 942 if (old_termios->c_cflag & CRTSCTS && 943 !(tty->termios->c_cflag & CRTSCTS)) { 944 tty->hw_stopped = 0; 945 tx_release(tty); 946 } 947} 948 949/* Send a block of data 950 * 951 * Arguments: 952 * 953 * tty pointer to tty information structure 954 * buf pointer to buffer containing send data 955 * count size of send data in bytes 956 * 957 * Return Value: number of characters written 958 */ 959static int write(struct tty_struct *tty, 960 const unsigned char *buf, int count) 961{ 962 int c, ret = 0; 963 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 964 unsigned long flags; 965 966 if (debug_level >= DEBUG_LEVEL_INFO) 967 printk("%s(%d):%s write() count=%d\n", 968 __FILE__,__LINE__,info->device_name,count); 969 970 if (sanity_check(info, tty->name, "write")) 971 goto cleanup; 972 973 if (!info->tx_buf) 974 goto cleanup; 975 976 if (info->params.mode == MGSL_MODE_HDLC) { 977 if (count > info->max_frame_size) { 978 ret = -EIO; 979 goto cleanup; 980 } 981 if (info->tx_active) 982 goto cleanup; 983 if (info->tx_count) { 984 /* send accumulated data from send_char() calls */ 985 /* as frame and wait before accepting more data. */ 986 tx_load_dma_buffer(info, info->tx_buf, info->tx_count); 987 goto start; 988 } 989 ret = info->tx_count = count; 990 tx_load_dma_buffer(info, buf, count); 991 goto start; 992 } 993 994 for (;;) { 995 c = min_t(int, count, 996 min(info->max_frame_size - info->tx_count - 1, 997 info->max_frame_size - info->tx_put)); 998 if (c <= 0) 999 break; 1000 1001 memcpy(info->tx_buf + info->tx_put, buf, c); 1002 1003 spin_lock_irqsave(&info->lock,flags); 1004 info->tx_put += c; 1005 if (info->tx_put >= info->max_frame_size) 1006 info->tx_put -= info->max_frame_size; 1007 info->tx_count += c; 1008 spin_unlock_irqrestore(&info->lock,flags); 1009 1010 buf += c; 1011 count -= c; 1012 ret += c; 1013 } 1014 1015 if (info->params.mode == MGSL_MODE_HDLC) { 1016 if (count) { 1017 ret = info->tx_count = 0; 1018 goto cleanup; 1019 } 1020 tx_load_dma_buffer(info, info->tx_buf, info->tx_count); 1021 } 1022start: 1023 if (info->tx_count && !tty->stopped && !tty->hw_stopped) { 1024 spin_lock_irqsave(&info->lock,flags); 1025 if (!info->tx_active) 1026 tx_start(info); 1027 spin_unlock_irqrestore(&info->lock,flags); 1028 } 1029 1030cleanup: 1031 if (debug_level >= DEBUG_LEVEL_INFO) 1032 printk( "%s(%d):%s write() returning=%d\n", 1033 __FILE__,__LINE__,info->device_name,ret); 1034 return ret; 1035} 1036 1037/* Add a character to the transmit buffer. 1038 */ 1039static int put_char(struct tty_struct *tty, unsigned char ch) 1040{ 1041 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1042 unsigned long flags; 1043 int ret = 0; 1044 1045 if ( debug_level >= DEBUG_LEVEL_INFO ) { 1046 printk( "%s(%d):%s put_char(%d)\n", 1047 __FILE__,__LINE__,info->device_name,ch); 1048 } 1049 1050 if (sanity_check(info, tty->name, "put_char")) 1051 return 0; 1052 1053 if (!info->tx_buf) 1054 return 0; 1055 1056 spin_lock_irqsave(&info->lock,flags); 1057 1058 if ( (info->params.mode != MGSL_MODE_HDLC) || 1059 !info->tx_active ) { 1060 1061 if (info->tx_count < info->max_frame_size - 1) { 1062 info->tx_buf[info->tx_put++] = ch; 1063 if (info->tx_put >= info->max_frame_size) 1064 info->tx_put -= info->max_frame_size; 1065 info->tx_count++; 1066 ret = 1; 1067 } 1068 } 1069 1070 spin_unlock_irqrestore(&info->lock,flags); 1071 return ret; 1072} 1073 1074/* Send a high-priority XON/XOFF character 1075 */ 1076static void send_xchar(struct tty_struct *tty, char ch) 1077{ 1078 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1079 unsigned long flags; 1080 1081 if (debug_level >= DEBUG_LEVEL_INFO) 1082 printk("%s(%d):%s send_xchar(%d)\n", 1083 __FILE__,__LINE__, info->device_name, ch ); 1084 1085 if (sanity_check(info, tty->name, "send_xchar")) 1086 return; 1087 1088 info->x_char = ch; 1089 if (ch) { 1090 /* Make sure transmit interrupts are on */ 1091 spin_lock_irqsave(&info->lock,flags); 1092 if (!info->tx_enabled) 1093 tx_start(info); 1094 spin_unlock_irqrestore(&info->lock,flags); 1095 } 1096} 1097 1098/* Wait until the transmitter is empty. 1099 */ 1100static void wait_until_sent(struct tty_struct *tty, int timeout) 1101{ 1102 SLMP_INFO * info = (SLMP_INFO *)tty->driver_data; 1103 unsigned long orig_jiffies, char_time; 1104 1105 if (!info ) 1106 return; 1107 1108 if (debug_level >= DEBUG_LEVEL_INFO) 1109 printk("%s(%d):%s wait_until_sent() entry\n", 1110 __FILE__,__LINE__, info->device_name ); 1111 1112 if (sanity_check(info, tty->name, "wait_until_sent")) 1113 return; 1114 1115 lock_kernel(); 1116 1117 if (!(info->port.flags & ASYNC_INITIALIZED)) 1118 goto exit; 1119 1120 orig_jiffies = jiffies; 1121 1122 /* Set check interval to 1/5 of estimated time to 1123 * send a character, and make it at least 1. The check 1124 * interval should also be less than the timeout. 1125 * Note: use tight timings here to satisfy the NIST-PCTS. 1126 */ 1127 1128 if ( info->params.data_rate ) { 1129 char_time = info->timeout/(32 * 5); 1130 if (!char_time) 1131 char_time++; 1132 } else 1133 char_time = 1; 1134 1135 if (timeout) 1136 char_time = min_t(unsigned long, char_time, timeout); 1137 1138 if ( info->params.mode == MGSL_MODE_HDLC ) { 1139 while (info->tx_active) { 1140 msleep_interruptible(jiffies_to_msecs(char_time)); 1141 if (signal_pending(current)) 1142 break; 1143 if (timeout && time_after(jiffies, orig_jiffies + timeout)) 1144 break; 1145 } 1146 } else { 1147 //TODO: determine if there is something similar to USC16C32 1148 // TXSTATUS_ALL_SENT status 1149 while ( info->tx_active && info->tx_enabled) { 1150 msleep_interruptible(jiffies_to_msecs(char_time)); 1151 if (signal_pending(current)) 1152 break; 1153 if (timeout && time_after(jiffies, orig_jiffies + timeout)) 1154 break; 1155 } 1156 } 1157 1158exit: 1159 unlock_kernel(); 1160 if (debug_level >= DEBUG_LEVEL_INFO) 1161 printk("%s(%d):%s wait_until_sent() exit\n", 1162 __FILE__,__LINE__, info->device_name ); 1163} 1164 1165/* Return the count of free bytes in transmit buffer 1166 */ 1167static int write_room(struct tty_struct *tty) 1168{ 1169 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1170 int ret; 1171 1172 if (sanity_check(info, tty->name, "write_room")) 1173 return 0; 1174 1175 lock_kernel(); 1176 if (info->params.mode == MGSL_MODE_HDLC) { 1177 ret = (info->tx_active) ? 0 : HDLC_MAX_FRAME_SIZE; 1178 } else { 1179 ret = info->max_frame_size - info->tx_count - 1; 1180 if (ret < 0) 1181 ret = 0; 1182 } 1183 unlock_kernel(); 1184 1185 if (debug_level >= DEBUG_LEVEL_INFO) 1186 printk("%s(%d):%s write_room()=%d\n", 1187 __FILE__, __LINE__, info->device_name, ret); 1188 1189 return ret; 1190} 1191 1192/* enable transmitter and send remaining buffered characters 1193 */ 1194static void flush_chars(struct tty_struct *tty) 1195{ 1196 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1197 unsigned long flags; 1198 1199 if ( debug_level >= DEBUG_LEVEL_INFO ) 1200 printk( "%s(%d):%s flush_chars() entry tx_count=%d\n", 1201 __FILE__,__LINE__,info->device_name,info->tx_count); 1202 1203 if (sanity_check(info, tty->name, "flush_chars")) 1204 return; 1205 1206 if (info->tx_count <= 0 || tty->stopped || tty->hw_stopped || 1207 !info->tx_buf) 1208 return; 1209 1210 if ( debug_level >= DEBUG_LEVEL_INFO ) 1211 printk( "%s(%d):%s flush_chars() entry, starting transmitter\n", 1212 __FILE__,__LINE__,info->device_name ); 1213 1214 spin_lock_irqsave(&info->lock,flags); 1215 1216 if (!info->tx_active) { 1217 if ( (info->params.mode == MGSL_MODE_HDLC) && 1218 info->tx_count ) { 1219 /* operating in synchronous (frame oriented) mode */ 1220 /* copy data from circular tx_buf to */ 1221 /* transmit DMA buffer. */ 1222 tx_load_dma_buffer(info, 1223 info->tx_buf,info->tx_count); 1224 } 1225 tx_start(info); 1226 } 1227 1228 spin_unlock_irqrestore(&info->lock,flags); 1229} 1230 1231/* Discard all data in the send buffer 1232 */ 1233static void flush_buffer(struct tty_struct *tty) 1234{ 1235 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1236 unsigned long flags; 1237 1238 if (debug_level >= DEBUG_LEVEL_INFO) 1239 printk("%s(%d):%s flush_buffer() entry\n", 1240 __FILE__,__LINE__, info->device_name ); 1241 1242 if (sanity_check(info, tty->name, "flush_buffer")) 1243 return; 1244 1245 spin_lock_irqsave(&info->lock,flags); 1246 info->tx_count = info->tx_put = info->tx_get = 0; 1247 del_timer(&info->tx_timer); 1248 spin_unlock_irqrestore(&info->lock,flags); 1249 1250 tty_wakeup(tty); 1251} 1252 1253/* throttle (stop) transmitter 1254 */ 1255static void tx_hold(struct tty_struct *tty) 1256{ 1257 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1258 unsigned long flags; 1259 1260 if (sanity_check(info, tty->name, "tx_hold")) 1261 return; 1262 1263 if ( debug_level >= DEBUG_LEVEL_INFO ) 1264 printk("%s(%d):%s tx_hold()\n", 1265 __FILE__,__LINE__,info->device_name); 1266 1267 spin_lock_irqsave(&info->lock,flags); 1268 if (info->tx_enabled) 1269 tx_stop(info); 1270 spin_unlock_irqrestore(&info->lock,flags); 1271} 1272 1273/* release (start) transmitter 1274 */ 1275static void tx_release(struct tty_struct *tty) 1276{ 1277 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1278 unsigned long flags; 1279 1280 if (sanity_check(info, tty->name, "tx_release")) 1281 return; 1282 1283 if ( debug_level >= DEBUG_LEVEL_INFO ) 1284 printk("%s(%d):%s tx_release()\n", 1285 __FILE__,__LINE__,info->device_name); 1286 1287 spin_lock_irqsave(&info->lock,flags); 1288 if (!info->tx_enabled) 1289 tx_start(info); 1290 spin_unlock_irqrestore(&info->lock,flags); 1291} 1292 1293/* Service an IOCTL request 1294 * 1295 * Arguments: 1296 * 1297 * tty pointer to tty instance data 1298 * file pointer to associated file object for device 1299 * cmd IOCTL command code 1300 * arg command argument/context 1301 * 1302 * Return Value: 0 if success, otherwise error code 1303 */ 1304static int do_ioctl(struct tty_struct *tty, struct file *file, 1305 unsigned int cmd, unsigned long arg) 1306{ 1307 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1308 int error; 1309 struct mgsl_icount cnow; /* kernel counter temps */ 1310 struct serial_icounter_struct __user *p_cuser; /* user space */ 1311 unsigned long flags; 1312 void __user *argp = (void __user *)arg; 1313 1314 if (debug_level >= DEBUG_LEVEL_INFO) 1315 printk("%s(%d):%s ioctl() cmd=%08X\n", __FILE__,__LINE__, 1316 info->device_name, cmd ); 1317 1318 if (sanity_check(info, tty->name, "ioctl")) 1319 return -ENODEV; 1320 1321 if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) && 1322 (cmd != TIOCMIWAIT) && (cmd != TIOCGICOUNT)) { 1323 if (tty->flags & (1 << TTY_IO_ERROR)) 1324 return -EIO; 1325 } 1326 1327 switch (cmd) { 1328 case MGSL_IOCGPARAMS: 1329 return get_params(info, argp); 1330 case MGSL_IOCSPARAMS: 1331 return set_params(info, argp); 1332 case MGSL_IOCGTXIDLE: 1333 return get_txidle(info, argp); 1334 case MGSL_IOCSTXIDLE: 1335 return set_txidle(info, (int)arg); 1336 case MGSL_IOCTXENABLE: 1337 return tx_enable(info, (int)arg); 1338 case MGSL_IOCRXENABLE: 1339 return rx_enable(info, (int)arg); 1340 case MGSL_IOCTXABORT: 1341 return tx_abort(info); 1342 case MGSL_IOCGSTATS: 1343 return get_stats(info, argp); 1344 case MGSL_IOCWAITEVENT: 1345 return wait_mgsl_event(info, argp); 1346 case MGSL_IOCLOOPTXDONE: 1347 return 0; // TODO: Not supported, need to document 1348 /* Wait for modem input (DCD,RI,DSR,CTS) change 1349 * as specified by mask in arg (TIOCM_RNG/DSR/CD/CTS) 1350 */ 1351 case TIOCMIWAIT: 1352 return modem_input_wait(info,(int)arg); 1353 1354 /* 1355 * Get counter of input serial line interrupts (DCD,RI,DSR,CTS) 1356 * Return: write counters to the user passed counter struct 1357 * NB: both 1->0 and 0->1 transitions are counted except for 1358 * RI where only 0->1 is counted. 1359 */ 1360 case TIOCGICOUNT: 1361 spin_lock_irqsave(&info->lock,flags); 1362 cnow = info->icount; 1363 spin_unlock_irqrestore(&info->lock,flags); 1364 p_cuser = argp; 1365 PUT_USER(error,cnow.cts, &p_cuser->cts); 1366 if (error) return error; 1367 PUT_USER(error,cnow.dsr, &p_cuser->dsr); 1368 if (error) return error; 1369 PUT_USER(error,cnow.rng, &p_cuser->rng); 1370 if (error) return error; 1371 PUT_USER(error,cnow.dcd, &p_cuser->dcd); 1372 if (error) return error; 1373 PUT_USER(error,cnow.rx, &p_cuser->rx); 1374 if (error) return error; 1375 PUT_USER(error,cnow.tx, &p_cuser->tx); 1376 if (error) return error; 1377 PUT_USER(error,cnow.frame, &p_cuser->frame); 1378 if (error) return error; 1379 PUT_USER(error,cnow.overrun, &p_cuser->overrun); 1380 if (error) return error; 1381 PUT_USER(error,cnow.parity, &p_cuser->parity); 1382 if (error) return error; 1383 PUT_USER(error,cnow.brk, &p_cuser->brk); 1384 if (error) return error; 1385 PUT_USER(error,cnow.buf_overrun, &p_cuser->buf_overrun); 1386 if (error) return error; 1387 return 0; 1388 default: 1389 return -ENOIOCTLCMD; 1390 } 1391 return 0; 1392} 1393 1394static int ioctl(struct tty_struct *tty, struct file *file, 1395 unsigned int cmd, unsigned long arg) 1396{ 1397 int ret; 1398 lock_kernel(); 1399 ret = do_ioctl(tty, file, cmd, arg); 1400 unlock_kernel(); 1401 return ret; 1402} 1403 1404/* 1405 * /proc fs routines.... 1406 */ 1407 1408static inline int line_info(char *buf, SLMP_INFO *info) 1409{ 1410 char stat_buf[30]; 1411 int ret; 1412 unsigned long flags; 1413 1414 ret = sprintf(buf, "%s: SCABase=%08x Mem=%08X StatusControl=%08x LCR=%08X\n" 1415 "\tIRQ=%d MaxFrameSize=%u\n", 1416 info->device_name, 1417 info->phys_sca_base, 1418 info->phys_memory_base, 1419 info->phys_statctrl_base, 1420 info->phys_lcr_base, 1421 info->irq_level, 1422 info->max_frame_size ); 1423 1424 /* output current serial signal states */ 1425 spin_lock_irqsave(&info->lock,flags); 1426 get_signals(info); 1427 spin_unlock_irqrestore(&info->lock,flags); 1428 1429 stat_buf[0] = 0; 1430 stat_buf[1] = 0; 1431 if (info->serial_signals & SerialSignal_RTS) 1432 strcat(stat_buf, "|RTS"); 1433 if (info->serial_signals & SerialSignal_CTS) 1434 strcat(stat_buf, "|CTS"); 1435 if (info->serial_signals & SerialSignal_DTR) 1436 strcat(stat_buf, "|DTR"); 1437 if (info->serial_signals & SerialSignal_DSR) 1438 strcat(stat_buf, "|DSR"); 1439 if (info->serial_signals & SerialSignal_DCD) 1440 strcat(stat_buf, "|CD"); 1441 if (info->serial_signals & SerialSignal_RI) 1442 strcat(stat_buf, "|RI"); 1443 1444 if (info->params.mode == MGSL_MODE_HDLC) { 1445 ret += sprintf(buf+ret, "\tHDLC txok:%d rxok:%d", 1446 info->icount.txok, info->icount.rxok); 1447 if (info->icount.txunder) 1448 ret += sprintf(buf+ret, " txunder:%d", info->icount.txunder); 1449 if (info->icount.txabort) 1450 ret += sprintf(buf+ret, " txabort:%d", info->icount.txabort); 1451 if (info->icount.rxshort) 1452 ret += sprintf(buf+ret, " rxshort:%d", info->icount.rxshort); 1453 if (info->icount.rxlong) 1454 ret += sprintf(buf+ret, " rxlong:%d", info->icount.rxlong); 1455 if (info->icount.rxover) 1456 ret += sprintf(buf+ret, " rxover:%d", info->icount.rxover); 1457 if (info->icount.rxcrc) 1458 ret += sprintf(buf+ret, " rxlong:%d", info->icount.rxcrc); 1459 } else { 1460 ret += sprintf(buf+ret, "\tASYNC tx:%d rx:%d", 1461 info->icount.tx, info->icount.rx); 1462 if (info->icount.frame) 1463 ret += sprintf(buf+ret, " fe:%d", info->icount.frame); 1464 if (info->icount.parity) 1465 ret += sprintf(buf+ret, " pe:%d", info->icount.parity); 1466 if (info->icount.brk) 1467 ret += sprintf(buf+ret, " brk:%d", info->icount.brk); 1468 if (info->icount.overrun) 1469 ret += sprintf(buf+ret, " oe:%d", info->icount.overrun); 1470 } 1471 1472 /* Append serial signal status to end */ 1473 ret += sprintf(buf+ret, " %s\n", stat_buf+1); 1474 1475 ret += sprintf(buf+ret, "\ttxactive=%d bh_req=%d bh_run=%d pending_bh=%x\n", 1476 info->tx_active,info->bh_requested,info->bh_running, 1477 info->pending_bh); 1478 1479 return ret; 1480} 1481 1482/* Called to print information about devices 1483 */ 1484static int read_proc(char *page, char **start, off_t off, int count, 1485 int *eof, void *data) 1486{ 1487 int len = 0, l; 1488 off_t begin = 0; 1489 SLMP_INFO *info; 1490 1491 len += sprintf(page, "synclinkmp driver:%s\n", driver_version); 1492 1493 info = synclinkmp_device_list; 1494 while( info ) { 1495 l = line_info(page + len, info); 1496 len += l; 1497 if (len+begin > off+count) 1498 goto done; 1499 if (len+begin < off) { 1500 begin += len; 1501 len = 0; 1502 } 1503 info = info->next_device; 1504 } 1505 1506 *eof = 1; 1507done: 1508 if (off >= len+begin) 1509 return 0; 1510 *start = page + (off-begin); 1511 return ((count < begin+len-off) ? count : begin+len-off); 1512} 1513 1514/* Return the count of bytes in transmit buffer 1515 */ 1516static int chars_in_buffer(struct tty_struct *tty) 1517{ 1518 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1519 1520 if (sanity_check(info, tty->name, "chars_in_buffer")) 1521 return 0; 1522 1523 if (debug_level >= DEBUG_LEVEL_INFO) 1524 printk("%s(%d):%s chars_in_buffer()=%d\n", 1525 __FILE__, __LINE__, info->device_name, info->tx_count); 1526 1527 return info->tx_count; 1528} 1529 1530/* Signal remote device to throttle send data (our receive data) 1531 */ 1532static void throttle(struct tty_struct * tty) 1533{ 1534 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1535 unsigned long flags; 1536 1537 if (debug_level >= DEBUG_LEVEL_INFO) 1538 printk("%s(%d):%s throttle() entry\n", 1539 __FILE__,__LINE__, info->device_name ); 1540 1541 if (sanity_check(info, tty->name, "throttle")) 1542 return; 1543 1544 if (I_IXOFF(tty)) 1545 send_xchar(tty, STOP_CHAR(tty)); 1546 1547 if (tty->termios->c_cflag & CRTSCTS) { 1548 spin_lock_irqsave(&info->lock,flags); 1549 info->serial_signals &= ~SerialSignal_RTS; 1550 set_signals(info); 1551 spin_unlock_irqrestore(&info->lock,flags); 1552 } 1553} 1554 1555/* Signal remote device to stop throttling send data (our receive data) 1556 */ 1557static void unthrottle(struct tty_struct * tty) 1558{ 1559 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 1560 unsigned long flags; 1561 1562 if (debug_level >= DEBUG_LEVEL_INFO) 1563 printk("%s(%d):%s unthrottle() entry\n", 1564 __FILE__,__LINE__, info->device_name ); 1565 1566 if (sanity_check(info, tty->name, "unthrottle")) 1567 return; 1568 1569 if (I_IXOFF(tty)) { 1570 if (info->x_char) 1571 info->x_char = 0; 1572 else 1573 send_xchar(tty, START_CHAR(tty)); 1574 } 1575 1576 if (tty->termios->c_cflag & CRTSCTS) { 1577 spin_lock_irqsave(&info->lock,flags); 1578 info->serial_signals |= SerialSignal_RTS; 1579 set_signals(info); 1580 spin_unlock_irqrestore(&info->lock,flags); 1581 } 1582} 1583 1584/* set or clear transmit break condition 1585 * break_state -1=set break condition, 0=clear 1586 */ 1587static int set_break(struct tty_struct *tty, int break_state) 1588{ 1589 unsigned char RegValue; 1590 SLMP_INFO * info = (SLMP_INFO *)tty->driver_data; 1591 unsigned long flags; 1592 1593 if (debug_level >= DEBUG_LEVEL_INFO) 1594 printk("%s(%d):%s set_break(%d)\n", 1595 __FILE__,__LINE__, info->device_name, break_state); 1596 1597 if (sanity_check(info, tty->name, "set_break")) 1598 return -EINVAL; 1599 1600 spin_lock_irqsave(&info->lock,flags); 1601 RegValue = read_reg(info, CTL); 1602 if (break_state == -1) 1603 RegValue |= BIT3; 1604 else 1605 RegValue &= ~BIT3; 1606 write_reg(info, CTL, RegValue); 1607 spin_unlock_irqrestore(&info->lock,flags); 1608 return 0; 1609} 1610 1611#if SYNCLINK_GENERIC_HDLC 1612 1613/** 1614 * called by generic HDLC layer when protocol selected (PPP, frame relay, etc.) 1615 * set encoding and frame check sequence (FCS) options 1616 * 1617 * dev pointer to network device structure 1618 * encoding serial encoding setting 1619 * parity FCS setting 1620 * 1621 * returns 0 if success, otherwise error code 1622 */ 1623static int hdlcdev_attach(struct net_device *dev, unsigned short encoding, 1624 unsigned short parity) 1625{ 1626 SLMP_INFO *info = dev_to_port(dev); 1627 unsigned char new_encoding; 1628 unsigned short new_crctype; 1629 1630 /* return error if TTY interface open */ 1631 if (info->port.count) 1632 return -EBUSY; 1633 1634 switch (encoding) 1635 { 1636 case ENCODING_NRZ: new_encoding = HDLC_ENCODING_NRZ; break; 1637 case ENCODING_NRZI: new_encoding = HDLC_ENCODING_NRZI_SPACE; break; 1638 case ENCODING_FM_MARK: new_encoding = HDLC_ENCODING_BIPHASE_MARK; break; 1639 case ENCODING_FM_SPACE: new_encoding = HDLC_ENCODING_BIPHASE_SPACE; break; 1640 case ENCODING_MANCHESTER: new_encoding = HDLC_ENCODING_BIPHASE_LEVEL; break; 1641 default: return -EINVAL; 1642 } 1643 1644 switch (parity) 1645 { 1646 case PARITY_NONE: new_crctype = HDLC_CRC_NONE; break; 1647 case PARITY_CRC16_PR1_CCITT: new_crctype = HDLC_CRC_16_CCITT; break; 1648 case PARITY_CRC32_PR1_CCITT: new_crctype = HDLC_CRC_32_CCITT; break; 1649 default: return -EINVAL; 1650 } 1651 1652 info->params.encoding = new_encoding; 1653 info->params.crc_type = new_crctype; 1654 1655 /* if network interface up, reprogram hardware */ 1656 if (info->netcount) 1657 program_hw(info); 1658 1659 return 0; 1660} 1661 1662/** 1663 * called by generic HDLC layer to send frame 1664 * 1665 * skb socket buffer containing HDLC frame 1666 * dev pointer to network device structure 1667 * 1668 * returns 0 if success, otherwise error code 1669 */ 1670static int hdlcdev_xmit(struct sk_buff *skb, struct net_device *dev) 1671{ 1672 SLMP_INFO *info = dev_to_port(dev); 1673 unsigned long flags; 1674 1675 if (debug_level >= DEBUG_LEVEL_INFO) 1676 printk(KERN_INFO "%s:hdlc_xmit(%s)\n",__FILE__,dev->name); 1677 1678 /* stop sending until this frame completes */ 1679 netif_stop_queue(dev); 1680 1681 /* copy data to device buffers */ 1682 info->tx_count = skb->len; 1683 tx_load_dma_buffer(info, skb->data, skb->len); 1684 1685 /* update network statistics */ 1686 dev->stats.tx_packets++; 1687 dev->stats.tx_bytes += skb->len; 1688 1689 /* done with socket buffer, so free it */ 1690 dev_kfree_skb(skb); 1691 1692 /* save start time for transmit timeout detection */ 1693 dev->trans_start = jiffies; 1694 1695 /* start hardware transmitter if necessary */ 1696 spin_lock_irqsave(&info->lock,flags); 1697 if (!info->tx_active) 1698 tx_start(info); 1699 spin_unlock_irqrestore(&info->lock,flags); 1700 1701 return 0; 1702} 1703 1704/** 1705 * called by network layer when interface enabled 1706 * claim resources and initialize hardware 1707 * 1708 * dev pointer to network device structure 1709 * 1710 * returns 0 if success, otherwise error code 1711 */ 1712static int hdlcdev_open(struct net_device *dev) 1713{ 1714 SLMP_INFO *info = dev_to_port(dev); 1715 int rc; 1716 unsigned long flags; 1717 1718 if (debug_level >= DEBUG_LEVEL_INFO) 1719 printk("%s:hdlcdev_open(%s)\n",__FILE__,dev->name); 1720 1721 /* generic HDLC layer open processing */ 1722 if ((rc = hdlc_open(dev))) 1723 return rc; 1724 1725 /* arbitrate between network and tty opens */ 1726 spin_lock_irqsave(&info->netlock, flags); 1727 if (info->port.count != 0 || info->netcount != 0) { 1728 printk(KERN_WARNING "%s: hdlc_open returning busy\n", dev->name); 1729 spin_unlock_irqrestore(&info->netlock, flags); 1730 return -EBUSY; 1731 } 1732 info->netcount=1; 1733 spin_unlock_irqrestore(&info->netlock, flags); 1734 1735 /* claim resources and init adapter */ 1736 if ((rc = startup(info)) != 0) { 1737 spin_lock_irqsave(&info->netlock, flags); 1738 info->netcount=0; 1739 spin_unlock_irqrestore(&info->netlock, flags); 1740 return rc; 1741 } 1742 1743 /* assert DTR and RTS, apply hardware settings */ 1744 info->serial_signals |= SerialSignal_RTS + SerialSignal_DTR; 1745 program_hw(info); 1746 1747 /* enable network layer transmit */ 1748 dev->trans_start = jiffies; 1749 netif_start_queue(dev); 1750 1751 /* inform generic HDLC layer of current DCD status */ 1752 spin_lock_irqsave(&info->lock, flags); 1753 get_signals(info); 1754 spin_unlock_irqrestore(&info->lock, flags); 1755 if (info->serial_signals & SerialSignal_DCD) 1756 netif_carrier_on(dev); 1757 else 1758 netif_carrier_off(dev); 1759 return 0; 1760} 1761 1762/** 1763 * called by network layer when interface is disabled 1764 * shutdown hardware and release resources 1765 * 1766 * dev pointer to network device structure 1767 * 1768 * returns 0 if success, otherwise error code 1769 */ 1770static int hdlcdev_close(struct net_device *dev) 1771{ 1772 SLMP_INFO *info = dev_to_port(dev); 1773 unsigned long flags; 1774 1775 if (debug_level >= DEBUG_LEVEL_INFO) 1776 printk("%s:hdlcdev_close(%s)\n",__FILE__,dev->name); 1777 1778 netif_stop_queue(dev); 1779 1780 /* shutdown adapter and release resources */ 1781 shutdown(info); 1782 1783 hdlc_close(dev); 1784 1785 spin_lock_irqsave(&info->netlock, flags); 1786 info->netcount=0; 1787 spin_unlock_irqrestore(&info->netlock, flags); 1788 1789 return 0; 1790} 1791 1792/** 1793 * called by network layer to process IOCTL call to network device 1794 * 1795 * dev pointer to network device structure 1796 * ifr pointer to network interface request structure 1797 * cmd IOCTL command code 1798 * 1799 * returns 0 if success, otherwise error code 1800 */ 1801static int hdlcdev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) 1802{ 1803 const size_t size = sizeof(sync_serial_settings); 1804 sync_serial_settings new_line; 1805 sync_serial_settings __user *line = ifr->ifr_settings.ifs_ifsu.sync; 1806 SLMP_INFO *info = dev_to_port(dev); 1807 unsigned int flags; 1808 1809 if (debug_level >= DEBUG_LEVEL_INFO) 1810 printk("%s:hdlcdev_ioctl(%s)\n",__FILE__,dev->name); 1811 1812 /* return error if TTY interface open */ 1813 if (info->port.count) 1814 return -EBUSY; 1815 1816 if (cmd != SIOCWANDEV) 1817 return hdlc_ioctl(dev, ifr, cmd); 1818 1819 switch(ifr->ifr_settings.type) { 1820 case IF_GET_IFACE: /* return current sync_serial_settings */ 1821 1822 ifr->ifr_settings.type = IF_IFACE_SYNC_SERIAL; 1823 if (ifr->ifr_settings.size < size) { 1824 ifr->ifr_settings.size = size; /* data size wanted */ 1825 return -ENOBUFS; 1826 } 1827 1828 flags = info->params.flags & (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL | 1829 HDLC_FLAG_RXC_BRG | HDLC_FLAG_RXC_TXCPIN | 1830 HDLC_FLAG_TXC_TXCPIN | HDLC_FLAG_TXC_DPLL | 1831 HDLC_FLAG_TXC_BRG | HDLC_FLAG_TXC_RXCPIN); 1832 1833 switch (flags){ 1834 case (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_TXCPIN): new_line.clock_type = CLOCK_EXT; break; 1835 case (HDLC_FLAG_RXC_BRG | HDLC_FLAG_TXC_BRG): new_line.clock_type = CLOCK_INT; break; 1836 case (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_BRG): new_line.clock_type = CLOCK_TXINT; break; 1837 case (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_RXCPIN): new_line.clock_type = CLOCK_TXFROMRX; break; 1838 default: new_line.clock_type = CLOCK_DEFAULT; 1839 } 1840 1841 new_line.clock_rate = info->params.clock_speed; 1842 new_line.loopback = info->params.loopback ? 1:0; 1843 1844 if (copy_to_user(line, &new_line, size)) 1845 return -EFAULT; 1846 return 0; 1847 1848 case IF_IFACE_SYNC_SERIAL: /* set sync_serial_settings */ 1849 1850 if(!capable(CAP_NET_ADMIN)) 1851 return -EPERM; 1852 if (copy_from_user(&new_line, line, size)) 1853 return -EFAULT; 1854 1855 switch (new_line.clock_type) 1856 { 1857 case CLOCK_EXT: flags = HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_TXCPIN; break; 1858 case CLOCK_TXFROMRX: flags = HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_RXCPIN; break; 1859 case CLOCK_INT: flags = HDLC_FLAG_RXC_BRG | HDLC_FLAG_TXC_BRG; break; 1860 case CLOCK_TXINT: flags = HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_TXC_BRG; break; 1861 case CLOCK_DEFAULT: flags = info->params.flags & 1862 (HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL | 1863 HDLC_FLAG_RXC_BRG | HDLC_FLAG_RXC_TXCPIN | 1864 HDLC_FLAG_TXC_TXCPIN | HDLC_FLAG_TXC_DPLL | 1865 HDLC_FLAG_TXC_BRG | HDLC_FLAG_TXC_RXCPIN); break; 1866 default: return -EINVAL; 1867 } 1868 1869 if (new_line.loopback != 0 && new_line.loopback != 1) 1870 return -EINVAL; 1871 1872 info->params.flags &= ~(HDLC_FLAG_RXC_RXCPIN | HDLC_FLAG_RXC_DPLL | 1873 HDLC_FLAG_RXC_BRG | HDLC_FLAG_RXC_TXCPIN | 1874 HDLC_FLAG_TXC_TXCPIN | HDLC_FLAG_TXC_DPLL | 1875 HDLC_FLAG_TXC_BRG | HDLC_FLAG_TXC_RXCPIN); 1876 info->params.flags |= flags; 1877 1878 info->params.loopback = new_line.loopback; 1879 1880 if (flags & (HDLC_FLAG_RXC_BRG | HDLC_FLAG_TXC_BRG)) 1881 info->params.clock_speed = new_line.clock_rate; 1882 else 1883 info->params.clock_speed = 0; 1884 1885 /* if network interface up, reprogram hardware */ 1886 if (info->netcount) 1887 program_hw(info); 1888 return 0; 1889 1890 default: 1891 return hdlc_ioctl(dev, ifr, cmd); 1892 } 1893} 1894 1895/** 1896 * called by network layer when transmit timeout is detected 1897 * 1898 * dev pointer to network device structure 1899 */ 1900static void hdlcdev_tx_timeout(struct net_device *dev) 1901{ 1902 SLMP_INFO *info = dev_to_port(dev); 1903 unsigned long flags; 1904 1905 if (debug_level >= DEBUG_LEVEL_INFO) 1906 printk("hdlcdev_tx_timeout(%s)\n",dev->name); 1907 1908 dev->stats.tx_errors++; 1909 dev->stats.tx_aborted_errors++; 1910 1911 spin_lock_irqsave(&info->lock,flags); 1912 tx_stop(info); 1913 spin_unlock_irqrestore(&info->lock,flags); 1914 1915 netif_wake_queue(dev); 1916} 1917 1918/** 1919 * called by device driver when transmit completes 1920 * reenable network layer transmit if stopped 1921 * 1922 * info pointer to device instance information 1923 */ 1924static void hdlcdev_tx_done(SLMP_INFO *info) 1925{ 1926 if (netif_queue_stopped(info->netdev)) 1927 netif_wake_queue(info->netdev); 1928} 1929 1930/** 1931 * called by device driver when frame received 1932 * pass frame to network layer 1933 * 1934 * info pointer to device instance information 1935 * buf pointer to buffer contianing frame data 1936 * size count of data bytes in buf 1937 */ 1938static void hdlcdev_rx(SLMP_INFO *info, char *buf, int size) 1939{ 1940 struct sk_buff *skb = dev_alloc_skb(size); 1941 struct net_device *dev = info->netdev; 1942 1943 if (debug_level >= DEBUG_LEVEL_INFO) 1944 printk("hdlcdev_rx(%s)\n",dev->name); 1945 1946 if (skb == NULL) { 1947 printk(KERN_NOTICE "%s: can't alloc skb, dropping packet\n", 1948 dev->name); 1949 dev->stats.rx_dropped++; 1950 return; 1951 } 1952 1953 memcpy(skb_put(skb, size), buf, size); 1954 1955 skb->protocol = hdlc_type_trans(skb, dev); 1956 1957 dev->stats.rx_packets++; 1958 dev->stats.rx_bytes += size; 1959 1960 netif_rx(skb); 1961 1962 dev->last_rx = jiffies; 1963} 1964 1965/** 1966 * called by device driver when adding device instance 1967 * do generic HDLC initialization 1968 * 1969 * info pointer to device instance information 1970 * 1971 * returns 0 if success, otherwise error code 1972 */ 1973static int hdlcdev_init(SLMP_INFO *info) 1974{ 1975 int rc; 1976 struct net_device *dev; 1977 hdlc_device *hdlc; 1978 1979 /* allocate and initialize network and HDLC layer objects */ 1980 1981 if (!(dev = alloc_hdlcdev(info))) { 1982 printk(KERN_ERR "%s:hdlc device allocation failure\n",__FILE__); 1983 return -ENOMEM; 1984 } 1985 1986 /* for network layer reporting purposes only */ 1987 dev->mem_start = info->phys_sca_base; 1988 dev->mem_end = info->phys_sca_base + SCA_BASE_SIZE - 1; 1989 dev->irq = info->irq_level; 1990 1991 /* network layer callbacks and settings */ 1992 dev->do_ioctl = hdlcdev_ioctl; 1993 dev->open = hdlcdev_open; 1994 dev->stop = hdlcdev_close; 1995 dev->tx_timeout = hdlcdev_tx_timeout; 1996 dev->watchdog_timeo = 10*HZ; 1997 dev->tx_queue_len = 50; 1998 1999 /* generic HDLC layer callbacks and settings */ 2000 hdlc = dev_to_hdlc(dev); 2001 hdlc->attach = hdlcdev_attach; 2002 hdlc->xmit = hdlcdev_xmit; 2003 2004 /* register objects with HDLC layer */ 2005 if ((rc = register_hdlc_device(dev))) { 2006 printk(KERN_WARNING "%s:unable to register hdlc device\n",__FILE__); 2007 free_netdev(dev); 2008 return rc; 2009 } 2010 2011 info->netdev = dev; 2012 return 0; 2013} 2014 2015/** 2016 * called by device driver when removing device instance 2017 * do generic HDLC cleanup 2018 * 2019 * info pointer to device instance information 2020 */ 2021static void hdlcdev_exit(SLMP_INFO *info) 2022{ 2023 unregister_hdlc_device(info->netdev); 2024 free_netdev(info->netdev); 2025 info->netdev = NULL; 2026} 2027 2028#endif /* CONFIG_HDLC */ 2029 2030 2031/* Return next bottom half action to perform. 2032 * Return Value: BH action code or 0 if nothing to do. 2033 */ 2034static int bh_action(SLMP_INFO *info) 2035{ 2036 unsigned long flags; 2037 int rc = 0; 2038 2039 spin_lock_irqsave(&info->lock,flags); 2040 2041 if (info->pending_bh & BH_RECEIVE) { 2042 info->pending_bh &= ~BH_RECEIVE; 2043 rc = BH_RECEIVE; 2044 } else if (info->pending_bh & BH_TRANSMIT) { 2045 info->pending_bh &= ~BH_TRANSMIT; 2046 rc = BH_TRANSMIT; 2047 } else if (info->pending_bh & BH_STATUS) { 2048 info->pending_bh &= ~BH_STATUS; 2049 rc = BH_STATUS; 2050 } 2051 2052 if (!rc) { 2053 /* Mark BH routine as complete */ 2054 info->bh_running = false; 2055 info->bh_requested = false; 2056 } 2057 2058 spin_unlock_irqrestore(&info->lock,flags); 2059 2060 return rc; 2061} 2062 2063/* Perform bottom half processing of work items queued by ISR. 2064 */ 2065static void bh_handler(struct work_struct *work) 2066{ 2067 SLMP_INFO *info = container_of(work, SLMP_INFO, task); 2068 int action; 2069 2070 if (!info) 2071 return; 2072 2073 if ( debug_level >= DEBUG_LEVEL_BH ) 2074 printk( "%s(%d):%s bh_handler() entry\n", 2075 __FILE__,__LINE__,info->device_name); 2076 2077 info->bh_running = true; 2078 2079 while((action = bh_action(info)) != 0) { 2080 2081 /* Process work item */ 2082 if ( debug_level >= DEBUG_LEVEL_BH ) 2083 printk( "%s(%d):%s bh_handler() work item action=%d\n", 2084 __FILE__,__LINE__,info->device_name, action); 2085 2086 switch (action) { 2087 2088 case BH_RECEIVE: 2089 bh_receive(info); 2090 break; 2091 case BH_TRANSMIT: 2092 bh_transmit(info); 2093 break; 2094 case BH_STATUS: 2095 bh_status(info); 2096 break; 2097 default: 2098 /* unknown work item ID */ 2099 printk("%s(%d):%s Unknown work item ID=%08X!\n", 2100 __FILE__,__LINE__,info->device_name,action); 2101 break; 2102 } 2103 } 2104 2105 if ( debug_level >= DEBUG_LEVEL_BH ) 2106 printk( "%s(%d):%s bh_handler() exit\n", 2107 __FILE__,__LINE__,info->device_name); 2108} 2109 2110static void bh_receive(SLMP_INFO *info) 2111{ 2112 if ( debug_level >= DEBUG_LEVEL_BH ) 2113 printk( "%s(%d):%s bh_receive()\n", 2114 __FILE__,__LINE__,info->device_name); 2115 2116 while( rx_get_frame(info) ); 2117} 2118 2119static void bh_transmit(SLMP_INFO *info) 2120{ 2121 struct tty_struct *tty = info->port.tty; 2122 2123 if ( debug_level >= DEBUG_LEVEL_BH ) 2124 printk( "%s(%d):%s bh_transmit() entry\n", 2125 __FILE__,__LINE__,info->device_name); 2126 2127 if (tty) 2128 tty_wakeup(tty); 2129} 2130 2131static void bh_status(SLMP_INFO *info) 2132{ 2133 if ( debug_level >= DEBUG_LEVEL_BH ) 2134 printk( "%s(%d):%s bh_status() entry\n", 2135 __FILE__,__LINE__,info->device_name); 2136 2137 info->ri_chkcount = 0; 2138 info->dsr_chkcount = 0; 2139 info->dcd_chkcount = 0; 2140 info->cts_chkcount = 0; 2141} 2142 2143static void isr_timer(SLMP_INFO * info) 2144{ 2145 unsigned char timer = (info->port_num & 1) ? TIMER2 : TIMER0; 2146 2147 /* IER2<7..4> = timer<3..0> interrupt enables (0=disabled) */ 2148 write_reg(info, IER2, 0); 2149 2150 /* TMCS, Timer Control/Status Register 2151 * 2152 * 07 CMF, Compare match flag (read only) 1=match 2153 * 06 ECMI, CMF Interrupt Enable: 0=disabled 2154 * 05 Reserved, must be 0 2155 * 04 TME, Timer Enable 2156 * 03..00 Reserved, must be 0 2157 * 2158 * 0000 0000 2159 */ 2160 write_reg(info, (unsigned char)(timer + TMCS), 0); 2161 2162 info->irq_occurred = true; 2163 2164 if ( debug_level >= DEBUG_LEVEL_ISR ) 2165 printk("%s(%d):%s isr_timer()\n", 2166 __FILE__,__LINE__,info->device_name); 2167} 2168 2169static void isr_rxint(SLMP_INFO * info) 2170{ 2171 struct tty_struct *tty = info->port.tty; 2172 struct mgsl_icount *icount = &info->icount; 2173 unsigned char status = read_reg(info, SR1) & info->ie1_value & (FLGD + IDLD + CDCD + BRKD); 2174 unsigned char status2 = read_reg(info, SR2) & info->ie2_value & OVRN; 2175 2176 /* clear status bits */ 2177 if (status) 2178 write_reg(info, SR1, status); 2179 2180 if (status2) 2181 write_reg(info, SR2, status2); 2182 2183 if ( debug_level >= DEBUG_LEVEL_ISR ) 2184 printk("%s(%d):%s isr_rxint status=%02X %02x\n", 2185 __FILE__,__LINE__,info->device_name,status,status2); 2186 2187 if (info->params.mode == MGSL_MODE_ASYNC) { 2188 if (status & BRKD) { 2189 icount->brk++; 2190 2191 /* process break detection if tty control 2192 * is not set to ignore it 2193 */ 2194 if ( tty ) { 2195 if (!(status & info->ignore_status_mask1)) { 2196 if (info->read_status_mask1 & BRKD) { 2197 tty_insert_flip_char(tty, 0, TTY_BREAK); 2198 if (info->port.flags & ASYNC_SAK) 2199 do_SAK(tty); 2200 } 2201 } 2202 } 2203 } 2204 } 2205 else { 2206 if (status & (FLGD|IDLD)) { 2207 if (status & FLGD) 2208 info->icount.exithunt++; 2209 else if (status & IDLD) 2210 info->icount.rxidle++; 2211 wake_up_interruptible(&info->event_wait_q); 2212 } 2213 } 2214 2215 if (status & CDCD) { 2216 /* simulate a common modem status change interrupt 2217 * for our handler 2218 */ 2219 get_signals( info ); 2220 isr_io_pin(info, 2221 MISCSTATUS_DCD_LATCHED|(info->serial_signals&SerialSignal_DCD)); 2222 } 2223} 2224 2225/* 2226 * handle async rx data interrupts 2227 */ 2228static void isr_rxrdy(SLMP_INFO * info) 2229{ 2230 u16 status; 2231 unsigned char DataByte; 2232 struct tty_struct *tty = info->port.tty; 2233 struct mgsl_icount *icount = &info->icount; 2234 2235 if ( debug_level >= DEBUG_LEVEL_ISR ) 2236 printk("%s(%d):%s isr_rxrdy\n", 2237 __FILE__,__LINE__,info->device_name); 2238 2239 while((status = read_reg(info,CST0)) & BIT0) 2240 { 2241 int flag = 0; 2242 bool over = false; 2243 DataByte = read_reg(info,TRB); 2244 2245 icount->rx++; 2246 2247 if ( status & (PE + FRME + OVRN) ) { 2248 printk("%s(%d):%s rxerr=%04X\n", 2249 __FILE__,__LINE__,info->device_name,status); 2250 2251 /* update error statistics */ 2252 if (status & PE) 2253 icount->parity++; 2254 else if (status & FRME) 2255 icount->frame++; 2256 else if (status & OVRN) 2257 icount->overrun++; 2258 2259 /* discard char if tty control flags say so */ 2260 if (status & info->ignore_status_mask2) 2261 continue; 2262 2263 status &= info->read_status_mask2; 2264 2265 if ( tty ) { 2266 if (status & PE) 2267 flag = TTY_PARITY; 2268 else if (status & FRME) 2269 flag = TTY_FRAME; 2270 if (status & OVRN) { 2271 /* Overrun is special, since it's 2272 * reported immediately, and doesn't 2273 * affect the current character 2274 */ 2275 over = true; 2276 } 2277 } 2278 } /* end of if (error) */ 2279 2280 if ( tty ) { 2281 tty_insert_flip_char(tty, DataByte, flag); 2282 if (over) 2283 tty_insert_flip_char(tty, 0, TTY_OVERRUN); 2284 } 2285 } 2286 2287 if ( debug_level >= DEBUG_LEVEL_ISR ) { 2288 printk("%s(%d):%s rx=%d brk=%d parity=%d frame=%d overrun=%d\n", 2289 __FILE__,__LINE__,info->device_name, 2290 icount->rx,icount->brk,icount->parity, 2291 icount->frame,icount->overrun); 2292 } 2293 2294 if ( tty ) 2295 tty_flip_buffer_push(tty); 2296} 2297 2298static void isr_txeom(SLMP_INFO * info, unsigned char status) 2299{ 2300 if ( debug_level >= DEBUG_LEVEL_ISR ) 2301 printk("%s(%d):%s isr_txeom status=%02x\n", 2302 __FILE__,__LINE__,info->device_name,status); 2303 2304 write_reg(info, TXDMA + DIR, 0x00); /* disable Tx DMA IRQs */ 2305 write_reg(info, TXDMA + DSR, 0xc0); /* clear IRQs and disable DMA */ 2306 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ 2307 2308 if (status & UDRN) { 2309 write_reg(info, CMD, TXRESET); 2310 write_reg(info, CMD, TXENABLE); 2311 } else 2312 write_reg(info, CMD, TXBUFCLR); 2313 2314 /* disable and clear tx interrupts */ 2315 info->ie0_value &= ~TXRDYE; 2316 info->ie1_value &= ~(IDLE + UDRN); 2317 write_reg16(info, IE0, (unsigned short)((info->ie1_value << 8) + info->ie0_value)); 2318 write_reg(info, SR1, (unsigned char)(UDRN + IDLE)); 2319 2320 if ( info->tx_active ) { 2321 if (info->params.mode != MGSL_MODE_ASYNC) { 2322 if (status & UDRN) 2323 info->icount.txunder++; 2324 else if (status & IDLE) 2325 info->icount.txok++; 2326 } 2327 2328 info->tx_active = false; 2329 info->tx_count = info->tx_put = info->tx_get = 0; 2330 2331 del_timer(&info->tx_timer); 2332 2333 if (info->params.mode != MGSL_MODE_ASYNC && info->drop_rts_on_tx_done ) { 2334 info->serial_signals &= ~SerialSignal_RTS; 2335 info->drop_rts_on_tx_done = false; 2336 set_signals(info); 2337 } 2338 2339#if SYNCLINK_GENERIC_HDLC 2340 if (info->netcount) 2341 hdlcdev_tx_done(info); 2342 else 2343#endif 2344 { 2345 if (info->port.tty && (info->port.tty->stopped || info->port.tty->hw_stopped)) { 2346 tx_stop(info); 2347 return; 2348 } 2349 info->pending_bh |= BH_TRANSMIT; 2350 } 2351 } 2352} 2353 2354 2355/* 2356 * handle tx status interrupts 2357 */ 2358static void isr_txint(SLMP_INFO * info) 2359{ 2360 unsigned char status = read_reg(info, SR1) & info->ie1_value & (UDRN + IDLE + CCTS); 2361 2362 /* clear status bits */ 2363 write_reg(info, SR1, status); 2364 2365 if ( debug_level >= DEBUG_LEVEL_ISR ) 2366 printk("%s(%d):%s isr_txint status=%02x\n", 2367 __FILE__,__LINE__,info->device_name,status); 2368 2369 if (status & (UDRN + IDLE)) 2370 isr_txeom(info, status); 2371 2372 if (status & CCTS) { 2373 /* simulate a common modem status change interrupt 2374 * for our handler 2375 */ 2376 get_signals( info ); 2377 isr_io_pin(info, 2378 MISCSTATUS_CTS_LATCHED|(info->serial_signals&SerialSignal_CTS)); 2379 2380 } 2381} 2382 2383/* 2384 * handle async tx data interrupts 2385 */ 2386static void isr_txrdy(SLMP_INFO * info) 2387{ 2388 if ( debug_level >= DEBUG_LEVEL_ISR ) 2389 printk("%s(%d):%s isr_txrdy() tx_count=%d\n", 2390 __FILE__,__LINE__,info->device_name,info->tx_count); 2391 2392 if (info->params.mode != MGSL_MODE_ASYNC) { 2393 /* disable TXRDY IRQ, enable IDLE IRQ */ 2394 info->ie0_value &= ~TXRDYE; 2395 info->ie1_value |= IDLE; 2396 write_reg16(info, IE0, (unsigned short)((info->ie1_value << 8) + info->ie0_value)); 2397 return; 2398 } 2399 2400 if (info->port.tty && (info->port.tty->stopped || info->port.tty->hw_stopped)) { 2401 tx_stop(info); 2402 return; 2403 } 2404 2405 if ( info->tx_count ) 2406 tx_load_fifo( info ); 2407 else { 2408 info->tx_active = false; 2409 info->ie0_value &= ~TXRDYE; 2410 write_reg(info, IE0, info->ie0_value); 2411 } 2412 2413 if (info->tx_count < WAKEUP_CHARS) 2414 info->pending_bh |= BH_TRANSMIT; 2415} 2416 2417static void isr_rxdmaok(SLMP_INFO * info) 2418{ 2419 /* BIT7 = EOT (end of transfer) 2420 * BIT6 = EOM (end of message/frame) 2421 */ 2422 unsigned char status = read_reg(info,RXDMA + DSR) & 0xc0; 2423 2424 /* clear IRQ (BIT0 must be 1 to prevent clearing DE bit) */ 2425 write_reg(info, RXDMA + DSR, (unsigned char)(status | 1)); 2426 2427 if ( debug_level >= DEBUG_LEVEL_ISR ) 2428 printk("%s(%d):%s isr_rxdmaok(), status=%02x\n", 2429 __FILE__,__LINE__,info->device_name,status); 2430 2431 info->pending_bh |= BH_RECEIVE; 2432} 2433 2434static void isr_rxdmaerror(SLMP_INFO * info) 2435{ 2436 /* BIT5 = BOF (buffer overflow) 2437 * BIT4 = COF (counter overflow) 2438 */ 2439 unsigned char status = read_reg(info,RXDMA + DSR) & 0x30; 2440 2441 /* clear IRQ (BIT0 must be 1 to prevent clearing DE bit) */ 2442 write_reg(info, RXDMA + DSR, (unsigned char)(status | 1)); 2443 2444 if ( debug_level >= DEBUG_LEVEL_ISR ) 2445 printk("%s(%d):%s isr_rxdmaerror(), status=%02x\n", 2446 __FILE__,__LINE__,info->device_name,status); 2447 2448 info->rx_overflow = true; 2449 info->pending_bh |= BH_RECEIVE; 2450} 2451 2452static void isr_txdmaok(SLMP_INFO * info) 2453{ 2454 unsigned char status_reg1 = read_reg(info, SR1); 2455 2456 write_reg(info, TXDMA + DIR, 0x00); /* disable Tx DMA IRQs */ 2457 write_reg(info, TXDMA + DSR, 0xc0); /* clear IRQs and disable DMA */ 2458 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ 2459 2460 if ( debug_level >= DEBUG_LEVEL_ISR ) 2461 printk("%s(%d):%s isr_txdmaok(), status=%02x\n", 2462 __FILE__,__LINE__,info->device_name,status_reg1); 2463 2464 /* program TXRDY as FIFO empty flag, enable TXRDY IRQ */ 2465 write_reg16(info, TRC0, 0); 2466 info->ie0_value |= TXRDYE; 2467 write_reg(info, IE0, info->ie0_value); 2468} 2469 2470static void isr_txdmaerror(SLMP_INFO * info) 2471{ 2472 /* BIT5 = BOF (buffer overflow) 2473 * BIT4 = COF (counter overflow) 2474 */ 2475 unsigned char status = read_reg(info,TXDMA + DSR) & 0x30; 2476 2477 /* clear IRQ (BIT0 must be 1 to prevent clearing DE bit) */ 2478 write_reg(info, TXDMA + DSR, (unsigned char)(status | 1)); 2479 2480 if ( debug_level >= DEBUG_LEVEL_ISR ) 2481 printk("%s(%d):%s isr_txdmaerror(), status=%02x\n", 2482 __FILE__,__LINE__,info->device_name,status); 2483} 2484 2485/* handle input serial signal changes 2486 */ 2487static void isr_io_pin( SLMP_INFO *info, u16 status ) 2488{ 2489 struct mgsl_icount *icount; 2490 2491 if ( debug_level >= DEBUG_LEVEL_ISR ) 2492 printk("%s(%d):isr_io_pin status=%04X\n", 2493 __FILE__,__LINE__,status); 2494 2495 if (status & (MISCSTATUS_CTS_LATCHED | MISCSTATUS_DCD_LATCHED | 2496 MISCSTATUS_DSR_LATCHED | MISCSTATUS_RI_LATCHED) ) { 2497 icount = &info->icount; 2498 /* update input line counters */ 2499 if (status & MISCSTATUS_RI_LATCHED) { 2500 icount->rng++; 2501 if ( status & SerialSignal_RI ) 2502 info->input_signal_events.ri_up++; 2503 else 2504 info->input_signal_events.ri_down++; 2505 } 2506 if (status & MISCSTATUS_DSR_LATCHED) { 2507 icount->dsr++; 2508 if ( status & SerialSignal_DSR ) 2509 info->input_signal_events.dsr_up++; 2510 else 2511 info->input_signal_events.dsr_down++; 2512 } 2513 if (status & MISCSTATUS_DCD_LATCHED) { 2514 if ((info->dcd_chkcount)++ >= IO_PIN_SHUTDOWN_LIMIT) { 2515 info->ie1_value &= ~CDCD; 2516 write_reg(info, IE1, info->ie1_value); 2517 } 2518 icount->dcd++; 2519 if (status & SerialSignal_DCD) { 2520 info->input_signal_events.dcd_up++; 2521 } else 2522 info->input_signal_events.dcd_down++; 2523#if SYNCLINK_GENERIC_HDLC 2524 if (info->netcount) { 2525 if (status & SerialSignal_DCD) 2526 netif_carrier_on(info->netdev); 2527 else 2528 netif_carrier_off(info->netdev); 2529 } 2530#endif 2531 } 2532 if (status & MISCSTATUS_CTS_LATCHED) 2533 { 2534 if ((info->cts_chkcount)++ >= IO_PIN_SHUTDOWN_LIMIT) { 2535 info->ie1_value &= ~CCTS; 2536 write_reg(info, IE1, info->ie1_value); 2537 } 2538 icount->cts++; 2539 if ( status & SerialSignal_CTS ) 2540 info->input_signal_events.cts_up++; 2541 else 2542 info->input_signal_events.cts_down++; 2543 } 2544 wake_up_interruptible(&info->status_event_wait_q); 2545 wake_up_interruptible(&info->event_wait_q); 2546 2547 if ( (info->port.flags & ASYNC_CHECK_CD) && 2548 (status & MISCSTATUS_DCD_LATCHED) ) { 2549 if ( debug_level >= DEBUG_LEVEL_ISR ) 2550 printk("%s CD now %s...", info->device_name, 2551 (status & SerialSignal_DCD) ? "on" : "off"); 2552 if (status & SerialSignal_DCD) 2553 wake_up_interruptible(&info->port.open_wait); 2554 else { 2555 if ( debug_level >= DEBUG_LEVEL_ISR ) 2556 printk("doing serial hangup..."); 2557 if (info->port.tty) 2558 tty_hangup(info->port.tty); 2559 } 2560 } 2561 2562 if ( (info->port.flags & ASYNC_CTS_FLOW) && 2563 (status & MISCSTATUS_CTS_LATCHED) ) { 2564 if ( info->port.tty ) { 2565 if (info->port.tty->hw_stopped) { 2566 if (status & SerialSignal_CTS) { 2567 if ( debug_level >= DEBUG_LEVEL_ISR ) 2568 printk("CTS tx start..."); 2569 info->port.tty->hw_stopped = 0; 2570 tx_start(info); 2571 info->pending_bh |= BH_TRANSMIT; 2572 return; 2573 } 2574 } else { 2575 if (!(status & SerialSignal_CTS)) { 2576 if ( debug_level >= DEBUG_LEVEL_ISR ) 2577 printk("CTS tx stop..."); 2578 info->port.tty->hw_stopped = 1; 2579 tx_stop(info); 2580 } 2581 } 2582 } 2583 } 2584 } 2585 2586 info->pending_bh |= BH_STATUS; 2587} 2588 2589/* Interrupt service routine entry point. 2590 * 2591 * Arguments: 2592 * irq interrupt number that caused interrupt 2593 * dev_id device ID supplied during interrupt registration 2594 * regs interrupted processor context 2595 */ 2596static irqreturn_t synclinkmp_interrupt(int dummy, void *dev_id) 2597{ 2598 SLMP_INFO *info = dev_id; 2599 unsigned char status, status0, status1=0; 2600 unsigned char dmastatus, dmastatus0, dmastatus1=0; 2601 unsigned char timerstatus0, timerstatus1=0; 2602 unsigned char shift; 2603 unsigned int i; 2604 unsigned short tmp; 2605 2606 if ( debug_level >= DEBUG_LEVEL_ISR ) 2607 printk(KERN_DEBUG "%s(%d): synclinkmp_interrupt(%d)entry.\n", 2608 __FILE__, __LINE__, info->irq_level); 2609 2610 spin_lock(&info->lock); 2611 2612 for(;;) { 2613 2614 /* get status for SCA0 (ports 0-1) */ 2615 tmp = read_reg16(info, ISR0); /* get ISR0 and ISR1 in one read */ 2616 status0 = (unsigned char)tmp; 2617 dmastatus0 = (unsigned char)(tmp>>8); 2618 timerstatus0 = read_reg(info, ISR2); 2619 2620 if ( debug_level >= DEBUG_LEVEL_ISR ) 2621 printk(KERN_DEBUG "%s(%d):%s status0=%02x, dmastatus0=%02x, timerstatus0=%02x\n", 2622 __FILE__, __LINE__, info->device_name, 2623 status0, dmastatus0, timerstatus0); 2624 2625 if (info->port_count == 4) { 2626 /* get status for SCA1 (ports 2-3) */ 2627 tmp = read_reg16(info->port_array[2], ISR0); 2628 status1 = (unsigned char)tmp; 2629 dmastatus1 = (unsigned char)(tmp>>8); 2630 timerstatus1 = read_reg(info->port_array[2], ISR2); 2631 2632 if ( debug_level >= DEBUG_LEVEL_ISR ) 2633 printk("%s(%d):%s status1=%02x, dmastatus1=%02x, timerstatus1=%02x\n", 2634 __FILE__,__LINE__,info->device_name, 2635 status1,dmastatus1,timerstatus1); 2636 } 2637 2638 if (!status0 && !dmastatus0 && !timerstatus0 && 2639 !status1 && !dmastatus1 && !timerstatus1) 2640 break; 2641 2642 for(i=0; i < info->port_count ; i++) { 2643 if (info->port_array[i] == NULL) 2644 continue; 2645 if (i < 2) { 2646 status = status0; 2647 dmastatus = dmastatus0; 2648 } else { 2649 status = status1; 2650 dmastatus = dmastatus1; 2651 } 2652 2653 shift = i & 1 ? 4 :0; 2654 2655 if (status & BIT0 << shift) 2656 isr_rxrdy(info->port_array[i]); 2657 if (status & BIT1 << shift) 2658 isr_txrdy(info->port_array[i]); 2659 if (status & BIT2 << shift) 2660 isr_rxint(info->port_array[i]); 2661 if (status & BIT3 << shift) 2662 isr_txint(info->port_array[i]); 2663 2664 if (dmastatus & BIT0 << shift) 2665 isr_rxdmaerror(info->port_array[i]); 2666 if (dmastatus & BIT1 << shift) 2667 isr_rxdmaok(info->port_array[i]); 2668 if (dmastatus & BIT2 << shift) 2669 isr_txdmaerror(info->port_array[i]); 2670 if (dmastatus & BIT3 << shift) 2671 isr_txdmaok(info->port_array[i]); 2672 } 2673 2674 if (timerstatus0 & (BIT5 | BIT4)) 2675 isr_timer(info->port_array[0]); 2676 if (timerstatus0 & (BIT7 | BIT6)) 2677 isr_timer(info->port_array[1]); 2678 if (timerstatus1 & (BIT5 | BIT4)) 2679 isr_timer(info->port_array[2]); 2680 if (timerstatus1 & (BIT7 | BIT6)) 2681 isr_timer(info->port_array[3]); 2682 } 2683 2684 for(i=0; i < info->port_count ; i++) { 2685 SLMP_INFO * port = info->port_array[i]; 2686 2687 /* Request bottom half processing if there's something 2688 * for it to do and the bh is not already running. 2689 * 2690 * Note: startup adapter diags require interrupts. 2691 * do not request bottom half processing if the 2692 * device is not open in a normal mode. 2693 */ 2694 if ( port && (port->port.count || port->netcount) && 2695 port->pending_bh && !port->bh_running && 2696 !port->bh_requested ) { 2697 if ( debug_level >= DEBUG_LEVEL_ISR ) 2698 printk("%s(%d):%s queueing bh task.\n", 2699 __FILE__,__LINE__,port->device_name); 2700 schedule_work(&port->task); 2701 port->bh_requested = true; 2702 } 2703 } 2704 2705 spin_unlock(&info->lock); 2706 2707 if ( debug_level >= DEBUG_LEVEL_ISR ) 2708 printk(KERN_DEBUG "%s(%d):synclinkmp_interrupt(%d)exit.\n", 2709 __FILE__, __LINE__, info->irq_level); 2710 return IRQ_HANDLED; 2711} 2712 2713/* Initialize and start device. 2714 */ 2715static int startup(SLMP_INFO * info) 2716{ 2717 if ( debug_level >= DEBUG_LEVEL_INFO ) 2718 printk("%s(%d):%s tx_releaseup()\n",__FILE__,__LINE__,info->device_name); 2719 2720 if (info->port.flags & ASYNC_INITIALIZED) 2721 return 0; 2722 2723 if (!info->tx_buf) { 2724 info->tx_buf = kmalloc(info->max_frame_size, GFP_KERNEL); 2725 if (!info->tx_buf) { 2726 printk(KERN_ERR"%s(%d):%s can't allocate transmit buffer\n", 2727 __FILE__,__LINE__,info->device_name); 2728 return -ENOMEM; 2729 } 2730 } 2731 2732 info->pending_bh = 0; 2733 2734 memset(&info->icount, 0, sizeof(info->icount)); 2735 2736 /* program hardware for current parameters */ 2737 reset_port(info); 2738 2739 change_params(info); 2740 2741 mod_timer(&info->status_timer, jiffies + msecs_to_jiffies(10)); 2742 2743 if (info->port.tty) 2744 clear_bit(TTY_IO_ERROR, &info->port.tty->flags); 2745 2746 info->port.flags |= ASYNC_INITIALIZED; 2747 2748 return 0; 2749} 2750 2751/* Called by close() and hangup() to shutdown hardware 2752 */ 2753static void shutdown(SLMP_INFO * info) 2754{ 2755 unsigned long flags; 2756 2757 if (!(info->port.flags & ASYNC_INITIALIZED)) 2758 return; 2759 2760 if (debug_level >= DEBUG_LEVEL_INFO) 2761 printk("%s(%d):%s synclinkmp_shutdown()\n", 2762 __FILE__,__LINE__, info->device_name ); 2763 2764 /* clear status wait queue because status changes */ 2765 /* can't happen after shutting down the hardware */ 2766 wake_up_interruptible(&info->status_event_wait_q); 2767 wake_up_interruptible(&info->event_wait_q); 2768 2769 del_timer(&info->tx_timer); 2770 del_timer(&info->status_timer); 2771 2772 kfree(info->tx_buf); 2773 info->tx_buf = NULL; 2774 2775 spin_lock_irqsave(&info->lock,flags); 2776 2777 reset_port(info); 2778 2779 if (!info->port.tty || info->port.tty->termios->c_cflag & HUPCL) { 2780 info->serial_signals &= ~(SerialSignal_DTR + SerialSignal_RTS); 2781 set_signals(info); 2782 } 2783 2784 spin_unlock_irqrestore(&info->lock,flags); 2785 2786 if (info->port.tty) 2787 set_bit(TTY_IO_ERROR, &info->port.tty->flags); 2788 2789 info->port.flags &= ~ASYNC_INITIALIZED; 2790} 2791 2792static void program_hw(SLMP_INFO *info) 2793{ 2794 unsigned long flags; 2795 2796 spin_lock_irqsave(&info->lock,flags); 2797 2798 rx_stop(info); 2799 tx_stop(info); 2800 2801 info->tx_count = info->tx_put = info->tx_get = 0; 2802 2803 if (info->params.mode == MGSL_MODE_HDLC || info->netcount) 2804 hdlc_mode(info); 2805 else 2806 async_mode(info); 2807 2808 set_signals(info); 2809 2810 info->dcd_chkcount = 0; 2811 info->cts_chkcount = 0; 2812 info->ri_chkcount = 0; 2813 info->dsr_chkcount = 0; 2814 2815 info->ie1_value |= (CDCD|CCTS); 2816 write_reg(info, IE1, info->ie1_value); 2817 2818 get_signals(info); 2819 2820 if (info->netcount || (info->port.tty && info->port.tty->termios->c_cflag & CREAD) ) 2821 rx_start(info); 2822 2823 spin_unlock_irqrestore(&info->lock,flags); 2824} 2825 2826/* Reconfigure adapter based on new parameters 2827 */ 2828static void change_params(SLMP_INFO *info) 2829{ 2830 unsigned cflag; 2831 int bits_per_char; 2832 2833 if (!info->port.tty || !info->port.tty->termios) 2834 return; 2835 2836 if (debug_level >= DEBUG_LEVEL_INFO) 2837 printk("%s(%d):%s change_params()\n", 2838 __FILE__,__LINE__, info->device_name ); 2839 2840 cflag = info->port.tty->termios->c_cflag; 2841 2842 /* if B0 rate (hangup) specified then negate DTR and RTS */ 2843 /* otherwise assert DTR and RTS */ 2844 if (cflag & CBAUD) 2845 info->serial_signals |= SerialSignal_RTS + SerialSignal_DTR; 2846 else 2847 info->serial_signals &= ~(SerialSignal_RTS + SerialSignal_DTR); 2848 2849 /* byte size and parity */ 2850 2851 switch (cflag & CSIZE) { 2852 case CS5: info->params.data_bits = 5; break; 2853 case CS6: info->params.data_bits = 6; break; 2854 case CS7: info->params.data_bits = 7; break; 2855 case CS8: info->params.data_bits = 8; break; 2856 /* Never happens, but GCC is too dumb to figure it out */ 2857 default: info->params.data_bits = 7; break; 2858 } 2859 2860 if (cflag & CSTOPB) 2861 info->params.stop_bits = 2; 2862 else 2863 info->params.stop_bits = 1; 2864 2865 info->params.parity = ASYNC_PARITY_NONE; 2866 if (cflag & PARENB) { 2867 if (cflag & PARODD) 2868 info->params.parity = ASYNC_PARITY_ODD; 2869 else 2870 info->params.parity = ASYNC_PARITY_EVEN; 2871#ifdef CMSPAR 2872 if (cflag & CMSPAR) 2873 info->params.parity = ASYNC_PARITY_SPACE; 2874#endif 2875 } 2876 2877 /* calculate number of jiffies to transmit a full 2878 * FIFO (32 bytes) at specified data rate 2879 */ 2880 bits_per_char = info->params.data_bits + 2881 info->params.stop_bits + 1; 2882 2883 /* if port data rate is set to 460800 or less then 2884 * allow tty settings to override, otherwise keep the 2885 * current data rate. 2886 */ 2887 if (info->params.data_rate <= 460800) { 2888 info->params.data_rate = tty_get_baud_rate(info->port.tty); 2889 } 2890 2891 if ( info->params.data_rate ) { 2892 info->timeout = (32*HZ*bits_per_char) / 2893 info->params.data_rate; 2894 } 2895 info->timeout += HZ/50; /* Add .02 seconds of slop */ 2896 2897 if (cflag & CRTSCTS) 2898 info->port.flags |= ASYNC_CTS_FLOW; 2899 else 2900 info->port.flags &= ~ASYNC_CTS_FLOW; 2901 2902 if (cflag & CLOCAL) 2903 info->port.flags &= ~ASYNC_CHECK_CD; 2904 else 2905 info->port.flags |= ASYNC_CHECK_CD; 2906 2907 /* process tty input control flags */ 2908 2909 info->read_status_mask2 = OVRN; 2910 if (I_INPCK(info->port.tty)) 2911 info->read_status_mask2 |= PE | FRME; 2912 if (I_BRKINT(info->port.tty) || I_PARMRK(info->port.tty)) 2913 info->read_status_mask1 |= BRKD; 2914 if (I_IGNPAR(info->port.tty)) 2915 info->ignore_status_mask2 |= PE | FRME; 2916 if (I_IGNBRK(info->port.tty)) { 2917 info->ignore_status_mask1 |= BRKD; 2918 /* If ignoring parity and break indicators, ignore 2919 * overruns too. (For real raw support). 2920 */ 2921 if (I_IGNPAR(info->port.tty)) 2922 info->ignore_status_mask2 |= OVRN; 2923 } 2924 2925 program_hw(info); 2926} 2927 2928static int get_stats(SLMP_INFO * info, struct mgsl_icount __user *user_icount) 2929{ 2930 int err; 2931 2932 if (debug_level >= DEBUG_LEVEL_INFO) 2933 printk("%s(%d):%s get_params()\n", 2934 __FILE__,__LINE__, info->device_name); 2935 2936 if (!user_icount) { 2937 memset(&info->icount, 0, sizeof(info->icount)); 2938 } else { 2939 COPY_TO_USER(err, user_icount, &info->icount, sizeof(struct mgsl_icount)); 2940 if (err) 2941 return -EFAULT; 2942 } 2943 2944 return 0; 2945} 2946 2947static int get_params(SLMP_INFO * info, MGSL_PARAMS __user *user_params) 2948{ 2949 int err; 2950 if (debug_level >= DEBUG_LEVEL_INFO) 2951 printk("%s(%d):%s get_params()\n", 2952 __FILE__,__LINE__, info->device_name); 2953 2954 COPY_TO_USER(err,user_params, &info->params, sizeof(MGSL_PARAMS)); 2955 if (err) { 2956 if ( debug_level >= DEBUG_LEVEL_INFO ) 2957 printk( "%s(%d):%s get_params() user buffer copy failed\n", 2958 __FILE__,__LINE__,info->device_name); 2959 return -EFAULT; 2960 } 2961 2962 return 0; 2963} 2964 2965static int set_params(SLMP_INFO * info, MGSL_PARAMS __user *new_params) 2966{ 2967 unsigned long flags; 2968 MGSL_PARAMS tmp_params; 2969 int err; 2970 2971 if (debug_level >= DEBUG_LEVEL_INFO) 2972 printk("%s(%d):%s set_params\n", 2973 __FILE__,__LINE__,info->device_name ); 2974 COPY_FROM_USER(err,&tmp_params, new_params, sizeof(MGSL_PARAMS)); 2975 if (err) { 2976 if ( debug_level >= DEBUG_LEVEL_INFO ) 2977 printk( "%s(%d):%s set_params() user buffer copy failed\n", 2978 __FILE__,__LINE__,info->device_name); 2979 return -EFAULT; 2980 } 2981 2982 spin_lock_irqsave(&info->lock,flags); 2983 memcpy(&info->params,&tmp_params,sizeof(MGSL_PARAMS)); 2984 spin_unlock_irqrestore(&info->lock,flags); 2985 2986 change_params(info); 2987 2988 return 0; 2989} 2990 2991static int get_txidle(SLMP_INFO * info, int __user *idle_mode) 2992{ 2993 int err; 2994 2995 if (debug_level >= DEBUG_LEVEL_INFO) 2996 printk("%s(%d):%s get_txidle()=%d\n", 2997 __FILE__,__LINE__, info->device_name, info->idle_mode); 2998 2999 COPY_TO_USER(err,idle_mode, &info->idle_mode, sizeof(int)); 3000 if (err) { 3001 if ( debug_level >= DEBUG_LEVEL_INFO ) 3002 printk( "%s(%d):%s get_txidle() user buffer copy failed\n", 3003 __FILE__,__LINE__,info->device_name); 3004 return -EFAULT; 3005 } 3006 3007 return 0; 3008} 3009 3010static int set_txidle(SLMP_INFO * info, int idle_mode) 3011{ 3012 unsigned long flags; 3013 3014 if (debug_level >= DEBUG_LEVEL_INFO) 3015 printk("%s(%d):%s set_txidle(%d)\n", 3016 __FILE__,__LINE__,info->device_name, idle_mode ); 3017 3018 spin_lock_irqsave(&info->lock,flags); 3019 info->idle_mode = idle_mode; 3020 tx_set_idle( info ); 3021 spin_unlock_irqrestore(&info->lock,flags); 3022 return 0; 3023} 3024 3025static int tx_enable(SLMP_INFO * info, int enable) 3026{ 3027 unsigned long flags; 3028 3029 if (debug_level >= DEBUG_LEVEL_INFO) 3030 printk("%s(%d):%s tx_enable(%d)\n", 3031 __FILE__,__LINE__,info->device_name, enable); 3032 3033 spin_lock_irqsave(&info->lock,flags); 3034 if ( enable ) { 3035 if ( !info->tx_enabled ) { 3036 tx_start(info); 3037 } 3038 } else { 3039 if ( info->tx_enabled ) 3040 tx_stop(info); 3041 } 3042 spin_unlock_irqrestore(&info->lock,flags); 3043 return 0; 3044} 3045 3046/* abort send HDLC frame 3047 */ 3048static int tx_abort(SLMP_INFO * info) 3049{ 3050 unsigned long flags; 3051 3052 if (debug_level >= DEBUG_LEVEL_INFO) 3053 printk("%s(%d):%s tx_abort()\n", 3054 __FILE__,__LINE__,info->device_name); 3055 3056 spin_lock_irqsave(&info->lock,flags); 3057 if ( info->tx_active && info->params.mode == MGSL_MODE_HDLC ) { 3058 info->ie1_value &= ~UDRN; 3059 info->ie1_value |= IDLE; 3060 write_reg(info, IE1, info->ie1_value); /* disable tx status interrupts */ 3061 write_reg(info, SR1, (unsigned char)(IDLE + UDRN)); /* clear pending */ 3062 3063 write_reg(info, TXDMA + DSR, 0); /* disable DMA channel */ 3064 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ 3065 3066 write_reg(info, CMD, TXABORT); 3067 } 3068 spin_unlock_irqrestore(&info->lock,flags); 3069 return 0; 3070} 3071 3072static int rx_enable(SLMP_INFO * info, int enable) 3073{ 3074 unsigned long flags; 3075 3076 if (debug_level >= DEBUG_LEVEL_INFO) 3077 printk("%s(%d):%s rx_enable(%d)\n", 3078 __FILE__,__LINE__,info->device_name,enable); 3079 3080 spin_lock_irqsave(&info->lock,flags); 3081 if ( enable ) { 3082 if ( !info->rx_enabled ) 3083 rx_start(info); 3084 } else { 3085 if ( info->rx_enabled ) 3086 rx_stop(info); 3087 } 3088 spin_unlock_irqrestore(&info->lock,flags); 3089 return 0; 3090} 3091 3092/* wait for specified event to occur 3093 */ 3094static int wait_mgsl_event(SLMP_INFO * info, int __user *mask_ptr) 3095{ 3096 unsigned long flags; 3097 int s; 3098 int rc=0; 3099 struct mgsl_icount cprev, cnow; 3100 int events; 3101 int mask; 3102 struct _input_signal_events oldsigs, newsigs; 3103 DECLARE_WAITQUEUE(wait, current); 3104 3105 COPY_FROM_USER(rc,&mask, mask_ptr, sizeof(int)); 3106 if (rc) { 3107 return -EFAULT; 3108 } 3109 3110 if (debug_level >= DEBUG_LEVEL_INFO) 3111 printk("%s(%d):%s wait_mgsl_event(%d)\n", 3112 __FILE__,__LINE__,info->device_name,mask); 3113 3114 spin_lock_irqsave(&info->lock,flags); 3115 3116 /* return immediately if state matches requested events */ 3117 get_signals(info); 3118 s = info->serial_signals; 3119 3120 events = mask & 3121 ( ((s & SerialSignal_DSR) ? MgslEvent_DsrActive:MgslEvent_DsrInactive) + 3122 ((s & SerialSignal_DCD) ? MgslEvent_DcdActive:MgslEvent_DcdInactive) + 3123 ((s & SerialSignal_CTS) ? MgslEvent_CtsActive:MgslEvent_CtsInactive) + 3124 ((s & SerialSignal_RI) ? MgslEvent_RiActive :MgslEvent_RiInactive) ); 3125 if (events) { 3126 spin_unlock_irqrestore(&info->lock,flags); 3127 goto exit; 3128 } 3129 3130 /* save current irq counts */ 3131 cprev = info->icount; 3132 oldsigs = info->input_signal_events; 3133 3134 /* enable hunt and idle irqs if needed */ 3135 if (mask & (MgslEvent_ExitHuntMode+MgslEvent_IdleReceived)) { 3136 unsigned char oldval = info->ie1_value; 3137 unsigned char newval = oldval + 3138 (mask & MgslEvent_ExitHuntMode ? FLGD:0) + 3139 (mask & MgslEvent_IdleReceived ? IDLD:0); 3140 if ( oldval != newval ) { 3141 info->ie1_value = newval; 3142 write_reg(info, IE1, info->ie1_value); 3143 } 3144 } 3145 3146 set_current_state(TASK_INTERRUPTIBLE); 3147 add_wait_queue(&info->event_wait_q, &wait); 3148 3149 spin_unlock_irqrestore(&info->lock,flags); 3150 3151 for(;;) { 3152 schedule(); 3153 if (signal_pending(current)) { 3154 rc = -ERESTARTSYS; 3155 break; 3156 } 3157 3158 /* get current irq counts */ 3159 spin_lock_irqsave(&info->lock,flags); 3160 cnow = info->icount; 3161 newsigs = info->input_signal_events; 3162 set_current_state(TASK_INTERRUPTIBLE); 3163 spin_unlock_irqrestore(&info->lock,flags); 3164 3165 /* if no change, wait aborted for some reason */ 3166 if (newsigs.dsr_up == oldsigs.dsr_up && 3167 newsigs.dsr_down == oldsigs.dsr_down && 3168 newsigs.dcd_up == oldsigs.dcd_up && 3169 newsigs.dcd_down == oldsigs.dcd_down && 3170 newsigs.cts_up == oldsigs.cts_up && 3171 newsigs.cts_down == oldsigs.cts_down && 3172 newsigs.ri_up == oldsigs.ri_up && 3173 newsigs.ri_down == oldsigs.ri_down && 3174 cnow.exithunt == cprev.exithunt && 3175 cnow.rxidle == cprev.rxidle) { 3176 rc = -EIO; 3177 break; 3178 } 3179 3180 events = mask & 3181 ( (newsigs.dsr_up != oldsigs.dsr_up ? MgslEvent_DsrActive:0) + 3182 (newsigs.dsr_down != oldsigs.dsr_down ? MgslEvent_DsrInactive:0) + 3183 (newsigs.dcd_up != oldsigs.dcd_up ? MgslEvent_DcdActive:0) + 3184 (newsigs.dcd_down != oldsigs.dcd_down ? MgslEvent_DcdInactive:0) + 3185 (newsigs.cts_up != oldsigs.cts_up ? MgslEvent_CtsActive:0) + 3186 (newsigs.cts_down != oldsigs.cts_down ? MgslEvent_CtsInactive:0) + 3187 (newsigs.ri_up != oldsigs.ri_up ? MgslEvent_RiActive:0) + 3188 (newsigs.ri_down != oldsigs.ri_down ? MgslEvent_RiInactive:0) + 3189 (cnow.exithunt != cprev.exithunt ? MgslEvent_ExitHuntMode:0) + 3190 (cnow.rxidle != cprev.rxidle ? MgslEvent_IdleReceived:0) ); 3191 if (events) 3192 break; 3193 3194 cprev = cnow; 3195 oldsigs = newsigs; 3196 } 3197 3198 remove_wait_queue(&info->event_wait_q, &wait); 3199 set_current_state(TASK_RUNNING); 3200 3201 3202 if (mask & (MgslEvent_ExitHuntMode + MgslEvent_IdleReceived)) { 3203 spin_lock_irqsave(&info->lock,flags); 3204 if (!waitqueue_active(&info->event_wait_q)) { 3205 /* disable enable exit hunt mode/idle rcvd IRQs */ 3206 info->ie1_value &= ~(FLGD|IDLD); 3207 write_reg(info, IE1, info->ie1_value); 3208 } 3209 spin_unlock_irqrestore(&info->lock,flags); 3210 } 3211exit: 3212 if ( rc == 0 ) 3213 PUT_USER(rc, events, mask_ptr); 3214 3215 return rc; 3216} 3217 3218static int modem_input_wait(SLMP_INFO *info,int arg) 3219{ 3220 unsigned long flags; 3221 int rc; 3222 struct mgsl_icount cprev, cnow; 3223 DECLARE_WAITQUEUE(wait, current); 3224 3225 /* save current irq counts */ 3226 spin_lock_irqsave(&info->lock,flags); 3227 cprev = info->icount; 3228 add_wait_queue(&info->status_event_wait_q, &wait); 3229 set_current_state(TASK_INTERRUPTIBLE); 3230 spin_unlock_irqrestore(&info->lock,flags); 3231 3232 for(;;) { 3233 schedule(); 3234 if (signal_pending(current)) { 3235 rc = -ERESTARTSYS; 3236 break; 3237 } 3238 3239 /* get new irq counts */ 3240 spin_lock_irqsave(&info->lock,flags); 3241 cnow = info->icount; 3242 set_current_state(TASK_INTERRUPTIBLE); 3243 spin_unlock_irqrestore(&info->lock,flags); 3244 3245 /* if no change, wait aborted for some reason */ 3246 if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr && 3247 cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) { 3248 rc = -EIO; 3249 break; 3250 } 3251 3252 /* check for change in caller specified modem input */ 3253 if ((arg & TIOCM_RNG && cnow.rng != cprev.rng) || 3254 (arg & TIOCM_DSR && cnow.dsr != cprev.dsr) || 3255 (arg & TIOCM_CD && cnow.dcd != cprev.dcd) || 3256 (arg & TIOCM_CTS && cnow.cts != cprev.cts)) { 3257 rc = 0; 3258 break; 3259 } 3260 3261 cprev = cnow; 3262 } 3263 remove_wait_queue(&info->status_event_wait_q, &wait); 3264 set_current_state(TASK_RUNNING); 3265 return rc; 3266} 3267 3268/* return the state of the serial control and status signals 3269 */ 3270static int tiocmget(struct tty_struct *tty, struct file *file) 3271{ 3272 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 3273 unsigned int result; 3274 unsigned long flags; 3275 3276 spin_lock_irqsave(&info->lock,flags); 3277 get_signals(info); 3278 spin_unlock_irqrestore(&info->lock,flags); 3279 3280 result = ((info->serial_signals & SerialSignal_RTS) ? TIOCM_RTS:0) + 3281 ((info->serial_signals & SerialSignal_DTR) ? TIOCM_DTR:0) + 3282 ((info->serial_signals & SerialSignal_DCD) ? TIOCM_CAR:0) + 3283 ((info->serial_signals & SerialSignal_RI) ? TIOCM_RNG:0) + 3284 ((info->serial_signals & SerialSignal_DSR) ? TIOCM_DSR:0) + 3285 ((info->serial_signals & SerialSignal_CTS) ? TIOCM_CTS:0); 3286 3287 if (debug_level >= DEBUG_LEVEL_INFO) 3288 printk("%s(%d):%s tiocmget() value=%08X\n", 3289 __FILE__,__LINE__, info->device_name, result ); 3290 return result; 3291} 3292 3293/* set modem control signals (DTR/RTS) 3294 */ 3295static int tiocmset(struct tty_struct *tty, struct file *file, 3296 unsigned int set, unsigned int clear) 3297{ 3298 SLMP_INFO *info = (SLMP_INFO *)tty->driver_data; 3299 unsigned long flags; 3300 3301 if (debug_level >= DEBUG_LEVEL_INFO) 3302 printk("%s(%d):%s tiocmset(%x,%x)\n", 3303 __FILE__,__LINE__,info->device_name, set, clear); 3304 3305 if (set & TIOCM_RTS) 3306 info->serial_signals |= SerialSignal_RTS; 3307 if (set & TIOCM_DTR) 3308 info->serial_signals |= SerialSignal_DTR; 3309 if (clear & TIOCM_RTS) 3310 info->serial_signals &= ~SerialSignal_RTS; 3311 if (clear & TIOCM_DTR) 3312 info->serial_signals &= ~SerialSignal_DTR; 3313 3314 spin_lock_irqsave(&info->lock,flags); 3315 set_signals(info); 3316 spin_unlock_irqrestore(&info->lock,flags); 3317 3318 return 0; 3319} 3320 3321 3322 3323/* Block the current process until the specified port is ready to open. 3324 */ 3325static int block_til_ready(struct tty_struct *tty, struct file *filp, 3326 SLMP_INFO *info) 3327{ 3328 DECLARE_WAITQUEUE(wait, current); 3329 int retval; 3330 bool do_clocal = false; 3331 bool extra_count = false; 3332 unsigned long flags; 3333 3334 if (debug_level >= DEBUG_LEVEL_INFO) 3335 printk("%s(%d):%s block_til_ready()\n", 3336 __FILE__,__LINE__, tty->driver->name ); 3337 3338 if (filp->f_flags & O_NONBLOCK || tty->flags & (1 << TTY_IO_ERROR)){ 3339 /* nonblock mode is set or port is not enabled */ 3340 /* just verify that callout device is not active */ 3341 info->port.flags |= ASYNC_NORMAL_ACTIVE; 3342 return 0; 3343 } 3344 3345 if (tty->termios->c_cflag & CLOCAL) 3346 do_clocal = true; 3347 3348 /* Wait for carrier detect and the line to become 3349 * free (i.e., not in use by the callout). While we are in 3350 * this loop, info->port.count is dropped by one, so that 3351 * close() knows when to free things. We restore it upon 3352 * exit, either normal or abnormal. 3353 */ 3354 3355 retval = 0; 3356 add_wait_queue(&info->port.open_wait, &wait); 3357 3358 if (debug_level >= DEBUG_LEVEL_INFO) 3359 printk("%s(%d):%s block_til_ready() before block, count=%d\n", 3360 __FILE__,__LINE__, tty->driver->name, info->port.count ); 3361 3362 spin_lock_irqsave(&info->lock, flags); 3363 if (!tty_hung_up_p(filp)) { 3364 extra_count = true; 3365 info->port.count--; 3366 } 3367 spin_unlock_irqrestore(&info->lock, flags); 3368 info->port.blocked_open++; 3369 3370 while (1) { 3371 if ((tty->termios->c_cflag & CBAUD)) { 3372 spin_lock_irqsave(&info->lock,flags); 3373 info->serial_signals |= SerialSignal_RTS + SerialSignal_DTR; 3374 set_signals(info); 3375 spin_unlock_irqrestore(&info->lock,flags); 3376 } 3377 3378 set_current_state(TASK_INTERRUPTIBLE); 3379 3380 if (tty_hung_up_p(filp) || !(info->port.flags & ASYNC_INITIALIZED)){ 3381 retval = (info->port.flags & ASYNC_HUP_NOTIFY) ? 3382 -EAGAIN : -ERESTARTSYS; 3383 break; 3384 } 3385 3386 spin_lock_irqsave(&info->lock,flags); 3387 get_signals(info); 3388 spin_unlock_irqrestore(&info->lock,flags); 3389 3390 if (!(info->port.flags & ASYNC_CLOSING) && 3391 (do_clocal || (info->serial_signals & SerialSignal_DCD)) ) { 3392 break; 3393 } 3394 3395 if (signal_pending(current)) { 3396 retval = -ERESTARTSYS; 3397 break; 3398 } 3399 3400 if (debug_level >= DEBUG_LEVEL_INFO) 3401 printk("%s(%d):%s block_til_ready() count=%d\n", 3402 __FILE__,__LINE__, tty->driver->name, info->port.count ); 3403 3404 schedule(); 3405 } 3406 3407 set_current_state(TASK_RUNNING); 3408 remove_wait_queue(&info->port.open_wait, &wait); 3409 3410 if (extra_count) 3411 info->port.count++; 3412 info->port.blocked_open--; 3413 3414 if (debug_level >= DEBUG_LEVEL_INFO) 3415 printk("%s(%d):%s block_til_ready() after, count=%d\n", 3416 __FILE__,__LINE__, tty->driver->name, info->port.count ); 3417 3418 if (!retval) 3419 info->port.flags |= ASYNC_NORMAL_ACTIVE; 3420 3421 return retval; 3422} 3423 3424static int alloc_dma_bufs(SLMP_INFO *info) 3425{ 3426 unsigned short BuffersPerFrame; 3427 unsigned short BufferCount; 3428 3429 // Force allocation to start at 64K boundary for each port. 3430 // This is necessary because *all* buffer descriptors for a port 3431 // *must* be in the same 64K block. All descriptors on a port 3432 // share a common 'base' address (upper 8 bits of 24 bits) programmed 3433 // into the CBP register. 3434 info->port_array[0]->last_mem_alloc = (SCA_MEM_SIZE/4) * info->port_num; 3435 3436 /* Calculate the number of DMA buffers necessary to hold the */ 3437 /* largest allowable frame size. Note: If the max frame size is */ 3438 /* not an even multiple of the DMA buffer size then we need to */ 3439 /* round the buffer count per frame up one. */ 3440 3441 BuffersPerFrame = (unsigned short)(info->max_frame_size/SCABUFSIZE); 3442 if ( info->max_frame_size % SCABUFSIZE ) 3443 BuffersPerFrame++; 3444 3445 /* calculate total number of data buffers (SCABUFSIZE) possible 3446 * in one ports memory (SCA_MEM_SIZE/4) after allocating memory 3447 * for the descriptor list (BUFFERLISTSIZE). 3448 */ 3449 BufferCount = (SCA_MEM_SIZE/4 - BUFFERLISTSIZE)/SCABUFSIZE; 3450 3451 /* limit number of buffers to maximum amount of descriptors */ 3452 if (BufferCount > BUFFERLISTSIZE/sizeof(SCADESC)) 3453 BufferCount = BUFFERLISTSIZE/sizeof(SCADESC); 3454 3455 /* use enough buffers to transmit one max size frame */ 3456 info->tx_buf_count = BuffersPerFrame + 1; 3457 3458 /* never use more than half the available buffers for transmit */ 3459 if (info->tx_buf_count > (BufferCount/2)) 3460 info->tx_buf_count = BufferCount/2; 3461 3462 if (info->tx_buf_count > SCAMAXDESC) 3463 info->tx_buf_count = SCAMAXDESC; 3464 3465 /* use remaining buffers for receive */ 3466 info->rx_buf_count = BufferCount - info->tx_buf_count; 3467 3468 if (info->rx_buf_count > SCAMAXDESC) 3469 info->rx_buf_count = SCAMAXDESC; 3470 3471 if ( debug_level >= DEBUG_LEVEL_INFO ) 3472 printk("%s(%d):%s Allocating %d TX and %d RX DMA buffers.\n", 3473 __FILE__,__LINE__, info->device_name, 3474 info->tx_buf_count,info->rx_buf_count); 3475 3476 if ( alloc_buf_list( info ) < 0 || 3477 alloc_frame_bufs(info, 3478 info->rx_buf_list, 3479 info->rx_buf_list_ex, 3480 info->rx_buf_count) < 0 || 3481 alloc_frame_bufs(info, 3482 info->tx_buf_list, 3483 info->tx_buf_list_ex, 3484 info->tx_buf_count) < 0 || 3485 alloc_tmp_rx_buf(info) < 0 ) { 3486 printk("%s(%d):%s Can't allocate DMA buffer memory\n", 3487 __FILE__,__LINE__, info->device_name); 3488 return -ENOMEM; 3489 } 3490 3491 rx_reset_buffers( info ); 3492 3493 return 0; 3494} 3495 3496/* Allocate DMA buffers for the transmit and receive descriptor lists. 3497 */ 3498static int alloc_buf_list(SLMP_INFO *info) 3499{ 3500 unsigned int i; 3501 3502 /* build list in adapter shared memory */ 3503 info->buffer_list = info->memory_base + info->port_array[0]->last_mem_alloc; 3504 info->buffer_list_phys = info->port_array[0]->last_mem_alloc; 3505 info->port_array[0]->last_mem_alloc += BUFFERLISTSIZE; 3506 3507 memset(info->buffer_list, 0, BUFFERLISTSIZE); 3508 3509 /* Save virtual address pointers to the receive and */ 3510 /* transmit buffer lists. (Receive 1st). These pointers will */ 3511 /* be used by the processor to access the lists. */ 3512 info->rx_buf_list = (SCADESC *)info->buffer_list; 3513 3514 info->tx_buf_list = (SCADESC *)info->buffer_list; 3515 info->tx_buf_list += info->rx_buf_count; 3516 3517 /* Build links for circular buffer entry lists (tx and rx) 3518 * 3519 * Note: links are physical addresses read by the SCA device 3520 * to determine the next buffer entry to use. 3521 */ 3522 3523 for ( i = 0; i < info->rx_buf_count; i++ ) { 3524 /* calculate and store physical address of this buffer entry */ 3525 info->rx_buf_list_ex[i].phys_entry = 3526 info->buffer_list_phys + (i * sizeof(SCABUFSIZE)); 3527 3528 /* calculate and store physical address of */ 3529 /* next entry in cirular list of entries */ 3530 info->rx_buf_list[i].next = info->buffer_list_phys; 3531 if ( i < info->rx_buf_count - 1 ) 3532 info->rx_buf_list[i].next += (i + 1) * sizeof(SCADESC); 3533 3534 info->rx_buf_list[i].length = SCABUFSIZE; 3535 } 3536 3537 for ( i = 0; i < info->tx_buf_count; i++ ) { 3538 /* calculate and store physical address of this buffer entry */ 3539 info->tx_buf_list_ex[i].phys_entry = info->buffer_list_phys + 3540 ((info->rx_buf_count + i) * sizeof(SCADESC)); 3541 3542 /* calculate and store physical address of */ 3543 /* next entry in cirular list of entries */ 3544 3545 info->tx_buf_list[i].next = info->buffer_list_phys + 3546 info->rx_buf_count * sizeof(SCADESC); 3547 3548 if ( i < info->tx_buf_count - 1 ) 3549 info->tx_buf_list[i].next += (i + 1) * sizeof(SCADESC); 3550 } 3551 3552 return 0; 3553} 3554 3555/* Allocate the frame DMA buffers used by the specified buffer list. 3556 */ 3557static int alloc_frame_bufs(SLMP_INFO *info, SCADESC *buf_list,SCADESC_EX *buf_list_ex,int count) 3558{ 3559 int i; 3560 unsigned long phys_addr; 3561 3562 for ( i = 0; i < count; i++ ) { 3563 buf_list_ex[i].virt_addr = info->memory_base + info->port_array[0]->last_mem_alloc; 3564 phys_addr = info->port_array[0]->last_mem_alloc; 3565 info->port_array[0]->last_mem_alloc += SCABUFSIZE; 3566 3567 buf_list[i].buf_ptr = (unsigned short)phys_addr; 3568 buf_list[i].buf_base = (unsigned char)(phys_addr >> 16); 3569 } 3570 3571 return 0; 3572} 3573 3574static void free_dma_bufs(SLMP_INFO *info) 3575{ 3576 info->buffer_list = NULL; 3577 info->rx_buf_list = NULL; 3578 info->tx_buf_list = NULL; 3579} 3580 3581/* allocate buffer large enough to hold max_frame_size. 3582 * This buffer is used to pass an assembled frame to the line discipline. 3583 */ 3584static int alloc_tmp_rx_buf(SLMP_INFO *info) 3585{ 3586 info->tmp_rx_buf = kmalloc(info->max_frame_size, GFP_KERNEL); 3587 if (info->tmp_rx_buf == NULL) 3588 return -ENOMEM; 3589 return 0; 3590} 3591 3592static void free_tmp_rx_buf(SLMP_INFO *info) 3593{ 3594 kfree(info->tmp_rx_buf); 3595 info->tmp_rx_buf = NULL; 3596} 3597 3598static int claim_resources(SLMP_INFO *info) 3599{ 3600 if (request_mem_region(info->phys_memory_base,SCA_MEM_SIZE,"synclinkmp") == NULL) { 3601 printk( "%s(%d):%s mem addr conflict, Addr=%08X\n", 3602 __FILE__,__LINE__,info->device_name, info->phys_memory_base); 3603 info->init_error = DiagStatus_AddressConflict; 3604 goto errout; 3605 } 3606 else 3607 info->shared_mem_requested = true; 3608 3609 if (request_mem_region(info->phys_lcr_base + info->lcr_offset,128,"synclinkmp") == NULL) { 3610 printk( "%s(%d):%s lcr mem addr conflict, Addr=%08X\n", 3611 __FILE__,__LINE__,info->device_name, info->phys_lcr_base); 3612 info->init_error = DiagStatus_AddressConflict; 3613 goto errout; 3614 } 3615 else 3616 info->lcr_mem_requested = true; 3617 3618 if (request_mem_region(info->phys_sca_base + info->sca_offset,SCA_BASE_SIZE,"synclinkmp") == NULL) { 3619 printk( "%s(%d):%s sca mem addr conflict, Addr=%08X\n", 3620 __FILE__,__LINE__,info->device_name, info->phys_sca_base); 3621 info->init_error = DiagStatus_AddressConflict; 3622 goto errout; 3623 } 3624 else 3625 info->sca_base_requested = true; 3626 3627 if (request_mem_region(info->phys_statctrl_base + info->statctrl_offset,SCA_REG_SIZE,"synclinkmp") == NULL) { 3628 printk( "%s(%d):%s stat/ctrl mem addr conflict, Addr=%08X\n", 3629 __FILE__,__LINE__,info->device_name, info->phys_statctrl_base); 3630 info->init_error = DiagStatus_AddressConflict; 3631 goto errout; 3632 } 3633 else 3634 info->sca_statctrl_requested = true; 3635 3636 info->memory_base = ioremap_nocache(info->phys_memory_base, 3637 SCA_MEM_SIZE); 3638 if (!info->memory_base) { 3639 printk( "%s(%d):%s Cant map shared memory, MemAddr=%08X\n", 3640 __FILE__,__LINE__,info->device_name, info->phys_memory_base ); 3641 info->init_error = DiagStatus_CantAssignPciResources; 3642 goto errout; 3643 } 3644 3645 info->lcr_base = ioremap_nocache(info->phys_lcr_base, PAGE_SIZE); 3646 if (!info->lcr_base) { 3647 printk( "%s(%d):%s Cant map LCR memory, MemAddr=%08X\n", 3648 __FILE__,__LINE__,info->device_name, info->phys_lcr_base ); 3649 info->init_error = DiagStatus_CantAssignPciResources; 3650 goto errout; 3651 } 3652 info->lcr_base += info->lcr_offset; 3653 3654 info->sca_base = ioremap_nocache(info->phys_sca_base, PAGE_SIZE); 3655 if (!info->sca_base) { 3656 printk( "%s(%d):%s Cant map SCA memory, MemAddr=%08X\n", 3657 __FILE__,__LINE__,info->device_name, info->phys_sca_base ); 3658 info->init_error = DiagStatus_CantAssignPciResources; 3659 goto errout; 3660 } 3661 info->sca_base += info->sca_offset; 3662 3663 info->statctrl_base = ioremap_nocache(info->phys_statctrl_base, 3664 PAGE_SIZE); 3665 if (!info->statctrl_base) { 3666 printk( "%s(%d):%s Cant map SCA Status/Control memory, MemAddr=%08X\n", 3667 __FILE__,__LINE__,info->device_name, info->phys_statctrl_base ); 3668 info->init_error = DiagStatus_CantAssignPciResources; 3669 goto errout; 3670 } 3671 info->statctrl_base += info->statctrl_offset; 3672 3673 if ( !memory_test(info) ) { 3674 printk( "%s(%d):Shared Memory Test failed for device %s MemAddr=%08X\n", 3675 __FILE__,__LINE__,info->device_name, info->phys_memory_base ); 3676 info->init_error = DiagStatus_MemoryError; 3677 goto errout; 3678 } 3679 3680 return 0; 3681 3682errout: 3683 release_resources( info ); 3684 return -ENODEV; 3685} 3686 3687static void release_resources(SLMP_INFO *info) 3688{ 3689 if ( debug_level >= DEBUG_LEVEL_INFO ) 3690 printk( "%s(%d):%s release_resources() entry\n", 3691 __FILE__,__LINE__,info->device_name ); 3692 3693 if ( info->irq_requested ) { 3694 free_irq(info->irq_level, info); 3695 info->irq_requested = false; 3696 } 3697 3698 if ( info->shared_mem_requested ) { 3699 release_mem_region(info->phys_memory_base,SCA_MEM_SIZE); 3700 info->shared_mem_requested = false; 3701 } 3702 if ( info->lcr_mem_requested ) { 3703 release_mem_region(info->phys_lcr_base + info->lcr_offset,128); 3704 info->lcr_mem_requested = false; 3705 } 3706 if ( info->sca_base_requested ) { 3707 release_mem_region(info->phys_sca_base + info->sca_offset,SCA_BASE_SIZE); 3708 info->sca_base_requested = false; 3709 } 3710 if ( info->sca_statctrl_requested ) { 3711 release_mem_region(info->phys_statctrl_base + info->statctrl_offset,SCA_REG_SIZE); 3712 info->sca_statctrl_requested = false; 3713 } 3714 3715 if (info->memory_base){ 3716 iounmap(info->memory_base); 3717 info->memory_base = NULL; 3718 } 3719 3720 if (info->sca_base) { 3721 iounmap(info->sca_base - info->sca_offset); 3722 info->sca_base=NULL; 3723 } 3724 3725 if (info->statctrl_base) { 3726 iounmap(info->statctrl_base - info->statctrl_offset); 3727 info->statctrl_base=NULL; 3728 } 3729 3730 if (info->lcr_base){ 3731 iounmap(info->lcr_base - info->lcr_offset); 3732 info->lcr_base = NULL; 3733 } 3734 3735 if ( debug_level >= DEBUG_LEVEL_INFO ) 3736 printk( "%s(%d):%s release_resources() exit\n", 3737 __FILE__,__LINE__,info->device_name ); 3738} 3739 3740/* Add the specified device instance data structure to the 3741 * global linked list of devices and increment the device count. 3742 */ 3743static void add_device(SLMP_INFO *info) 3744{ 3745 info->next_device = NULL; 3746 info->line = synclinkmp_device_count; 3747 sprintf(info->device_name,"ttySLM%dp%d",info->adapter_num,info->port_num); 3748 3749 if (info->line < MAX_DEVICES) { 3750 if (maxframe[info->line]) 3751 info->max_frame_size = maxframe[info->line]; 3752 } 3753 3754 synclinkmp_device_count++; 3755 3756 if ( !synclinkmp_device_list ) 3757 synclinkmp_device_list = info; 3758 else { 3759 SLMP_INFO *current_dev = synclinkmp_device_list; 3760 while( current_dev->next_device ) 3761 current_dev = current_dev->next_device; 3762 current_dev->next_device = info; 3763 } 3764 3765 if ( info->max_frame_size < 4096 ) 3766 info->max_frame_size = 4096; 3767 else if ( info->max_frame_size > 65535 ) 3768 info->max_frame_size = 65535; 3769 3770 printk( "SyncLink MultiPort %s: " 3771 "Mem=(%08x %08X %08x %08X) IRQ=%d MaxFrameSize=%u\n", 3772 info->device_name, 3773 info->phys_sca_base, 3774 info->phys_memory_base, 3775 info->phys_statctrl_base, 3776 info->phys_lcr_base, 3777 info->irq_level, 3778 info->max_frame_size ); 3779 3780#if SYNCLINK_GENERIC_HDLC 3781 hdlcdev_init(info); 3782#endif 3783} 3784 3785/* Allocate and initialize a device instance structure 3786 * 3787 * Return Value: pointer to SLMP_INFO if success, otherwise NULL 3788 */ 3789static SLMP_INFO *alloc_dev(int adapter_num, int port_num, struct pci_dev *pdev) 3790{ 3791 SLMP_INFO *info; 3792 3793 info = kzalloc(sizeof(SLMP_INFO), 3794 GFP_KERNEL); 3795 3796 if (!info) { 3797 printk("%s(%d) Error can't allocate device instance data for adapter %d, port %d\n", 3798 __FILE__,__LINE__, adapter_num, port_num); 3799 } else { 3800 tty_port_init(&info->port); 3801 info->magic = MGSL_MAGIC; 3802 INIT_WORK(&info->task, bh_handler); 3803 info->max_frame_size = 4096; 3804 info->port.close_delay = 5*HZ/10; 3805 info->port.closing_wait = 30*HZ; 3806 init_waitqueue_head(&info->status_event_wait_q); 3807 init_waitqueue_head(&info->event_wait_q); 3808 spin_lock_init(&info->netlock); 3809 memcpy(&info->params,&default_params,sizeof(MGSL_PARAMS)); 3810 info->idle_mode = HDLC_TXIDLE_FLAGS; 3811 info->adapter_num = adapter_num; 3812 info->port_num = port_num; 3813 3814 /* Copy configuration info to device instance data */ 3815 info->irq_level = pdev->irq; 3816 info->phys_lcr_base = pci_resource_start(pdev,0); 3817 info->phys_sca_base = pci_resource_start(pdev,2); 3818 info->phys_memory_base = pci_resource_start(pdev,3); 3819 info->phys_statctrl_base = pci_resource_start(pdev,4); 3820 3821 /* Because veremap only works on page boundaries we must map 3822 * a larger area than is actually implemented for the LCR 3823 * memory range. We map a full page starting at the page boundary. 3824 */ 3825 info->lcr_offset = info->phys_lcr_base & (PAGE_SIZE-1); 3826 info->phys_lcr_base &= ~(PAGE_SIZE-1); 3827 3828 info->sca_offset = info->phys_sca_base & (PAGE_SIZE-1); 3829 info->phys_sca_base &= ~(PAGE_SIZE-1); 3830 3831 info->statctrl_offset = info->phys_statctrl_base & (PAGE_SIZE-1); 3832 info->phys_statctrl_base &= ~(PAGE_SIZE-1); 3833 3834 info->bus_type = MGSL_BUS_TYPE_PCI; 3835 info->irq_flags = IRQF_SHARED; 3836 3837 setup_timer(&info->tx_timer, tx_timeout, (unsigned long)info); 3838 setup_timer(&info->status_timer, status_timeout, 3839 (unsigned long)info); 3840 3841 /* Store the PCI9050 misc control register value because a flaw 3842 * in the PCI9050 prevents LCR registers from being read if 3843 * BIOS assigns an LCR base address with bit 7 set. 3844 * 3845 * Only the misc control register is accessed for which only 3846 * write access is needed, so set an initial value and change 3847 * bits to the device instance data as we write the value 3848 * to the actual misc control register. 3849 */ 3850 info->misc_ctrl_value = 0x087e4546; 3851 3852 /* initial port state is unknown - if startup errors 3853 * occur, init_error will be set to indicate the 3854 * problem. Once the port is fully initialized, 3855 * this value will be set to 0 to indicate the 3856 * port is available. 3857 */ 3858 info->init_error = -1; 3859 } 3860 3861 return info; 3862} 3863 3864static void device_init(int adapter_num, struct pci_dev *pdev) 3865{ 3866 SLMP_INFO *port_array[SCA_MAX_PORTS]; 3867 int port; 3868 3869 /* allocate device instances for up to SCA_MAX_PORTS devices */ 3870 for ( port = 0; port < SCA_MAX_PORTS; ++port ) { 3871 port_array[port] = alloc_dev(adapter_num,port,pdev); 3872 if( port_array[port] == NULL ) { 3873 for ( --port; port >= 0; --port ) 3874 kfree(port_array[port]); 3875 return; 3876 } 3877 } 3878 3879 /* give copy of port_array to all ports and add to device list */ 3880 for ( port = 0; port < SCA_MAX_PORTS; ++port ) { 3881 memcpy(port_array[port]->port_array,port_array,sizeof(port_array)); 3882 add_device( port_array[port] ); 3883 spin_lock_init(&port_array[port]->lock); 3884 } 3885 3886 /* Allocate and claim adapter resources */ 3887 if ( !claim_resources(port_array[0]) ) { 3888 3889 alloc_dma_bufs(port_array[0]); 3890 3891 /* copy resource information from first port to others */ 3892 for ( port = 1; port < SCA_MAX_PORTS; ++port ) { 3893 port_array[port]->lock = port_array[0]->lock; 3894 port_array[port]->irq_level = port_array[0]->irq_level; 3895 port_array[port]->memory_base = port_array[0]->memory_base; 3896 port_array[port]->sca_base = port_array[0]->sca_base; 3897 port_array[port]->statctrl_base = port_array[0]->statctrl_base; 3898 port_array[port]->lcr_base = port_array[0]->lcr_base; 3899 alloc_dma_bufs(port_array[port]); 3900 } 3901 3902 if ( request_irq(port_array[0]->irq_level, 3903 synclinkmp_interrupt, 3904 port_array[0]->irq_flags, 3905 port_array[0]->device_name, 3906 port_array[0]) < 0 ) { 3907 printk( "%s(%d):%s Cant request interrupt, IRQ=%d\n", 3908 __FILE__,__LINE__, 3909 port_array[0]->device_name, 3910 port_array[0]->irq_level ); 3911 } 3912 else { 3913 port_array[0]->irq_requested = true; 3914 adapter_test(port_array[0]); 3915 } 3916 } 3917} 3918 3919static const struct tty_operations ops = { 3920 .open = open, 3921 .close = close, 3922 .write = write, 3923 .put_char = put_char, 3924 .flush_chars = flush_chars, 3925 .write_room = write_room, 3926 .chars_in_buffer = chars_in_buffer, 3927 .flush_buffer = flush_buffer, 3928 .ioctl = ioctl, 3929 .throttle = throttle, 3930 .unthrottle = unthrottle, 3931 .send_xchar = send_xchar, 3932 .break_ctl = set_break, 3933 .wait_until_sent = wait_until_sent, 3934 .read_proc = read_proc, 3935 .set_termios = set_termios, 3936 .stop = tx_hold, 3937 .start = tx_release, 3938 .hangup = hangup, 3939 .tiocmget = tiocmget, 3940 .tiocmset = tiocmset, 3941}; 3942 3943static void synclinkmp_cleanup(void) 3944{ 3945 int rc; 3946 SLMP_INFO *info; 3947 SLMP_INFO *tmp; 3948 3949 printk("Unloading %s %s\n", driver_name, driver_version); 3950 3951 if (serial_driver) { 3952 if ((rc = tty_unregister_driver(serial_driver))) 3953 printk("%s(%d) failed to unregister tty driver err=%d\n", 3954 __FILE__,__LINE__,rc); 3955 put_tty_driver(serial_driver); 3956 } 3957 3958 /* reset devices */ 3959 info = synclinkmp_device_list; 3960 while(info) { 3961 reset_port(info); 3962 info = info->next_device; 3963 } 3964 3965 /* release devices */ 3966 info = synclinkmp_device_list; 3967 while(info) { 3968#if SYNCLINK_GENERIC_HDLC 3969 hdlcdev_exit(info); 3970#endif 3971 free_dma_bufs(info); 3972 free_tmp_rx_buf(info); 3973 if ( info->port_num == 0 ) { 3974 if (info->sca_base) 3975 write_reg(info, LPR, 1); /* set low power mode */ 3976 release_resources(info); 3977 } 3978 tmp = info; 3979 info = info->next_device; 3980 kfree(tmp); 3981 } 3982 3983 pci_unregister_driver(&synclinkmp_pci_driver); 3984} 3985 3986/* Driver initialization entry point. 3987 */ 3988 3989static int __init synclinkmp_init(void) 3990{ 3991 int rc; 3992 3993 if (break_on_load) { 3994 synclinkmp_get_text_ptr(); 3995 BREAKPOINT(); 3996 } 3997 3998 printk("%s %s\n", driver_name, driver_version); 3999 4000 if ((rc = pci_register_driver(&synclinkmp_pci_driver)) < 0) { 4001 printk("%s:failed to register PCI driver, error=%d\n",__FILE__,rc); 4002 return rc; 4003 } 4004 4005 serial_driver = alloc_tty_driver(128); 4006 if (!serial_driver) { 4007 rc = -ENOMEM; 4008 goto error; 4009 } 4010 4011 /* Initialize the tty_driver structure */ 4012 4013 serial_driver->owner = THIS_MODULE; 4014 serial_driver->driver_name = "synclinkmp"; 4015 serial_driver->name = "ttySLM"; 4016 serial_driver->major = ttymajor; 4017 serial_driver->minor_start = 64; 4018 serial_driver->type = TTY_DRIVER_TYPE_SERIAL; 4019 serial_driver->subtype = SERIAL_TYPE_NORMAL; 4020 serial_driver->init_termios = tty_std_termios; 4021 serial_driver->init_termios.c_cflag = 4022 B9600 | CS8 | CREAD | HUPCL | CLOCAL; 4023 serial_driver->init_termios.c_ispeed = 9600; 4024 serial_driver->init_termios.c_ospeed = 9600; 4025 serial_driver->flags = TTY_DRIVER_REAL_RAW; 4026 tty_set_operations(serial_driver, &ops); 4027 if ((rc = tty_register_driver(serial_driver)) < 0) { 4028 printk("%s(%d):Couldn't register serial driver\n", 4029 __FILE__,__LINE__); 4030 put_tty_driver(serial_driver); 4031 serial_driver = NULL; 4032 goto error; 4033 } 4034 4035 printk("%s %s, tty major#%d\n", 4036 driver_name, driver_version, 4037 serial_driver->major); 4038 4039 return 0; 4040 4041error: 4042 synclinkmp_cleanup(); 4043 return rc; 4044} 4045 4046static void __exit synclinkmp_exit(void) 4047{ 4048 synclinkmp_cleanup(); 4049} 4050 4051module_init(synclinkmp_init); 4052module_exit(synclinkmp_exit); 4053 4054/* Set the port for internal loopback mode. 4055 * The TxCLK and RxCLK signals are generated from the BRG and 4056 * the TxD is looped back to the RxD internally. 4057 */ 4058static void enable_loopback(SLMP_INFO *info, int enable) 4059{ 4060 if (enable) { 4061 /* MD2 (Mode Register 2) 4062 * 01..00 CNCT<1..0> Channel Connection 11=Local Loopback 4063 */ 4064 write_reg(info, MD2, (unsigned char)(read_reg(info, MD2) | (BIT1 + BIT0))); 4065 4066 /* degate external TxC clock source */ 4067 info->port_array[0]->ctrlreg_value |= (BIT0 << (info->port_num * 2)); 4068 write_control_reg(info); 4069 4070 /* RXS/TXS (Rx/Tx clock source) 4071 * 07 Reserved, must be 0 4072 * 06..04 Clock Source, 100=BRG 4073 * 03..00 Clock Divisor, 0000=1 4074 */ 4075 write_reg(info, RXS, 0x40); 4076 write_reg(info, TXS, 0x40); 4077 4078 } else { 4079 /* MD2 (Mode Register 2) 4080 * 01..00 CNCT<1..0> Channel connection, 0=normal 4081 */ 4082 write_reg(info, MD2, (unsigned char)(read_reg(info, MD2) & ~(BIT1 + BIT0))); 4083 4084 /* RXS/TXS (Rx/Tx clock source) 4085 * 07 Reserved, must be 0 4086 * 06..04 Clock Source, 000=RxC/TxC Pin 4087 * 03..00 Clock Divisor, 0000=1 4088 */ 4089 write_reg(info, RXS, 0x00); 4090 write_reg(info, TXS, 0x00); 4091 } 4092 4093 /* set LinkSpeed if available, otherwise default to 2Mbps */ 4094 if (info->params.clock_speed) 4095 set_rate(info, info->params.clock_speed); 4096 else 4097 set_rate(info, 3686400); 4098} 4099 4100/* Set the baud rate register to the desired speed 4101 * 4102 * data_rate data rate of clock in bits per second 4103 * A data rate of 0 disables the AUX clock. 4104 */ 4105static void set_rate( SLMP_INFO *info, u32 data_rate ) 4106{ 4107 u32 TMCValue; 4108 unsigned char BRValue; 4109 u32 Divisor=0; 4110 4111 /* fBRG = fCLK/(TMC * 2^BR) 4112 */ 4113 if (data_rate != 0) { 4114 Divisor = 14745600/data_rate; 4115 if (!Divisor) 4116 Divisor = 1; 4117 4118 TMCValue = Divisor; 4119 4120 BRValue = 0; 4121 if (TMCValue != 1 && TMCValue != 2) { 4122 /* BRValue of 0 provides 50/50 duty cycle *only* when 4123 * TMCValue is 1 or 2. BRValue of 1 to 9 always provides 4124 * 50/50 duty cycle. 4125 */ 4126 BRValue = 1; 4127 TMCValue >>= 1; 4128 } 4129 4130 /* while TMCValue is too big for TMC register, divide 4131 * by 2 and increment BR exponent. 4132 */ 4133 for(; TMCValue > 256 && BRValue < 10; BRValue++) 4134 TMCValue >>= 1; 4135 4136 write_reg(info, TXS, 4137 (unsigned char)((read_reg(info, TXS) & 0xf0) | BRValue)); 4138 write_reg(info, RXS, 4139 (unsigned char)((read_reg(info, RXS) & 0xf0) | BRValue)); 4140 write_reg(info, TMC, (unsigned char)TMCValue); 4141 } 4142 else { 4143 write_reg(info, TXS,0); 4144 write_reg(info, RXS,0); 4145 write_reg(info, TMC, 0); 4146 } 4147} 4148 4149/* Disable receiver 4150 */ 4151static void rx_stop(SLMP_INFO *info) 4152{ 4153 if (debug_level >= DEBUG_LEVEL_ISR) 4154 printk("%s(%d):%s rx_stop()\n", 4155 __FILE__,__LINE__, info->device_name ); 4156 4157 write_reg(info, CMD, RXRESET); 4158 4159 info->ie0_value &= ~RXRDYE; 4160 write_reg(info, IE0, info->ie0_value); /* disable Rx data interrupts */ 4161 4162 write_reg(info, RXDMA + DSR, 0); /* disable Rx DMA */ 4163 write_reg(info, RXDMA + DCMD, SWABORT); /* reset/init Rx DMA */ 4164 write_reg(info, RXDMA + DIR, 0); /* disable Rx DMA interrupts */ 4165 4166 info->rx_enabled = false; 4167 info->rx_overflow = false; 4168} 4169 4170/* enable the receiver 4171 */ 4172static void rx_start(SLMP_INFO *info) 4173{ 4174 int i; 4175 4176 if (debug_level >= DEBUG_LEVEL_ISR) 4177 printk("%s(%d):%s rx_start()\n", 4178 __FILE__,__LINE__, info->device_name ); 4179 4180 write_reg(info, CMD, RXRESET); 4181 4182 if ( info->params.mode == MGSL_MODE_HDLC ) { 4183 /* HDLC, disabe IRQ on rxdata */ 4184 info->ie0_value &= ~RXRDYE; 4185 write_reg(info, IE0, info->ie0_value); 4186 4187 /* Reset all Rx DMA buffers and program rx dma */ 4188 write_reg(info, RXDMA + DSR, 0); /* disable Rx DMA */ 4189 write_reg(info, RXDMA + DCMD, SWABORT); /* reset/init Rx DMA */ 4190 4191 for (i = 0; i < info->rx_buf_count; i++) { 4192 info->rx_buf_list[i].status = 0xff; 4193 4194 // throttle to 4 shared memory writes at a time to prevent 4195 // hogging local bus (keep latency time for DMA requests low). 4196 if (!(i % 4)) 4197 read_status_reg(info); 4198 } 4199 info->current_rx_buf = 0; 4200 4201 /* set current/1st descriptor address */ 4202 write_reg16(info, RXDMA + CDA, 4203 info->rx_buf_list_ex[0].phys_entry); 4204 4205 /* set new last rx descriptor address */ 4206 write_reg16(info, RXDMA + EDA, 4207 info->rx_buf_list_ex[info->rx_buf_count - 1].phys_entry); 4208 4209 /* set buffer length (shared by all rx dma data buffers) */ 4210 write_reg16(info, RXDMA + BFL, SCABUFSIZE); 4211 4212 write_reg(info, RXDMA + DIR, 0x60); /* enable Rx DMA interrupts (EOM/BOF) */ 4213 write_reg(info, RXDMA + DSR, 0xf2); /* clear Rx DMA IRQs, enable Rx DMA */ 4214 } else { 4215 /* async, enable IRQ on rxdata */ 4216 info->ie0_value |= RXRDYE; 4217 write_reg(info, IE0, info->ie0_value); 4218 } 4219 4220 write_reg(info, CMD, RXENABLE); 4221 4222 info->rx_overflow = false; 4223 info->rx_enabled = true; 4224} 4225 4226/* Enable the transmitter and send a transmit frame if 4227 * one is loaded in the DMA buffers. 4228 */ 4229static void tx_start(SLMP_INFO *info) 4230{ 4231 if (debug_level >= DEBUG_LEVEL_ISR) 4232 printk("%s(%d):%s tx_start() tx_count=%d\n", 4233 __FILE__,__LINE__, info->device_name,info->tx_count ); 4234 4235 if (!info->tx_enabled ) { 4236 write_reg(info, CMD, TXRESET); 4237 write_reg(info, CMD, TXENABLE); 4238 info->tx_enabled = true; 4239 } 4240 4241 if ( info->tx_count ) { 4242 4243 /* If auto RTS enabled and RTS is inactive, then assert */ 4244 /* RTS and set a flag indicating that the driver should */ 4245 /* negate RTS when the transmission completes. */ 4246 4247 info->drop_rts_on_tx_done = false; 4248 4249 if (info->params.mode != MGSL_MODE_ASYNC) { 4250 4251 if ( info->params.flags & HDLC_FLAG_AUTO_RTS ) { 4252 get_signals( info ); 4253 if ( !(info->serial_signals & SerialSignal_RTS) ) { 4254 info->serial_signals |= SerialSignal_RTS; 4255 set_signals( info ); 4256 info->drop_rts_on_tx_done = true; 4257 } 4258 } 4259 4260 write_reg16(info, TRC0, 4261 (unsigned short)(((tx_negate_fifo_level-1)<<8) + tx_active_fifo_level)); 4262 4263 write_reg(info, TXDMA + DSR, 0); /* disable DMA channel */ 4264 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ 4265 4266 /* set TX CDA (current descriptor address) */ 4267 write_reg16(info, TXDMA + CDA, 4268 info->tx_buf_list_ex[0].phys_entry); 4269 4270 /* set TX EDA (last descriptor address) */ 4271 write_reg16(info, TXDMA + EDA, 4272 info->tx_buf_list_ex[info->last_tx_buf].phys_entry); 4273 4274 /* enable underrun IRQ */ 4275 info->ie1_value &= ~IDLE; 4276 info->ie1_value |= UDRN; 4277 write_reg(info, IE1, info->ie1_value); 4278 write_reg(info, SR1, (unsigned char)(IDLE + UDRN)); 4279 4280 write_reg(info, TXDMA + DIR, 0x40); /* enable Tx DMA interrupts (EOM) */ 4281 write_reg(info, TXDMA + DSR, 0xf2); /* clear Tx DMA IRQs, enable Tx DMA */ 4282 4283 mod_timer(&info->tx_timer, jiffies + 4284 msecs_to_jiffies(5000)); 4285 } 4286 else { 4287 tx_load_fifo(info); 4288 /* async, enable IRQ on txdata */ 4289 info->ie0_value |= TXRDYE; 4290 write_reg(info, IE0, info->ie0_value); 4291 } 4292 4293 info->tx_active = true; 4294 } 4295} 4296 4297/* stop the transmitter and DMA 4298 */ 4299static void tx_stop( SLMP_INFO *info ) 4300{ 4301 if (debug_level >= DEBUG_LEVEL_ISR) 4302 printk("%s(%d):%s tx_stop()\n", 4303 __FILE__,__LINE__, info->device_name ); 4304 4305 del_timer(&info->tx_timer); 4306 4307 write_reg(info, TXDMA + DSR, 0); /* disable DMA channel */ 4308 write_reg(info, TXDMA + DCMD, SWABORT); /* reset/init DMA channel */ 4309 4310 write_reg(info, CMD, TXRESET); 4311 4312 info->ie1_value &= ~(UDRN + IDLE); 4313 write_reg(info, IE1, info->ie1_value); /* disable tx status interrupts */ 4314 write_reg(info, SR1, (unsigned char)(IDLE + UDRN)); /* clear pending */ 4315 4316 info->ie0_value &= ~TXRDYE; 4317 write_reg(info, IE0, info->ie0_value); /* disable tx data interrupts */ 4318 4319 info->tx_enabled = false; 4320 info->tx_active = false; 4321} 4322 4323/* Fill the transmit FIFO until the FIFO is full or 4324 * there is no more data to load. 4325 */ 4326static void tx_load_fifo(SLMP_INFO *info) 4327{ 4328 u8 TwoBytes[2]; 4329 4330 /* do nothing is now tx data available and no XON/XOFF pending */ 4331 4332 if ( !info->tx_count && !info->x_char ) 4333 return; 4334 4335 /* load the Transmit FIFO until FIFOs full or all data sent */ 4336 4337 while( info->tx_count && (read_reg(info,SR0) & BIT1) ) { 4338 4339 /* there is more space in the transmit FIFO and */ 4340 /* there is more data in transmit buffer */ 4341 4342 if ( (info->tx_count > 1) && !info->x_char ) { 4343 /* write 16-bits */ 4344 TwoBytes[0] = info->tx_buf[info->tx_get++]; 4345 if (info->tx_get >= info->max_frame_size) 4346 info->tx_get -= info->max_frame_size; 4347 TwoBytes[1] = info->tx_buf[info->tx_get++]; 4348 if (info->tx_get >= info->max_frame_size) 4349 info->tx_get -= info->max_frame_size; 4350 4351 write_reg16(info, TRB, *((u16 *)TwoBytes)); 4352 4353 info->tx_count -= 2; 4354 info->icount.tx += 2; 4355 } else { 4356 /* only 1 byte left to transmit or 1 FIFO slot left */ 4357 4358 if (info->x_char) { 4359 /* transmit pending high priority char */ 4360 write_reg(info, TRB, info->x_char); 4361 info->x_char = 0; 4362 } else { 4363 write_reg(info, TRB, info->tx_buf[info->tx_get++]); 4364 if (info->tx_get >= info->max_frame_size) 4365 info->tx_get -= info->max_frame_size; 4366 info->tx_count--; 4367 } 4368 info->icount.tx++; 4369 } 4370 } 4371} 4372 4373/* Reset a port to a known state 4374 */ 4375static void reset_port(SLMP_INFO *info) 4376{ 4377 if (info->sca_base) { 4378 4379 tx_stop(info); 4380 rx_stop(info); 4381 4382 info->serial_signals &= ~(SerialSignal_DTR + SerialSignal_RTS); 4383 set_signals(info); 4384 4385 /* disable all port interrupts */ 4386 info->ie0_value = 0; 4387 info->ie1_value = 0; 4388 info->ie2_value = 0; 4389 write_reg(info, IE0, info->ie0_value); 4390 write_reg(info, IE1, info->ie1_value); 4391 write_reg(info, IE2, info->ie2_value); 4392 4393 write_reg(info, CMD, CHRESET); 4394 } 4395} 4396 4397/* Reset all the ports to a known state. 4398 */ 4399static void reset_adapter(SLMP_INFO *info) 4400{ 4401 int i; 4402 4403 for ( i=0; i < SCA_MAX_PORTS; ++i) { 4404 if (info->port_array[i]) 4405 reset_port(info->port_array[i]); 4406 } 4407} 4408 4409/* Program port for asynchronous communications. 4410 */ 4411static void async_mode(SLMP_INFO *info) 4412{ 4413 4414 unsigned char RegValue; 4415 4416 tx_stop(info); 4417 rx_stop(info); 4418 4419 /* MD0, Mode Register 0 4420 * 4421 * 07..05 PRCTL<2..0>, Protocol Mode, 000=async 4422 * 04 AUTO, Auto-enable (RTS/CTS/DCD) 4423 * 03 Reserved, must be 0 4424 * 02 CRCCC, CRC Calculation, 0=disabled 4425 * 01..00 STOP<1..0> Stop bits (00=1,10=2) 4426 * 4427 * 0000 0000 4428 */ 4429 RegValue = 0x00; 4430 if (info->params.stop_bits != 1) 4431 RegValue |= BIT1; 4432 write_reg(info, MD0, RegValue); 4433 4434 /* MD1, Mode Register 1 4435 * 4436 * 07..06 BRATE<1..0>, bit rate, 00=1/1 01=1/16 10=1/32 11=1/64 4437 * 05..04 TXCHR<1..0>, tx char size, 00=8 bits,01=7,10=6,11=5 4438 * 03..02 RXCHR<1..0>, rx char size 4439 * 01..00 PMPM<1..0>, Parity mode, 00=none 10=even 11=odd 4440 * 4441 * 0100 0000 4442 */ 4443 RegValue = 0x40; 4444 switch (info->params.data_bits) { 4445 case 7: RegValue |= BIT4 + BIT2; break; 4446 case 6: RegValue |= BIT5 + BIT3; break; 4447 case 5: RegValue |= BIT5 + BIT4 + BIT3 + BIT2; break; 4448 } 4449 if (info->params.parity != ASYNC_PARITY_NONE) { 4450 RegValue |= BIT1; 4451 if (info->params.parity == ASYNC_PARITY_ODD) 4452 RegValue |= BIT0; 4453 } 4454 write_reg(info, MD1, RegValue); 4455 4456 /* MD2, Mode Register 2 4457 * 4458 * 07..02 Reserved, must be 0 4459 * 01..00 CNCT<1..0> Channel connection, 00=normal 11=local loopback 4460 * 4461 * 0000 0000 4462 */ 4463 RegValue = 0x00; 4464 if (info->params.loopback) 4465 RegValue |= (BIT1 + BIT0); 4466 write_reg(info, MD2, RegValue); 4467 4468 /* RXS, Receive clock source 4469 * 4470 * 07 Reserved, must be 0 4471 * 06..04 RXCS<2..0>, clock source, 000=RxC Pin, 100=BRG, 110=DPLL 4472 * 03..00 RXBR<3..0>, rate divisor, 0000=1 4473 */ 4474 RegValue=BIT6; 4475 write_reg(info, RXS, RegValue); 4476 4477 /* TXS, Transmit clock source 4478 * 4479 * 07 Reserved, must be 0 4480 * 06..04 RXCS<2..0>, clock source, 000=TxC Pin, 100=BRG, 110=Receive Clock 4481 * 03..00 RXBR<3..0>, rate divisor, 0000=1 4482 */ 4483 RegValue=BIT6; 4484 write_reg(info, TXS, RegValue); 4485 4486 /* Control Register 4487 * 4488 * 6,4,2,0 CLKSEL<3..0>, 0 = TcCLK in, 1 = Auxclk out 4489 */ 4490 info->port_array[0]->ctrlreg_value |= (BIT0 << (info->port_num * 2)); 4491 write_control_reg(info); 4492 4493 tx_set_idle(info); 4494 4495 /* RRC Receive Ready Control 0 4496 * 4497 * 07..05 Reserved, must be 0 4498 * 04..00 RRC<4..0> Rx FIFO trigger active 0x00 = 1 byte 4499 */ 4500 write_reg(info, RRC, 0x00); 4501 4502 /* TRC0 Transmit Ready Control 0 4503 * 4504 * 07..05 Reserved, must be 0 4505 * 04..00 TRC<4..0> Tx FIFO trigger active 0x10 = 16 bytes 4506 */ 4507 write_reg(info, TRC0, 0x10); 4508 4509 /* TRC1 Transmit Ready Control 1 4510 * 4511 * 07..05 Reserved, must be 0 4512 * 04..00 TRC<4..0> Tx FIFO trigger inactive 0x1e = 31 bytes (full-1) 4513 */ 4514 write_reg(info, TRC1, 0x1e); 4515 4516 /* CTL, MSCI control register 4517 * 4518 * 07..06 Reserved, set to 0 4519 * 05 UDRNC, underrun control, 0=abort 1=CRC+flag (HDLC/BSC) 4520 * 04 IDLC, idle control, 0=mark 1=idle register 4521 * 03 BRK, break, 0=off 1 =on (async) 4522 * 02 SYNCLD, sync char load enable (BSC) 1=enabled 4523 * 01 GOP, go active on poll (LOOP mode) 1=enabled 4524 * 00 RTS, RTS output control, 0=active 1=inactive 4525 * 4526 * 0001 0001 4527 */ 4528 RegValue = 0x10; 4529 if (!(info->serial_signals & SerialSignal_RTS)) 4530 RegValue |= 0x01; 4531 write_reg(info, CTL, RegValue); 4532 4533 /* enable status interrupts */ 4534 info->ie0_value |= TXINTE + RXINTE; 4535 write_reg(info, IE0, info->ie0_value); 4536 4537 /* enable break detect interrupt */ 4538 info->ie1_value = BRKD; 4539 write_reg(info, IE1, info->ie1_value); 4540 4541 /* enable rx overrun interrupt */ 4542 info->ie2_value = OVRN; 4543 write_reg(info, IE2, info->ie2_value); 4544 4545 set_rate( info, info->params.data_rate * 16 ); 4546} 4547 4548/* Program the SCA for HDLC communications. 4549 */ 4550static void hdlc_mode(SLMP_INFO *info) 4551{ 4552 unsigned char RegValue; 4553 u32 DpllDivisor; 4554 4555 // Can't use DPLL because SCA outputs recovered clock on RxC when 4556 // DPLL mode selected. This causes output contention with RxC receiver. 4557 // Use of DPLL would require external hardware to disable RxC receiver 4558 // when DPLL mode selected. 4559 info->params.flags &= ~(HDLC_FLAG_TXC_DPLL + HDLC_FLAG_RXC_DPLL); 4560 4561 /* disable DMA interrupts */ 4562 write_reg(info, TXDMA + DIR, 0); 4563 write_reg(info, RXDMA + DIR, 0); 4564 4565 /* MD0, Mode Register 0 4566 * 4567 * 07..05 PRCTL<2..0>, Protocol Mode, 100=HDLC 4568 * 04 AUTO, Auto-enable (RTS/CTS/DCD) 4569 * 03 Reserved, must be 0 4570 * 02 CRCCC, CRC Calculation, 1=enabled 4571 * 01 CRC1, CRC selection, 0=CRC-16,1=CRC-CCITT-16 4572 * 00 CRC0, CRC initial value, 1 = all 1s 4573 * 4574 * 1000 0001 4575 */ 4576 RegValue = 0x81; 4577 if (info->params.flags & HDLC_FLAG_AUTO_CTS) 4578 RegValue |= BIT4; 4579 if (info->params.flags & HDLC_FLAG_AUTO_DCD) 4580 RegValue |= BIT4; 4581 if (info->params.crc_type == HDLC_CRC_16_CCITT) 4582 RegValue |= BIT2 + BIT1; 4583 write_reg(info, MD0, RegValue); 4584 4585 /* MD1, Mode Register 1 4586 * 4587 * 07..06 ADDRS<1..0>, Address detect, 00=no addr check 4588 * 05..04 TXCHR<1..0>, tx char size, 00=8 bits 4589 * 03..02 RXCHR<1..0>, rx char size, 00=8 bits 4590 * 01..00 PMPM<1..0>, Parity mode, 00=no parity 4591 * 4592 * 0000 0000 4593 */ 4594 RegValue = 0x00; 4595 write_reg(info, MD1, RegValue); 4596 4597 /* MD2, Mode Register 2 4598 * 4599 * 07 NRZFM, 0=NRZ, 1=FM 4600 * 06..05 CODE<1..0> Encoding, 00=NRZ 4601 * 04..03 DRATE<1..0> DPLL Divisor, 00=8 4602 * 02 Reserved, must be 0 4603 * 01..00 CNCT<1..0> Channel connection, 0=normal 4604 * 4605 * 0000 0000 4606 */ 4607 RegValue = 0x00; 4608 switch(info->params.encoding) { 4609 case HDLC_ENCODING_NRZI: RegValue |= BIT5; break; 4610 case HDLC_ENCODING_BIPHASE_MARK: RegValue |= BIT7 + BIT5; break; /* aka FM1 */ 4611 case HDLC_ENCODING_BIPHASE_SPACE: RegValue |= BIT7 + BIT6; break; /* aka FM0 */ 4612 case HDLC_ENCODING_BIPHASE_LEVEL: RegValue |= BIT7; break; /* aka Manchester */ 4613#if 0 4614 case HDLC_ENCODING_NRZB: /* not supported */ 4615 case HDLC_ENCODING_NRZI_MARK: /* not supported */ 4616 case HDLC_ENCODING_DIFF_BIPHASE_LEVEL: /* not supported */ 4617#endif 4618 } 4619 if ( info->params.flags & HDLC_FLAG_DPLL_DIV16 ) { 4620 DpllDivisor = 16; 4621 RegValue |= BIT3; 4622 } else if ( info->params.flags & HDLC_FLAG_DPLL_DIV8 ) { 4623 DpllDivisor = 8; 4624 } else { 4625 DpllDivisor = 32; 4626 RegValue |= BIT4; 4627 } 4628 write_reg(info, MD2, RegValue); 4629 4630 4631 /* RXS, Receive clock source 4632 * 4633 * 07 Reserved, must be 0 4634 * 06..04 RXCS<2..0>, clock source, 000=RxC Pin, 100=BRG, 110=DPLL 4635 * 03..00 RXBR<3..0>, rate divisor, 0000=1 4636 */ 4637 RegValue=0; 4638 if (info->params.flags & HDLC_FLAG_RXC_BRG) 4639 RegValue |= BIT6; 4640 if (info->params.flags & HDLC_FLAG_RXC_DPLL) 4641 RegValue |= BIT6 + BIT5; 4642 write_reg(info, RXS, RegValue); 4643 4644 /* TXS, Transmit clock source 4645 * 4646 * 07 Reserved, must be 0 4647 * 06..04 RXCS<2..0>, clock source, 000=TxC Pin, 100=BRG, 110=Receive Clock 4648 * 03..00 RXBR<3..0>, rate divisor, 0000=1 4649 */ 4650 RegValue=0; 4651 if (info->params.flags & HDLC_FLAG_TXC_BRG) 4652 RegValue |= BIT6; 4653 if (info->params.flags & HDLC_FLAG_TXC_DPLL) 4654 RegValue |= BIT6 + BIT5; 4655 write_reg(info, TXS, RegValue); 4656 4657 if (info->params.flags & HDLC_FLAG_RXC_DPLL) 4658 set_rate(info, info->params.clock_speed * DpllDivisor); 4659 else 4660 set_rate(info, info->params.clock_speed); 4661 4662 /* GPDATA (General Purpose I/O Data Register) 4663 * 4664 * 6,4,2,0 CLKSEL<3..0>, 0 = TcCLK in, 1 = Auxclk out 4665 */ 4666 if (info->params.flags & HDLC_FLAG_TXC_BRG) 4667 info->port_array[0]->ctrlreg_value |= (BIT0 << (info->port_num * 2)); 4668 else 4669 info->port_array[0]->ctrlreg_value &= ~(BIT0 << (info->port_num * 2)); 4670 write_control_reg(info); 4671 4672 /* RRC Receive Ready Control 0 4673 * 4674 * 07..05 Reserved, must be 0 4675 * 04..00 RRC<4..0> Rx FIFO trigger active 4676 */ 4677 write_reg(info, RRC, rx_active_fifo_level); 4678 4679 /* TRC0 Transmit Ready Control 0 4680 * 4681 * 07..05 Reserved, must be 0 4682 * 04..00 TRC<4..0> Tx FIFO trigger active 4683 */ 4684 write_reg(info, TRC0, tx_active_fifo_level); 4685 4686 /* TRC1 Transmit Ready Control 1 4687 * 4688 * 07..05 Reserved, must be 0 4689 * 04..00 TRC<4..0> Tx FIFO trigger inactive 0x1f = 32 bytes (full) 4690 */ 4691 write_reg(info, TRC1, (unsigned char)(tx_negate_fifo_level - 1)); 4692 4693 /* DMR, DMA Mode Register 4694 * 4695 * 07..05 Reserved, must be 0 4696 * 04 TMOD, Transfer Mode: 1=chained-block 4697 * 03 Reserved, must be 0 4698 * 02 NF, Number of Frames: 1=multi-frame 4699 * 01 CNTE, Frame End IRQ Counter enable: 0=disabled 4700 * 00 Reserved, must be 0 4701 * 4702 * 0001 0100 4703 */ 4704 write_reg(info, TXDMA + DMR, 0x14); 4705 write_reg(info, RXDMA + DMR, 0x14); 4706 4707 /* Set chain pointer base (upper 8 bits of 24 bit addr) */ 4708 write_reg(info, RXDMA + CPB, 4709 (unsigned char)(info->buffer_list_phys >> 16)); 4710 4711 /* Set chain pointer base (upper 8 bits of 24 bit addr) */ 4712 write_reg(info, TXDMA + CPB, 4713 (unsigned char)(info->buffer_list_phys >> 16)); 4714 4715 /* enable status interrupts. other code enables/disables 4716 * the individual sources for these two interrupt classes. 4717 */ 4718 info->ie0_value |= TXINTE + RXINTE; 4719 write_reg(info, IE0, info->ie0_value); 4720 4721 /* CTL, MSCI control register 4722 * 4723 * 07..06 Reserved, set to 0 4724 * 05 UDRNC, underrun control, 0=abort 1=CRC+flag (HDLC/BSC) 4725 * 04 IDLC, idle control, 0=mark 1=idle register 4726 * 03 BRK, break, 0=off 1 =on (async) 4727 * 02 SYNCLD, sync char load enable (BSC) 1=enabled 4728 * 01 GOP, go active on poll (LOOP mode) 1=enabled 4729 * 00 RTS, RTS output control, 0=active 1=inactive 4730 * 4731 * 0001 0001 4732 */ 4733 RegValue = 0x10; 4734 if (!(info->serial_signals & SerialSignal_RTS)) 4735 RegValue |= 0x01; 4736 write_reg(info, CTL, RegValue); 4737 4738 /* preamble not supported ! */ 4739 4740 tx_set_idle(info); 4741 tx_stop(info); 4742 rx_stop(info); 4743 4744 set_rate(info, info->params.clock_speed); 4745 4746 if (info->params.loopback) 4747 enable_loopback(info,1); 4748} 4749 4750/* Set the transmit HDLC idle mode 4751 */ 4752static void tx_set_idle(SLMP_INFO *info) 4753{ 4754 unsigned char RegValue = 0xff; 4755 4756 /* Map API idle mode to SCA register bits */ 4757 switch(info->idle_mode) { 4758 case HDLC_TXIDLE_FLAGS: RegValue = 0x7e; break; 4759 case HDLC_TXIDLE_ALT_ZEROS_ONES: RegValue = 0xaa; break; 4760 case HDLC_TXIDLE_ZEROS: RegValue = 0x00; break; 4761 case HDLC_TXIDLE_ONES: RegValue = 0xff; break; 4762 case HDLC_TXIDLE_ALT_MARK_SPACE: RegValue = 0xaa; break; 4763 case HDLC_TXIDLE_SPACE: RegValue = 0x00; break; 4764 case HDLC_TXIDLE_MARK: RegValue = 0xff; break; 4765 } 4766 4767 write_reg(info, IDL, RegValue); 4768} 4769 4770/* Query the adapter for the state of the V24 status (input) signals. 4771 */ 4772static void get_signals(SLMP_INFO *info) 4773{ 4774 u16 status = read_reg(info, SR3); 4775 u16 gpstatus = read_status_reg(info); 4776 u16 testbit; 4777 4778 /* clear all serial signals except DTR and RTS */ 4779 info->serial_signals &= SerialSignal_DTR + SerialSignal_RTS; 4780 4781 /* set serial signal bits to reflect MISR */ 4782 4783 if (!(status & BIT3)) 4784 info->serial_signals |= SerialSignal_CTS; 4785 4786 if ( !(status & BIT2)) 4787 info->serial_signals |= SerialSignal_DCD; 4788 4789 testbit = BIT1 << (info->port_num * 2); // Port 0..3 RI is GPDATA<1,3,5,7> 4790 if (!(gpstatus & testbit)) 4791 info->serial_signals |= SerialSignal_RI; 4792 4793 testbit = BIT0 << (info->port_num * 2); // Port 0..3 DSR is GPDATA<0,2,4,6> 4794 if (!(gpstatus & testbit)) 4795 info->serial_signals |= SerialSignal_DSR; 4796} 4797 4798/* Set the state of DTR and RTS based on contents of 4799 * serial_signals member of device context. 4800 */ 4801static void set_signals(SLMP_INFO *info) 4802{ 4803 unsigned char RegValue; 4804 u16 EnableBit; 4805 4806 RegValue = read_reg(info, CTL); 4807 if (info->serial_signals & SerialSignal_RTS) 4808 RegValue &= ~BIT0; 4809 else 4810 RegValue |= BIT0; 4811 write_reg(info, CTL, RegValue); 4812 4813 // Port 0..3 DTR is ctrl reg <1,3,5,7> 4814 EnableBit = BIT1 << (info->port_num*2); 4815 if (info->serial_signals & SerialSignal_DTR) 4816 info->port_array[0]->ctrlreg_value &= ~EnableBit; 4817 else 4818 info->port_array[0]->ctrlreg_value |= EnableBit; 4819 write_control_reg(info); 4820} 4821 4822/*******************/ 4823/* DMA Buffer Code */ 4824/*******************/ 4825 4826/* Set the count for all receive buffers to SCABUFSIZE 4827 * and set the current buffer to the first buffer. This effectively 4828 * makes all buffers free and discards any data in buffers. 4829 */ 4830static void rx_reset_buffers(SLMP_INFO *info) 4831{ 4832 rx_free_frame_buffers(info, 0, info->rx_buf_count - 1); 4833} 4834 4835/* Free the buffers used by a received frame 4836 * 4837 * info pointer to device instance data 4838 * first index of 1st receive buffer of frame 4839 * last index of last receive buffer of frame 4840 */ 4841static void rx_free_frame_buffers(SLMP_INFO *info, unsigned int first, unsigned int last) 4842{ 4843 bool done = false; 4844 4845 while(!done) { 4846 /* reset current buffer for reuse */ 4847 info->rx_buf_list[first].status = 0xff; 4848 4849 if (first == last) { 4850 done = true; 4851 /* set new last rx descriptor address */ 4852 write_reg16(info, RXDMA + EDA, info->rx_buf_list_ex[first].phys_entry); 4853 } 4854 4855 first++; 4856 if (first == info->rx_buf_count) 4857 first = 0; 4858 } 4859 4860 /* set current buffer to next buffer after last buffer of frame */ 4861 info->current_rx_buf = first; 4862} 4863 4864/* Return a received frame from the receive DMA buffers. 4865 * Only frames received without errors are returned. 4866 * 4867 * Return Value: true if frame returned, otherwise false 4868 */ 4869static bool rx_get_frame(SLMP_INFO *info) 4870{ 4871 unsigned int StartIndex, EndIndex; /* index of 1st and last buffers of Rx frame */ 4872 unsigned short status; 4873 unsigned int framesize = 0; 4874 bool ReturnCode = false; 4875 unsigned long flags; 4876 struct tty_struct *tty = info->port.tty; 4877 unsigned char addr_field = 0xff; 4878 SCADESC *desc; 4879 SCADESC_EX *desc_ex; 4880 4881CheckAgain: 4882 /* assume no frame returned, set zero length */ 4883 framesize = 0; 4884 addr_field = 0xff; 4885 4886 /* 4887 * current_rx_buf points to the 1st buffer of the next available 4888 * receive frame. To find the last buffer of the frame look for 4889 * a non-zero status field in the buffer entries. (The status 4890 * field is set by the 16C32 after completing a receive frame. 4891 */ 4892 StartIndex = EndIndex = info->current_rx_buf; 4893 4894 for ( ;; ) { 4895 desc = &info->rx_buf_list[EndIndex]; 4896 desc_ex = &info->rx_buf_list_ex[EndIndex]; 4897 4898 if (desc->status == 0xff) 4899 goto Cleanup; /* current desc still in use, no frames available */ 4900 4901 if (framesize == 0 && info->params.addr_filter != 0xff) 4902 addr_field = desc_ex->virt_addr[0]; 4903 4904 framesize += desc->length; 4905 4906 /* Status != 0 means last buffer of frame */ 4907 if (desc->status) 4908 break; 4909 4910 EndIndex++; 4911 if (EndIndex == info->rx_buf_count) 4912 EndIndex = 0; 4913 4914 if (EndIndex == info->current_rx_buf) { 4915 /* all buffers have been 'used' but none mark */ 4916 /* the end of a frame. Reset buffers and receiver. */ 4917 if ( info->rx_enabled ){ 4918 spin_lock_irqsave(&info->lock,flags); 4919 rx_start(info); 4920 spin_unlock_irqrestore(&info->lock,flags); 4921 } 4922 goto Cleanup; 4923 } 4924 4925 } 4926 4927 /* check status of receive frame */ 4928 4929 /* frame status is byte stored after frame data 4930 * 4931 * 7 EOM (end of msg), 1 = last buffer of frame 4932 * 6 Short Frame, 1 = short frame 4933 * 5 Abort, 1 = frame aborted 4934 * 4 Residue, 1 = last byte is partial 4935 * 3 Overrun, 1 = overrun occurred during frame reception 4936 * 2 CRC, 1 = CRC error detected 4937 * 4938 */ 4939 status = desc->status; 4940 4941 /* ignore CRC bit if not using CRC (bit is undefined) */ 4942 /* Note:CRC is not save to data buffer */ 4943 if (info->params.crc_type == HDLC_CRC_NONE) 4944 status &= ~BIT2; 4945 4946 if (framesize == 0 || 4947 (addr_field != 0xff && addr_field != info->params.addr_filter)) { 4948 /* discard 0 byte frames, this seems to occur sometime 4949 * when remote is idling flags. 4950 */ 4951 rx_free_frame_buffers(info, StartIndex, EndIndex); 4952 goto CheckAgain; 4953 } 4954 4955 if (framesize < 2) 4956 status |= BIT6; 4957 4958 if (status & (BIT6+BIT5+BIT3+BIT2)) { 4959 /* received frame has errors, 4960 * update counts and mark frame size as 0 4961 */ 4962 if (status & BIT6) 4963 info->icount.rxshort++; 4964 else if (status & BIT5) 4965 info->icount.rxabort++; 4966 else if (status & BIT3) 4967 info->icount.rxover++; 4968 else 4969 info->icount.rxcrc++; 4970 4971 framesize = 0; 4972#if SYNCLINK_GENERIC_HDLC 4973 { 4974 info->netdev->stats.rx_errors++; 4975 info->netdev->stats.rx_frame_errors++; 4976 } 4977#endif 4978 } 4979 4980 if ( debug_level >= DEBUG_LEVEL_BH ) 4981 printk("%s(%d):%s rx_get_frame() status=%04X size=%d\n", 4982 __FILE__,__LINE__,info->device_name,status,framesize); 4983 4984 if ( debug_level >= DEBUG_LEVEL_DATA ) 4985 trace_block(info,info->rx_buf_list_ex[StartIndex].virt_addr, 4986 min_t(int, framesize,SCABUFSIZE),0); 4987 4988 if (framesize) { 4989 if (framesize > info->max_frame_size) 4990 info->icount.rxlong++; 4991 else { 4992 /* copy dma buffer(s) to contiguous intermediate buffer */ 4993 int copy_count = framesize; 4994 int index = StartIndex; 4995 unsigned char *ptmp = info->tmp_rx_buf; 4996 info->tmp_rx_buf_count = framesize; 4997 4998 info->icount.rxok++; 4999 5000 while(copy_count) { 5001 int partial_count = min(copy_count,SCABUFSIZE); 5002 memcpy( ptmp, 5003 info->rx_buf_list_ex[index].virt_addr, 5004 partial_count ); 5005 ptmp += partial_count; 5006 copy_count -= partial_count; 5007 5008 if ( ++index == info->rx_buf_count ) 5009 index = 0; 5010 } 5011 5012#if SYNCLINK_GENERIC_HDLC 5013 if (info->netcount) 5014 hdlcdev_rx(info,info->tmp_rx_buf,framesize); 5015 else 5016#endif 5017 ldisc_receive_buf(tty,info->tmp_rx_buf, 5018 info->flag_buf, framesize); 5019 } 5020 } 5021 /* Free the buffers used by this frame. */ 5022 rx_free_frame_buffers( info, StartIndex, EndIndex ); 5023 5024 ReturnCode = true; 5025 5026Cleanup: 5027 if ( info->rx_enabled && info->rx_overflow ) { 5028 /* Receiver is enabled, but needs to restarted due to 5029 * rx buffer overflow. If buffers are empty, restart receiver. 5030 */ 5031 if (info->rx_buf_list[EndIndex].status == 0xff) { 5032 spin_lock_irqsave(&info->lock,flags); 5033 rx_start(info); 5034 spin_unlock_irqrestore(&info->lock,flags); 5035 } 5036 } 5037 5038 return ReturnCode; 5039} 5040 5041/* load the transmit DMA buffer with data 5042 */ 5043static void tx_load_dma_buffer(SLMP_INFO *info, const char *buf, unsigned int count) 5044{ 5045 unsigned short copy_count; 5046 unsigned int i = 0; 5047 SCADESC *desc; 5048 SCADESC_EX *desc_ex; 5049 5050 if ( debug_level >= DEBUG_LEVEL_DATA ) 5051 trace_block(info,buf, min_t(int, count,SCABUFSIZE), 1); 5052 5053 /* Copy source buffer to one or more DMA buffers, starting with 5054 * the first transmit dma buffer. 5055 */ 5056 for(i=0;;) 5057 { 5058 copy_count = min_t(unsigned short,count,SCABUFSIZE); 5059 5060 desc = &info->tx_buf_list[i]; 5061 desc_ex = &info->tx_buf_list_ex[i]; 5062 5063 load_pci_memory(info, desc_ex->virt_addr,buf,copy_count); 5064 5065 desc->length = copy_count; 5066 desc->status = 0; 5067 5068 buf += copy_count; 5069 count -= copy_count; 5070 5071 if (!count) 5072 break; 5073 5074 i++; 5075 if (i >= info->tx_buf_count) 5076 i = 0; 5077 } 5078 5079 info->tx_buf_list[i].status = 0x81; /* set EOM and EOT status */ 5080 info->last_tx_buf = ++i; 5081} 5082 5083static bool register_test(SLMP_INFO *info) 5084{ 5085 static unsigned char testval[] = {0x00, 0xff, 0xaa, 0x55, 0x69, 0x96}; 5086 static unsigned int count = ARRAY_SIZE(testval); 5087 unsigned int i; 5088 bool rc = true; 5089 unsigned long flags; 5090 5091 spin_lock_irqsave(&info->lock,flags); 5092 reset_port(info); 5093 5094 /* assume failure */ 5095 info->init_error = DiagStatus_AddressFailure; 5096 5097 /* Write bit patterns to various registers but do it out of */ 5098 /* sync, then read back and verify values. */ 5099 5100 for (i = 0 ; i < count ; i++) { 5101 write_reg(info, TMC, testval[i]); 5102 write_reg(info, IDL, testval[(i+1)%count]); 5103 write_reg(info, SA0, testval[(i+2)%count]); 5104 write_reg(info, SA1, testval[(i+3)%count]); 5105 5106 if ( (read_reg(info, TMC) != testval[i]) || 5107 (read_reg(info, IDL) != testval[(i+1)%count]) || 5108 (read_reg(info, SA0) != testval[(i+2)%count]) || 5109 (read_reg(info, SA1) != testval[(i+3)%count]) ) 5110 { 5111 rc = false; 5112 break; 5113 } 5114 } 5115 5116 reset_port(info); 5117 spin_unlock_irqrestore(&info->lock,flags); 5118 5119 return rc; 5120} 5121 5122static bool irq_test(SLMP_INFO *info) 5123{ 5124 unsigned long timeout; 5125 unsigned long flags; 5126 5127 unsigned char timer = (info->port_num & 1) ? TIMER2 : TIMER0; 5128 5129 spin_lock_irqsave(&info->lock,flags); 5130 reset_port(info); 5131 5132 /* assume failure */ 5133 info->init_error = DiagStatus_IrqFailure; 5134 info->irq_occurred = false; 5135 5136 /* setup timer0 on SCA0 to interrupt */ 5137 5138 /* IER2<7..4> = timer<3..0> interrupt enables (1=enabled) */ 5139 write_reg(info, IER2, (unsigned char)((info->port_num & 1) ? BIT6 : BIT4)); 5140 5141 write_reg(info, (unsigned char)(timer + TEPR), 0); /* timer expand prescale */ 5142 write_reg16(info, (unsigned char)(timer + TCONR), 1); /* timer constant */ 5143 5144 5145 /* TMCS, Timer Control/Status Register 5146 * 5147 * 07 CMF, Compare match flag (read only) 1=match 5148 * 06 ECMI, CMF Interrupt Enable: 1=enabled 5149 * 05 Reserved, must be 0 5150 * 04 TME, Timer Enable 5151 * 03..00 Reserved, must be 0 5152 * 5153 * 0101 0000 5154 */ 5155 write_reg(info, (unsigned char)(timer + TMCS), 0x50); 5156 5157 spin_unlock_irqrestore(&info->lock,flags); 5158 5159 timeout=100; 5160 while( timeout-- && !info->irq_occurred ) { 5161 msleep_interruptible(10); 5162 } 5163 5164 spin_lock_irqsave(&info->lock,flags); 5165 reset_port(info); 5166 spin_unlock_irqrestore(&info->lock,flags); 5167 5168 return info->irq_occurred; 5169} 5170 5171/* initialize individual SCA device (2 ports) 5172 */ 5173static bool sca_init(SLMP_INFO *info) 5174{ 5175 /* set wait controller to single mem partition (low), no wait states */ 5176 write_reg(info, PABR0, 0); /* wait controller addr boundary 0 */ 5177 write_reg(info, PABR1, 0); /* wait controller addr boundary 1 */ 5178 write_reg(info, WCRL, 0); /* wait controller low range */ 5179 write_reg(info, WCRM, 0); /* wait controller mid range */ 5180 write_reg(info, WCRH, 0); /* wait controller high range */ 5181 5182 /* DPCR, DMA Priority Control 5183 * 5184 * 07..05 Not used, must be 0 5185 * 04 BRC, bus release condition: 0=all transfers complete 5186 * 03 CCC, channel change condition: 0=every cycle 5187 * 02..00 PR<2..0>, priority 100=round robin 5188 * 5189 * 00000100 = 0x04 5190 */ 5191 write_reg(info, DPCR, dma_priority); 5192 5193 /* DMA Master Enable, BIT7: 1=enable all channels */ 5194 write_reg(info, DMER, 0x80); 5195 5196 /* enable all interrupt classes */ 5197 write_reg(info, IER0, 0xff); /* TxRDY,RxRDY,TxINT,RxINT (ports 0-1) */ 5198 write_reg(info, IER1, 0xff); /* DMIB,DMIA (channels 0-3) */ 5199 write_reg(info, IER2, 0xf0); /* TIRQ (timers 0-3) */ 5200 5201 /* ITCR, interrupt control register 5202 * 07 IPC, interrupt priority, 0=MSCI->DMA 5203 * 06..05 IAK<1..0>, Acknowledge cycle, 00=non-ack cycle 5204 * 04 VOS, Vector Output, 0=unmodified vector 5205 * 03..00 Reserved, must be 0 5206 */ 5207 write_reg(info, ITCR, 0); 5208 5209 return true; 5210} 5211 5212/* initialize adapter hardware 5213 */ 5214static bool init_adapter(SLMP_INFO *info) 5215{ 5216 int i; 5217 5218 /* Set BIT30 of Local Control Reg 0x50 to reset SCA */ 5219 volatile u32 *MiscCtrl = (u32 *)(info->lcr_base + 0x50); 5220 u32 readval; 5221 5222 info->misc_ctrl_value |= BIT30; 5223 *MiscCtrl = info->misc_ctrl_value; 5224 5225 /* 5226 * Force at least 170ns delay before clearing 5227 * reset bit. Each read from LCR takes at least 5228 * 30ns so 10 times for 300ns to be safe. 5229 */ 5230 for(i=0;i<10;i++) 5231 readval = *MiscCtrl; 5232 5233 info->misc_ctrl_value &= ~BIT30; 5234 *MiscCtrl = info->misc_ctrl_value; 5235 5236 /* init control reg (all DTRs off, all clksel=input) */ 5237 info->ctrlreg_value = 0xaa; 5238 write_control_reg(info); 5239 5240 { 5241 volatile u32 *LCR1BRDR = (u32 *)(info->lcr_base + 0x2c); 5242 lcr1_brdr_value &= ~(BIT5 + BIT4 + BIT3); 5243 5244 switch(read_ahead_count) 5245 { 5246 case 16: 5247 lcr1_brdr_value |= BIT5 + BIT4 + BIT3; 5248 break; 5249 case 8: 5250 lcr1_brdr_value |= BIT5 + BIT4; 5251 break; 5252 case 4: 5253 lcr1_brdr_value |= BIT5 + BIT3; 5254 break; 5255 case 0: 5256 lcr1_brdr_value |= BIT5; 5257 break; 5258 } 5259 5260 *LCR1BRDR = lcr1_brdr_value; 5261 *MiscCtrl = misc_ctrl_value; 5262 } 5263 5264 sca_init(info->port_array[0]); 5265 sca_init(info->port_array[2]); 5266 5267 return true; 5268} 5269 5270/* Loopback an HDLC frame to test the hardware 5271 * interrupt and DMA functions. 5272 */ 5273static bool loopback_test(SLMP_INFO *info) 5274{ 5275#define TESTFRAMESIZE 20 5276 5277 unsigned long timeout; 5278 u16 count = TESTFRAMESIZE; 5279 unsigned char buf[TESTFRAMESIZE]; 5280 bool rc = false; 5281 unsigned long flags; 5282 5283 struct tty_struct *oldtty = info->port.tty; 5284 u32 speed = info->params.clock_speed; 5285 5286 info->params.clock_speed = 3686400; 5287 info->port.tty = NULL; 5288 5289 /* assume failure */ 5290 info->init_error = DiagStatus_DmaFailure; 5291 5292 /* build and send transmit frame */ 5293 for (count = 0; count < TESTFRAMESIZE;++count) 5294 buf[count] = (unsigned char)count; 5295 5296 memset(info->tmp_rx_buf,0,TESTFRAMESIZE); 5297 5298 /* program hardware for HDLC and enabled receiver */ 5299 spin_lock_irqsave(&info->lock,flags); 5300 hdlc_mode(info); 5301 enable_loopback(info,1); 5302 rx_start(info); 5303 info->tx_count = count; 5304 tx_load_dma_buffer(info,buf,count); 5305 tx_start(info); 5306 spin_unlock_irqrestore(&info->lock,flags); 5307 5308 /* wait for receive complete */ 5309 /* Set a timeout for waiting for interrupt. */ 5310 for ( timeout = 100; timeout; --timeout ) { 5311 msleep_interruptible(10); 5312 5313 if (rx_get_frame(info)) { 5314 rc = true; 5315 break; 5316 } 5317 } 5318 5319 /* verify received frame length and contents */ 5320 if (rc && 5321 ( info->tmp_rx_buf_count != count || 5322 memcmp(buf, info->tmp_rx_buf,count))) { 5323 rc = false; 5324 } 5325 5326 spin_lock_irqsave(&info->lock,flags); 5327 reset_adapter(info); 5328 spin_unlock_irqrestore(&info->lock,flags); 5329 5330 info->params.clock_speed = speed; 5331 info->port.tty = oldtty; 5332 5333 return rc; 5334} 5335 5336/* Perform diagnostics on hardware 5337 */ 5338static int adapter_test( SLMP_INFO *info ) 5339{ 5340 unsigned long flags; 5341 if ( debug_level >= DEBUG_LEVEL_INFO ) 5342 printk( "%s(%d):Testing device %s\n", 5343 __FILE__,__LINE__,info->device_name ); 5344 5345 spin_lock_irqsave(&info->lock,flags); 5346 init_adapter(info); 5347 spin_unlock_irqrestore(&info->lock,flags); 5348 5349 info->port_array[0]->port_count = 0; 5350 5351 if ( register_test(info->port_array[0]) && 5352 register_test(info->port_array[1])) { 5353 5354 info->port_array[0]->port_count = 2; 5355 5356 if ( register_test(info->port_array[2]) && 5357 register_test(info->port_array[3]) ) 5358 info->port_array[0]->port_count += 2; 5359 } 5360 else { 5361 printk( "%s(%d):Register test failure for device %s Addr=%08lX\n", 5362 __FILE__,__LINE__,info->device_name, (unsigned long)(info->phys_sca_base)); 5363 return -ENODEV; 5364 } 5365 5366 if ( !irq_test(info->port_array[0]) || 5367 !irq_test(info->port_array[1]) || 5368 (info->port_count == 4 && !irq_test(info->port_array[2])) || 5369 (info->port_count == 4 && !irq_test(info->port_array[3]))) { 5370 printk( "%s(%d):Interrupt test failure for device %s IRQ=%d\n", 5371 __FILE__,__LINE__,info->device_name, (unsigned short)(info->irq_level) ); 5372 return -ENODEV; 5373 } 5374 5375 if (!loopback_test(info->port_array[0]) || 5376 !loopback_test(info->port_array[1]) || 5377 (info->port_count == 4 && !loopback_test(info->port_array[2])) || 5378 (info->port_count == 4 && !loopback_test(info->port_array[3]))) { 5379 printk( "%s(%d):DMA test failure for device %s\n", 5380 __FILE__,__LINE__,info->device_name); 5381 return -ENODEV; 5382 } 5383 5384 if ( debug_level >= DEBUG_LEVEL_INFO ) 5385 printk( "%s(%d):device %s passed diagnostics\n", 5386 __FILE__,__LINE__,info->device_name ); 5387 5388 info->port_array[0]->init_error = 0; 5389 info->port_array[1]->init_error = 0; 5390 if ( info->port_count > 2 ) { 5391 info->port_array[2]->init_error = 0; 5392 info->port_array[3]->init_error = 0; 5393 } 5394 5395 return 0; 5396} 5397 5398/* Test the shared memory on a PCI adapter. 5399 */ 5400static bool memory_test(SLMP_INFO *info) 5401{ 5402 static unsigned long testval[] = { 0x0, 0x55555555, 0xaaaaaaaa, 5403 0x66666666, 0x99999999, 0xffffffff, 0x12345678 }; 5404 unsigned long count = ARRAY_SIZE(testval); 5405 unsigned long i; 5406 unsigned long limit = SCA_MEM_SIZE/sizeof(unsigned long); 5407 unsigned long * addr = (unsigned long *)info->memory_base; 5408 5409 /* Test data lines with test pattern at one location. */ 5410 5411 for ( i = 0 ; i < count ; i++ ) { 5412 *addr = testval[i]; 5413 if ( *addr != testval[i] ) 5414 return false; 5415 } 5416 5417 /* Test address lines with incrementing pattern over */ 5418 /* entire address range. */ 5419 5420 for ( i = 0 ; i < limit ; i++ ) { 5421 *addr = i * 4; 5422 addr++; 5423 } 5424 5425 addr = (unsigned long *)info->memory_base; 5426 5427 for ( i = 0 ; i < limit ; i++ ) { 5428 if ( *addr != i * 4 ) 5429 return false; 5430 addr++; 5431 } 5432 5433 memset( info->memory_base, 0, SCA_MEM_SIZE ); 5434 return true; 5435} 5436 5437/* Load data into PCI adapter shared memory. 5438 * 5439 * The PCI9050 releases control of the local bus 5440 * after completing the current read or write operation. 5441 * 5442 * While the PCI9050 write FIFO not empty, the 5443 * PCI9050 treats all of the writes as a single transaction 5444 * and does not release the bus. This causes DMA latency problems 5445 * at high speeds when copying large data blocks to the shared memory. 5446 * 5447 * This function breaks a write into multiple transations by 5448 * interleaving a read which flushes the write FIFO and 'completes' 5449 * the write transation. This allows any pending DMA request to gain control 5450 * of the local bus in a timely fasion. 5451 */ 5452static void load_pci_memory(SLMP_INFO *info, char* dest, const char* src, unsigned short count) 5453{ 5454 /* A load interval of 16 allows for 4 32-bit writes at */ 5455 /* 136ns each for a maximum latency of 542ns on the local bus.*/ 5456 5457 unsigned short interval = count / sca_pci_load_interval; 5458 unsigned short i; 5459 5460 for ( i = 0 ; i < interval ; i++ ) 5461 { 5462 memcpy(dest, src, sca_pci_load_interval); 5463 read_status_reg(info); 5464 dest += sca_pci_load_interval; 5465 src += sca_pci_load_interval; 5466 } 5467 5468 memcpy(dest, src, count % sca_pci_load_interval); 5469} 5470 5471static void trace_block(SLMP_INFO *info,const char* data, int count, int xmit) 5472{ 5473 int i; 5474 int linecount; 5475 if (xmit) 5476 printk("%s tx data:\n",info->device_name); 5477 else 5478 printk("%s rx data:\n",info->device_name); 5479 5480 while(count) { 5481 if (count > 16) 5482 linecount = 16; 5483 else 5484 linecount = count; 5485 5486 for(i=0;i<linecount;i++) 5487 printk("%02X ",(unsigned char)data[i]); 5488 for(;i<17;i++) 5489 printk(" "); 5490 for(i=0;i<linecount;i++) { 5491 if (data[i]>=040 && data[i]<=0176) 5492 printk("%c",data[i]); 5493 else 5494 printk("."); 5495 } 5496 printk("\n"); 5497 5498 data += linecount; 5499 count -= linecount; 5500 } 5501} /* end of trace_block() */ 5502 5503/* called when HDLC frame times out 5504 * update stats and do tx completion processing 5505 */ 5506static void tx_timeout(unsigned long context) 5507{ 5508 SLMP_INFO *info = (SLMP_INFO*)context; 5509 unsigned long flags; 5510 5511 if ( debug_level >= DEBUG_LEVEL_INFO ) 5512 printk( "%s(%d):%s tx_timeout()\n", 5513 __FILE__,__LINE__,info->device_name); 5514 if(info->tx_active && info->params.mode == MGSL_MODE_HDLC) { 5515 info->icount.txtimeout++; 5516 } 5517 spin_lock_irqsave(&info->lock,flags); 5518 info->tx_active = false; 5519 info->tx_count = info->tx_put = info->tx_get = 0; 5520 5521 spin_unlock_irqrestore(&info->lock,flags); 5522 5523#if SYNCLINK_GENERIC_HDLC 5524 if (info->netcount) 5525 hdlcdev_tx_done(info); 5526 else 5527#endif 5528 bh_transmit(info); 5529} 5530 5531/* called to periodically check the DSR/RI modem signal input status 5532 */ 5533static void status_timeout(unsigned long context) 5534{ 5535 u16 status = 0; 5536 SLMP_INFO *info = (SLMP_INFO*)context; 5537 unsigned long flags; 5538 unsigned char delta; 5539 5540 5541 spin_lock_irqsave(&info->lock,flags); 5542 get_signals(info); 5543 spin_unlock_irqrestore(&info->lock,flags); 5544 5545 /* check for DSR/RI state change */ 5546 5547 delta = info->old_signals ^ info->serial_signals; 5548 info->old_signals = info->serial_signals; 5549 5550 if (delta & SerialSignal_DSR) 5551 status |= MISCSTATUS_DSR_LATCHED|(info->serial_signals&SerialSignal_DSR); 5552 5553 if (delta & SerialSignal_RI) 5554 status |= MISCSTATUS_RI_LATCHED|(info->serial_signals&SerialSignal_RI); 5555 5556 if (delta & SerialSignal_DCD) 5557 status |= MISCSTATUS_DCD_LATCHED|(info->serial_signals&SerialSignal_DCD); 5558 5559 if (delta & SerialSignal_CTS) 5560 status |= MISCSTATUS_CTS_LATCHED|(info->serial_signals&SerialSignal_CTS); 5561 5562 if (status) 5563 isr_io_pin(info,status); 5564 5565 mod_timer(&info->status_timer, jiffies + msecs_to_jiffies(10)); 5566} 5567 5568 5569/* Register Access Routines - 5570 * All registers are memory mapped 5571 */ 5572#define CALC_REGADDR() \ 5573 unsigned char * RegAddr = (unsigned char*)(info->sca_base + Addr); \ 5574 if (info->port_num > 1) \ 5575 RegAddr += 256; /* port 0-1 SCA0, 2-3 SCA1 */ \ 5576 if ( info->port_num & 1) { \ 5577 if (Addr > 0x7f) \ 5578 RegAddr += 0x40; /* DMA access */ \ 5579 else if (Addr > 0x1f && Addr < 0x60) \ 5580 RegAddr += 0x20; /* MSCI access */ \ 5581 } 5582 5583 5584static unsigned char read_reg(SLMP_INFO * info, unsigned char Addr) 5585{ 5586 CALC_REGADDR(); 5587 return *RegAddr; 5588} 5589static void write_reg(SLMP_INFO * info, unsigned char Addr, unsigned char Value) 5590{ 5591 CALC_REGADDR(); 5592 *RegAddr = Value; 5593} 5594 5595static u16 read_reg16(SLMP_INFO * info, unsigned char Addr) 5596{ 5597 CALC_REGADDR(); 5598 return *((u16 *)RegAddr); 5599} 5600 5601static void write_reg16(SLMP_INFO * info, unsigned char Addr, u16 Value) 5602{ 5603 CALC_REGADDR(); 5604 *((u16 *)RegAddr) = Value; 5605} 5606 5607static unsigned char read_status_reg(SLMP_INFO * info) 5608{ 5609 unsigned char *RegAddr = (unsigned char *)info->statctrl_base; 5610 return *RegAddr; 5611} 5612 5613static void write_control_reg(SLMP_INFO * info) 5614{ 5615 unsigned char *RegAddr = (unsigned char *)info->statctrl_base; 5616 *RegAddr = info->port_array[0]->ctrlreg_value; 5617} 5618 5619 5620static int __devinit synclinkmp_init_one (struct pci_dev *dev, 5621 const struct pci_device_id *ent) 5622{ 5623 if (pci_enable_device(dev)) { 5624 printk("error enabling pci device %p\n", dev); 5625 return -EIO; 5626 } 5627 device_init( ++synclinkmp_adapter_count, dev ); 5628 return 0; 5629} 5630 5631static void __devexit synclinkmp_remove_one (struct pci_dev *dev) 5632{ 5633}