xref: /openbmc/linux/drivers/net/wan/wanxl.c (revision f0328a19)
125763b3cSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
21da177e4SLinus Torvalds /*
31da177e4SLinus Torvalds  * wanXL serial card driver for Linux
41da177e4SLinus Torvalds  * host part
51da177e4SLinus Torvalds  *
61da177e4SLinus Torvalds  * Copyright (C) 2003 Krzysztof Halasa <khc@pm.waw.pl>
71da177e4SLinus Torvalds  *
81da177e4SLinus Torvalds  * Status:
91da177e4SLinus Torvalds  *   - Only DTE (external clock) support with NRZ and NRZI encodings
101da177e4SLinus Torvalds  *   - wanXL100 will require minor driver modifications, no access to hw
111da177e4SLinus Torvalds  */
121da177e4SLinus Torvalds 
1312a3bfefSJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
1412a3bfefSJoe Perches 
151da177e4SLinus Torvalds #include <linux/module.h>
161da177e4SLinus Torvalds #include <linux/kernel.h>
171da177e4SLinus Torvalds #include <linux/slab.h>
181da177e4SLinus Torvalds #include <linux/sched.h>
191da177e4SLinus Torvalds #include <linux/types.h>
201da177e4SLinus Torvalds #include <linux/fcntl.h>
211da177e4SLinus Torvalds #include <linux/string.h>
221da177e4SLinus Torvalds #include <linux/errno.h>
231da177e4SLinus Torvalds #include <linux/init.h>
24a6b7a407SAlexey Dobriyan #include <linux/interrupt.h>
251da177e4SLinus Torvalds #include <linux/ioport.h>
261da177e4SLinus Torvalds #include <linux/netdevice.h>
271da177e4SLinus Torvalds #include <linux/hdlc.h>
281da177e4SLinus Torvalds #include <linux/pci.h>
291e7f0bd8SDomen Puncer #include <linux/dma-mapping.h>
30164006daSAl Viro #include <linux/delay.h>
311da177e4SLinus Torvalds #include <asm/io.h>
321da177e4SLinus Torvalds 
331da177e4SLinus Torvalds #include "wanxl.h"
341da177e4SLinus Torvalds 
351da177e4SLinus Torvalds static const char *version = "wanXL serial card driver version: 0.48";
361da177e4SLinus Torvalds 
371da177e4SLinus Torvalds #define PLX_CTL_RESET   0x40000000 /* adapter reset */
381da177e4SLinus Torvalds 
391da177e4SLinus Torvalds #undef DEBUG_PKT
401da177e4SLinus Torvalds #undef DEBUG_PCI
411da177e4SLinus Torvalds 
421da177e4SLinus Torvalds /* MAILBOX #1 - PUTS COMMANDS */
431da177e4SLinus Torvalds #define MBX1_CMD_ABORTJ 0x85000000 /* Abort and Jump */
441da177e4SLinus Torvalds #ifdef __LITTLE_ENDIAN
451da177e4SLinus Torvalds #define MBX1_CMD_BSWAP  0x8C000001 /* little-endian Byte Swap Mode */
461da177e4SLinus Torvalds #else
471da177e4SLinus Torvalds #define MBX1_CMD_BSWAP  0x8C000000 /* big-endian Byte Swap Mode */
481da177e4SLinus Torvalds #endif
491da177e4SLinus Torvalds 
501da177e4SLinus Torvalds /* MAILBOX #2 - DRAM SIZE */
511da177e4SLinus Torvalds #define MBX2_MEMSZ_MASK 0xFFFF0000 /* PUTS Memory Size Register mask */
521da177e4SLinus Torvalds 
53db569581SHimangi Saraogi struct port {
541da177e4SLinus Torvalds 	struct net_device *dev;
55db569581SHimangi Saraogi 	struct card *card;
561da177e4SLinus Torvalds 	spinlock_t lock;	/* for wanxl_xmit */
571da177e4SLinus Torvalds         int node;		/* physical port #0 - 3 */
581da177e4SLinus Torvalds 	unsigned int clock_type;
591da177e4SLinus Torvalds 	int tx_in, tx_out;
601da177e4SLinus Torvalds 	struct sk_buff *tx_skbs[TX_BUFFERS];
61db569581SHimangi Saraogi };
621da177e4SLinus Torvalds 
63db569581SHimangi Saraogi struct card_status {
641da177e4SLinus Torvalds 	desc_t rx_descs[RX_QUEUE_LENGTH];
651da177e4SLinus Torvalds 	port_status_t port_status[4];
66db569581SHimangi Saraogi };
671da177e4SLinus Torvalds 
68db569581SHimangi Saraogi struct card {
691da177e4SLinus Torvalds 	int n_ports;		/* 1, 2 or 4 ports */
701da177e4SLinus Torvalds 	u8 irq;
711da177e4SLinus Torvalds 
721da177e4SLinus Torvalds 	u8 __iomem *plx;	/* PLX PCI9060 virtual base address */
731da177e4SLinus Torvalds 	struct pci_dev *pdev;	/* for pci_name(pdev) */
741da177e4SLinus Torvalds 	int rx_in;
751da177e4SLinus Torvalds 	struct sk_buff *rx_skbs[RX_QUEUE_LENGTH];
76db569581SHimangi Saraogi 	struct card_status *status;	/* shared between host and card */
771da177e4SLinus Torvalds 	dma_addr_t status_address;
7837e1244aSGustavo A. R. Silva 	struct port ports[];	/* 1 - 4 port structures follow */
79db569581SHimangi Saraogi };
801da177e4SLinus Torvalds 
81db569581SHimangi Saraogi static inline struct port *dev_to_port(struct net_device *dev)
821da177e4SLinus Torvalds {
83db569581SHimangi Saraogi 	return (struct port *)dev_to_hdlc(dev)->priv;
841da177e4SLinus Torvalds }
851da177e4SLinus Torvalds 
86db569581SHimangi Saraogi static inline port_status_t *get_status(struct port *port)
871da177e4SLinus Torvalds {
881da177e4SLinus Torvalds 	return &port->card->status->port_status[port->node];
891da177e4SLinus Torvalds }
901da177e4SLinus Torvalds 
911da177e4SLinus Torvalds #ifdef DEBUG_PCI
921da177e4SLinus Torvalds static inline dma_addr_t pci_map_single_debug(struct pci_dev *pdev, void *ptr,
931da177e4SLinus Torvalds 					      size_t size, int direction)
941da177e4SLinus Torvalds {
9524dd377aSChristophe JAILLET 	dma_addr_t addr = dma_map_single(&pdev->dev, ptr, size, direction);
96*f0328a19SPeng Li 
971da177e4SLinus Torvalds 	if (addr + size > 0x100000000LL)
9812a3bfefSJoe Perches 		pr_crit("%s: pci_map_single() returned memory at 0x%llx!\n",
9912a3bfefSJoe Perches 			pci_name(pdev), (unsigned long long)addr);
1001da177e4SLinus Torvalds 	return addr;
1011da177e4SLinus Torvalds }
1021da177e4SLinus Torvalds 
1031da177e4SLinus Torvalds #undef pci_map_single
1041da177e4SLinus Torvalds #define pci_map_single pci_map_single_debug
1051da177e4SLinus Torvalds #endif
1061da177e4SLinus Torvalds 
1071da177e4SLinus Torvalds /* Cable and/or personality module change interrupt service */
108db569581SHimangi Saraogi static inline void wanxl_cable_intr(struct port *port)
1091da177e4SLinus Torvalds {
1101da177e4SLinus Torvalds 	u32 value = get_status(port)->cable;
1111da177e4SLinus Torvalds 	int valid = 1;
1121da177e4SLinus Torvalds 	const char *cable, *pm, *dte = "", *dsr = "", *dcd = "";
1131da177e4SLinus Torvalds 
1141da177e4SLinus Torvalds 	switch(value & 0x7) {
1151da177e4SLinus Torvalds 	case STATUS_CABLE_V35: cable = "V.35"; break;
1161da177e4SLinus Torvalds 	case STATUS_CABLE_X21: cable = "X.21"; break;
1171da177e4SLinus Torvalds 	case STATUS_CABLE_V24: cable = "V.24"; break;
1181da177e4SLinus Torvalds 	case STATUS_CABLE_EIA530: cable = "EIA530"; break;
1191da177e4SLinus Torvalds 	case STATUS_CABLE_NONE: cable = "no"; break;
1201da177e4SLinus Torvalds 	default: cable = "invalid";
1211da177e4SLinus Torvalds 	}
1221da177e4SLinus Torvalds 
1231da177e4SLinus Torvalds 	switch((value >> STATUS_CABLE_PM_SHIFT) & 0x7) {
1241da177e4SLinus Torvalds 	case STATUS_CABLE_V35: pm = "V.35"; break;
1251da177e4SLinus Torvalds 	case STATUS_CABLE_X21: pm = "X.21"; break;
1261da177e4SLinus Torvalds 	case STATUS_CABLE_V24: pm = "V.24"; break;
1271da177e4SLinus Torvalds 	case STATUS_CABLE_EIA530: pm = "EIA530"; break;
1281da177e4SLinus Torvalds 	case STATUS_CABLE_NONE: pm = "no personality"; valid = 0; break;
1291da177e4SLinus Torvalds 	default: pm = "invalid personality"; valid = 0;
1301da177e4SLinus Torvalds 	}
1311da177e4SLinus Torvalds 
1321da177e4SLinus Torvalds 	if (valid) {
1331da177e4SLinus Torvalds 		if ((value & 7) == ((value >> STATUS_CABLE_PM_SHIFT) & 7)) {
1341da177e4SLinus Torvalds 			dsr = (value & STATUS_CABLE_DSR) ? ", DSR ON" :
1351da177e4SLinus Torvalds 				", DSR off";
1361da177e4SLinus Torvalds 			dcd = (value & STATUS_CABLE_DCD) ? ", carrier ON" :
1371da177e4SLinus Torvalds 				", carrier off";
1381da177e4SLinus Torvalds 		}
1391da177e4SLinus Torvalds 		dte = (value & STATUS_CABLE_DCE) ? " DCE" : " DTE";
1401da177e4SLinus Torvalds 	}
14112a3bfefSJoe Perches 	netdev_info(port->dev, "%s%s module, %s cable%s%s\n",
14212a3bfefSJoe Perches 		    pm, dte, cable, dsr, dcd);
1431da177e4SLinus Torvalds 
144c2ce9204SKrzysztof Halasa 	if (value & STATUS_CABLE_DCD)
145c2ce9204SKrzysztof Halasa 		netif_carrier_on(port->dev);
146c2ce9204SKrzysztof Halasa 	else
147c2ce9204SKrzysztof Halasa 		netif_carrier_off(port->dev);
1481da177e4SLinus Torvalds }
1491da177e4SLinus Torvalds 
1501da177e4SLinus Torvalds /* Transmit complete interrupt service */
151db569581SHimangi Saraogi static inline void wanxl_tx_intr(struct port *port)
1521da177e4SLinus Torvalds {
1531da177e4SLinus Torvalds 	struct net_device *dev = port->dev;
154*f0328a19SPeng Li 
1551da177e4SLinus Torvalds 	while (1) {
1561da177e4SLinus Torvalds                 desc_t *desc = &get_status(port)->tx_descs[port->tx_in];
1571da177e4SLinus Torvalds 		struct sk_buff *skb = port->tx_skbs[port->tx_in];
1581da177e4SLinus Torvalds 
1591da177e4SLinus Torvalds 		switch (desc->stat) {
1601da177e4SLinus Torvalds 		case PACKET_FULL:
1611da177e4SLinus Torvalds 		case PACKET_EMPTY:
1621da177e4SLinus Torvalds 			netif_wake_queue(dev);
1631da177e4SLinus Torvalds 			return;
1641da177e4SLinus Torvalds 
1651da177e4SLinus Torvalds 		case PACKET_UNDERRUN:
166198191c4SKrzysztof Halasa 			dev->stats.tx_errors++;
167198191c4SKrzysztof Halasa 			dev->stats.tx_fifo_errors++;
1681da177e4SLinus Torvalds 			break;
1691da177e4SLinus Torvalds 
1701da177e4SLinus Torvalds 		default:
171198191c4SKrzysztof Halasa 			dev->stats.tx_packets++;
172198191c4SKrzysztof Halasa 			dev->stats.tx_bytes += skb->len;
1731da177e4SLinus Torvalds 		}
1741da177e4SLinus Torvalds                 desc->stat = PACKET_EMPTY; /* Free descriptor */
17524dd377aSChristophe JAILLET 		dma_unmap_single(&port->card->pdev->dev, desc->address,
17624dd377aSChristophe JAILLET 				 skb->len, DMA_TO_DEVICE);
17773634c08SYang Wei 		dev_consume_skb_irq(skb);
1781da177e4SLinus Torvalds                 port->tx_in = (port->tx_in + 1) % TX_BUFFERS;
1791da177e4SLinus Torvalds         }
1801da177e4SLinus Torvalds }
1811da177e4SLinus Torvalds 
1821da177e4SLinus Torvalds /* Receive complete interrupt service */
183db569581SHimangi Saraogi static inline void wanxl_rx_intr(struct card *card)
1841da177e4SLinus Torvalds {
1851da177e4SLinus Torvalds 	desc_t *desc;
186*f0328a19SPeng Li 
1871da177e4SLinus Torvalds 	while (desc = &card->status->rx_descs[card->rx_in],
1881da177e4SLinus Torvalds 	       desc->stat != PACKET_EMPTY) {
1891da177e4SLinus Torvalds 		if ((desc->stat & PACKET_PORT_MASK) > card->n_ports)
19012a3bfefSJoe Perches 			pr_crit("%s: received packet for nonexistent port\n",
19112a3bfefSJoe Perches 				pci_name(card->pdev));
1921da177e4SLinus Torvalds 		else {
1931da177e4SLinus Torvalds 			struct sk_buff *skb = card->rx_skbs[card->rx_in];
194db569581SHimangi Saraogi 			struct port *port = &card->ports[desc->stat &
1951da177e4SLinus Torvalds 						    PACKET_PORT_MASK];
1961da177e4SLinus Torvalds 			struct net_device *dev = port->dev;
1971da177e4SLinus Torvalds 
1981da177e4SLinus Torvalds 			if (!skb)
199198191c4SKrzysztof Halasa 				dev->stats.rx_dropped++;
2001da177e4SLinus Torvalds 			else {
20124dd377aSChristophe JAILLET 				dma_unmap_single(&card->pdev->dev,
20224dd377aSChristophe JAILLET 						 desc->address, BUFFER_LENGTH,
20324dd377aSChristophe JAILLET 						 DMA_FROM_DEVICE);
2041da177e4SLinus Torvalds 				skb_put(skb, desc->length);
2051da177e4SLinus Torvalds 
2061da177e4SLinus Torvalds #ifdef DEBUG_PKT
2071da177e4SLinus Torvalds 				printk(KERN_DEBUG "%s RX(%i):", dev->name,
2081da177e4SLinus Torvalds 				       skb->len);
2091da177e4SLinus Torvalds 				debug_frame(skb);
2101da177e4SLinus Torvalds #endif
211198191c4SKrzysztof Halasa 				dev->stats.rx_packets++;
212198191c4SKrzysztof Halasa 				dev->stats.rx_bytes += skb->len;
2131da177e4SLinus Torvalds 				skb->protocol = hdlc_type_trans(skb, dev);
2141da177e4SLinus Torvalds 				netif_rx(skb);
2151da177e4SLinus Torvalds 				skb = NULL;
2161da177e4SLinus Torvalds 			}
2171da177e4SLinus Torvalds 
2181da177e4SLinus Torvalds 			if (!skb) {
2191da177e4SLinus Torvalds 				skb = dev_alloc_skb(BUFFER_LENGTH);
2201da177e4SLinus Torvalds 				desc->address = skb ?
22124dd377aSChristophe JAILLET 					dma_map_single(&card->pdev->dev,
22224dd377aSChristophe JAILLET 						       skb->data,
2231da177e4SLinus Torvalds 						       BUFFER_LENGTH,
22424dd377aSChristophe JAILLET 						       DMA_FROM_DEVICE) : 0;
2251da177e4SLinus Torvalds 				card->rx_skbs[card->rx_in] = skb;
2261da177e4SLinus Torvalds 			}
2271da177e4SLinus Torvalds 		}
2281da177e4SLinus Torvalds 		desc->stat = PACKET_EMPTY; /* Free descriptor */
2291da177e4SLinus Torvalds 		card->rx_in = (card->rx_in + 1) % RX_QUEUE_LENGTH;
2301da177e4SLinus Torvalds 	}
2311da177e4SLinus Torvalds }
2321da177e4SLinus Torvalds 
2337d12e780SDavid Howells static irqreturn_t wanxl_intr(int irq, void *dev_id)
2341da177e4SLinus Torvalds {
235db569581SHimangi Saraogi 	struct card *card = dev_id;
2361da177e4SLinus Torvalds         int i;
2371da177e4SLinus Torvalds         u32 stat;
2381da177e4SLinus Torvalds         int handled = 0;
2391da177e4SLinus Torvalds 
2401da177e4SLinus Torvalds         while((stat = readl(card->plx + PLX_DOORBELL_FROM_CARD)) != 0) {
2411da177e4SLinus Torvalds                 handled = 1;
2421da177e4SLinus Torvalds 		writel(stat, card->plx + PLX_DOORBELL_FROM_CARD);
2431da177e4SLinus Torvalds 
2441da177e4SLinus Torvalds                 for (i = 0; i < card->n_ports; i++) {
2451da177e4SLinus Torvalds 			if (stat & (1 << (DOORBELL_FROM_CARD_TX_0 + i)))
2461da177e4SLinus Torvalds 				wanxl_tx_intr(&card->ports[i]);
2471da177e4SLinus Torvalds 			if (stat & (1 << (DOORBELL_FROM_CARD_CABLE_0 + i)))
2481da177e4SLinus Torvalds 				wanxl_cable_intr(&card->ports[i]);
2491da177e4SLinus Torvalds 		}
2501da177e4SLinus Torvalds 		if (stat & (1 << DOORBELL_FROM_CARD_RX))
2511da177e4SLinus Torvalds 			wanxl_rx_intr(card);
2521da177e4SLinus Torvalds         }
2531da177e4SLinus Torvalds 
2541da177e4SLinus Torvalds         return IRQ_RETVAL(handled);
2551da177e4SLinus Torvalds }
2561da177e4SLinus Torvalds 
257d71a6749SStephen Hemminger static netdev_tx_t wanxl_xmit(struct sk_buff *skb, struct net_device *dev)
2581da177e4SLinus Torvalds {
259db569581SHimangi Saraogi 	struct port *port = dev_to_port(dev);
2601da177e4SLinus Torvalds 	desc_t *desc;
2611da177e4SLinus Torvalds 
2621da177e4SLinus Torvalds         spin_lock(&port->lock);
2631da177e4SLinus Torvalds 
2641da177e4SLinus Torvalds 	desc = &get_status(port)->tx_descs[port->tx_out];
2651da177e4SLinus Torvalds         if (desc->stat != PACKET_EMPTY) {
2661da177e4SLinus Torvalds                 /* should never happen - previous xmit should stop queue */
2671da177e4SLinus Torvalds #ifdef DEBUG_PKT
2681da177e4SLinus Torvalds                 printk(KERN_DEBUG "%s: transmitter buffer full\n", dev->name);
2691da177e4SLinus Torvalds #endif
2701da177e4SLinus Torvalds 		netif_stop_queue(dev);
2710311ee22SDan Carpenter 		spin_unlock(&port->lock);
2725b548140SPatrick McHardy 		return NETDEV_TX_BUSY;       /* request packet to be queued */
2731da177e4SLinus Torvalds 	}
2741da177e4SLinus Torvalds 
2751da177e4SLinus Torvalds #ifdef DEBUG_PKT
2761da177e4SLinus Torvalds 	printk(KERN_DEBUG "%s TX(%i):", dev->name, skb->len);
2771da177e4SLinus Torvalds 	debug_frame(skb);
2781da177e4SLinus Torvalds #endif
2791da177e4SLinus Torvalds 
2801da177e4SLinus Torvalds 	port->tx_skbs[port->tx_out] = skb;
28124dd377aSChristophe JAILLET 	desc->address = dma_map_single(&port->card->pdev->dev, skb->data,
28224dd377aSChristophe JAILLET 				       skb->len, DMA_TO_DEVICE);
2831da177e4SLinus Torvalds 	desc->length = skb->len;
2841da177e4SLinus Torvalds 	desc->stat = PACKET_FULL;
2851da177e4SLinus Torvalds 	writel(1 << (DOORBELL_TO_CARD_TX_0 + port->node),
2861da177e4SLinus Torvalds 	       port->card->plx + PLX_DOORBELL_TO_CARD);
2871da177e4SLinus Torvalds 
2881da177e4SLinus Torvalds 	port->tx_out = (port->tx_out + 1) % TX_BUFFERS;
2891da177e4SLinus Torvalds 
2901da177e4SLinus Torvalds 	if (get_status(port)->tx_descs[port->tx_out].stat != PACKET_EMPTY) {
2911da177e4SLinus Torvalds 		netif_stop_queue(dev);
2921da177e4SLinus Torvalds #ifdef DEBUG_PKT
2931da177e4SLinus Torvalds 		printk(KERN_DEBUG "%s: transmitter buffer full\n", dev->name);
2941da177e4SLinus Torvalds #endif
2951da177e4SLinus Torvalds 	}
2961da177e4SLinus Torvalds 
2971da177e4SLinus Torvalds 	spin_unlock(&port->lock);
298ec634fe3SPatrick McHardy 	return NETDEV_TX_OK;
2991da177e4SLinus Torvalds }
3001da177e4SLinus Torvalds 
3011da177e4SLinus Torvalds static int wanxl_attach(struct net_device *dev, unsigned short encoding,
3021da177e4SLinus Torvalds 			unsigned short parity)
3031da177e4SLinus Torvalds {
304db569581SHimangi Saraogi 	struct port *port = dev_to_port(dev);
3051da177e4SLinus Torvalds 
3061da177e4SLinus Torvalds 	if (encoding != ENCODING_NRZ &&
3071da177e4SLinus Torvalds 	    encoding != ENCODING_NRZI)
3081da177e4SLinus Torvalds 		return -EINVAL;
3091da177e4SLinus Torvalds 
3101da177e4SLinus Torvalds 	if (parity != PARITY_NONE &&
3111da177e4SLinus Torvalds 	    parity != PARITY_CRC32_PR1_CCITT &&
3121da177e4SLinus Torvalds 	    parity != PARITY_CRC16_PR1_CCITT &&
3131da177e4SLinus Torvalds 	    parity != PARITY_CRC32_PR0_CCITT &&
3141da177e4SLinus Torvalds 	    parity != PARITY_CRC16_PR0_CCITT)
3151da177e4SLinus Torvalds 		return -EINVAL;
3161da177e4SLinus Torvalds 
3171da177e4SLinus Torvalds 	get_status(port)->encoding = encoding;
3181da177e4SLinus Torvalds 	get_status(port)->parity = parity;
3191da177e4SLinus Torvalds 	return 0;
3201da177e4SLinus Torvalds }
3211da177e4SLinus Torvalds 
3221da177e4SLinus Torvalds static int wanxl_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
3231da177e4SLinus Torvalds {
3241da177e4SLinus Torvalds 	const size_t size = sizeof(sync_serial_settings);
3251da177e4SLinus Torvalds 	sync_serial_settings line;
326db569581SHimangi Saraogi 	struct port *port = dev_to_port(dev);
3271da177e4SLinus Torvalds 
3281da177e4SLinus Torvalds 	if (cmd != SIOCWANDEV)
3291da177e4SLinus Torvalds 		return hdlc_ioctl(dev, ifr, cmd);
3301da177e4SLinus Torvalds 
3311da177e4SLinus Torvalds 	switch (ifr->ifr_settings.type) {
3321da177e4SLinus Torvalds 	case IF_GET_IFACE:
3331da177e4SLinus Torvalds 		ifr->ifr_settings.type = IF_IFACE_SYNC_SERIAL;
3341da177e4SLinus Torvalds 		if (ifr->ifr_settings.size < size) {
3351da177e4SLinus Torvalds 			ifr->ifr_settings.size = size; /* data size wanted */
3361da177e4SLinus Torvalds 			return -ENOBUFS;
3371da177e4SLinus Torvalds 		}
3382b13d06cSSalva Peiró 		memset(&line, 0, sizeof(line));
3391da177e4SLinus Torvalds 		line.clock_type = get_status(port)->clocking;
3401da177e4SLinus Torvalds 		line.clock_rate = 0;
3411da177e4SLinus Torvalds 		line.loopback = 0;
3421da177e4SLinus Torvalds 
3431da177e4SLinus Torvalds 		if (copy_to_user(ifr->ifr_settings.ifs_ifsu.sync, &line, size))
3441da177e4SLinus Torvalds 			return -EFAULT;
3451da177e4SLinus Torvalds 		return 0;
3461da177e4SLinus Torvalds 
3471da177e4SLinus Torvalds 	case IF_IFACE_SYNC_SERIAL:
3481da177e4SLinus Torvalds 		if (!capable(CAP_NET_ADMIN))
3491da177e4SLinus Torvalds 			return -EPERM;
3501da177e4SLinus Torvalds 		if (dev->flags & IFF_UP)
3511da177e4SLinus Torvalds 			return -EBUSY;
3521da177e4SLinus Torvalds 
3531da177e4SLinus Torvalds 		if (copy_from_user(&line, ifr->ifr_settings.ifs_ifsu.sync,
3541da177e4SLinus Torvalds 				   size))
3551da177e4SLinus Torvalds 			return -EFAULT;
3561da177e4SLinus Torvalds 
3571da177e4SLinus Torvalds 		if (line.clock_type != CLOCK_EXT &&
3581da177e4SLinus Torvalds 		    line.clock_type != CLOCK_TXFROMRX)
3591da177e4SLinus Torvalds 			return -EINVAL; /* No such clock setting */
3601da177e4SLinus Torvalds 
3611da177e4SLinus Torvalds 		if (line.loopback != 0)
3621da177e4SLinus Torvalds 			return -EINVAL;
3631da177e4SLinus Torvalds 
3641da177e4SLinus Torvalds 		get_status(port)->clocking = line.clock_type;
3651da177e4SLinus Torvalds 		return 0;
3661da177e4SLinus Torvalds 
3671da177e4SLinus Torvalds 	default:
3681da177e4SLinus Torvalds 		return hdlc_ioctl(dev, ifr, cmd);
3691da177e4SLinus Torvalds         }
3701da177e4SLinus Torvalds }
3711da177e4SLinus Torvalds 
3721da177e4SLinus Torvalds static int wanxl_open(struct net_device *dev)
3731da177e4SLinus Torvalds {
374db569581SHimangi Saraogi 	struct port *port = dev_to_port(dev);
3751da177e4SLinus Torvalds 	u8 __iomem *dbr = port->card->plx + PLX_DOORBELL_TO_CARD;
3761da177e4SLinus Torvalds 	unsigned long timeout;
3771da177e4SLinus Torvalds 	int i;
3781da177e4SLinus Torvalds 
3791da177e4SLinus Torvalds 	if (get_status(port)->open) {
38012a3bfefSJoe Perches 		netdev_err(dev, "port already open\n");
3811da177e4SLinus Torvalds 		return -EIO;
3821da177e4SLinus Torvalds 	}
3831da177e4SLinus Torvalds 	if ((i = hdlc_open(dev)) != 0)
3841da177e4SLinus Torvalds 		return i;
3851da177e4SLinus Torvalds 
3861da177e4SLinus Torvalds 	port->tx_in = port->tx_out = 0;
3871da177e4SLinus Torvalds 	for (i = 0; i < TX_BUFFERS; i++)
3881da177e4SLinus Torvalds 		get_status(port)->tx_descs[i].stat = PACKET_EMPTY;
3891da177e4SLinus Torvalds 	/* signal the card */
3901da177e4SLinus Torvalds 	writel(1 << (DOORBELL_TO_CARD_OPEN_0 + port->node), dbr);
3911da177e4SLinus Torvalds 
3921da177e4SLinus Torvalds 	timeout = jiffies + HZ;
393d157e023SHannes Eder 	do {
3941da177e4SLinus Torvalds 		if (get_status(port)->open) {
3951da177e4SLinus Torvalds 			netif_start_queue(dev);
3961da177e4SLinus Torvalds 			return 0;
3971da177e4SLinus Torvalds 		}
398d157e023SHannes Eder 	} while (time_after(timeout, jiffies));
3991da177e4SLinus Torvalds 
40012a3bfefSJoe Perches 	netdev_err(dev, "unable to open port\n");
4011da177e4SLinus Torvalds 	/* ask the card to close the port, should it be still alive */
4021da177e4SLinus Torvalds 	writel(1 << (DOORBELL_TO_CARD_CLOSE_0 + port->node), dbr);
4031da177e4SLinus Torvalds 	return -EFAULT;
4041da177e4SLinus Torvalds }
4051da177e4SLinus Torvalds 
4061da177e4SLinus Torvalds static int wanxl_close(struct net_device *dev)
4071da177e4SLinus Torvalds {
408db569581SHimangi Saraogi 	struct port *port = dev_to_port(dev);
4091da177e4SLinus Torvalds 	unsigned long timeout;
4101da177e4SLinus Torvalds 	int i;
4111da177e4SLinus Torvalds 
4121da177e4SLinus Torvalds 	hdlc_close(dev);
4131da177e4SLinus Torvalds 	/* signal the card */
4141da177e4SLinus Torvalds 	writel(1 << (DOORBELL_TO_CARD_CLOSE_0 + port->node),
4151da177e4SLinus Torvalds 	       port->card->plx + PLX_DOORBELL_TO_CARD);
4161da177e4SLinus Torvalds 
4171da177e4SLinus Torvalds 	timeout = jiffies + HZ;
418d157e023SHannes Eder 	do {
4191da177e4SLinus Torvalds 		if (!get_status(port)->open)
4201da177e4SLinus Torvalds 			break;
421d157e023SHannes Eder 	} while (time_after(timeout, jiffies));
4221da177e4SLinus Torvalds 
4231da177e4SLinus Torvalds 	if (get_status(port)->open)
42412a3bfefSJoe Perches 		netdev_err(dev, "unable to close port\n");
4251da177e4SLinus Torvalds 
4261da177e4SLinus Torvalds 	netif_stop_queue(dev);
4271da177e4SLinus Torvalds 
4281da177e4SLinus Torvalds 	for (i = 0; i < TX_BUFFERS; i++) {
4291da177e4SLinus Torvalds 		desc_t *desc = &get_status(port)->tx_descs[i];
4301da177e4SLinus Torvalds 
4311da177e4SLinus Torvalds 		if (desc->stat != PACKET_EMPTY) {
4321da177e4SLinus Torvalds 			desc->stat = PACKET_EMPTY;
43324dd377aSChristophe JAILLET 			dma_unmap_single(&port->card->pdev->dev,
43424dd377aSChristophe JAILLET 					 desc->address, port->tx_skbs[i]->len,
43524dd377aSChristophe JAILLET 					 DMA_TO_DEVICE);
4361da177e4SLinus Torvalds 			dev_kfree_skb(port->tx_skbs[i]);
4371da177e4SLinus Torvalds 		}
4381da177e4SLinus Torvalds 	}
4391da177e4SLinus Torvalds 	return 0;
4401da177e4SLinus Torvalds }
4411da177e4SLinus Torvalds 
4421da177e4SLinus Torvalds static struct net_device_stats *wanxl_get_stats(struct net_device *dev)
4431da177e4SLinus Torvalds {
444db569581SHimangi Saraogi 	struct port *port = dev_to_port(dev);
4451da177e4SLinus Torvalds 
446198191c4SKrzysztof Halasa 	dev->stats.rx_over_errors = get_status(port)->rx_overruns;
447198191c4SKrzysztof Halasa 	dev->stats.rx_frame_errors = get_status(port)->rx_frame_errors;
448198191c4SKrzysztof Halasa 	dev->stats.rx_errors = dev->stats.rx_over_errors +
449198191c4SKrzysztof Halasa 		dev->stats.rx_frame_errors;
450198191c4SKrzysztof Halasa 	return &dev->stats;
4511da177e4SLinus Torvalds }
4521da177e4SLinus Torvalds 
453db569581SHimangi Saraogi static int wanxl_puts_command(struct card *card, u32 cmd)
4541da177e4SLinus Torvalds {
4551da177e4SLinus Torvalds 	unsigned long timeout = jiffies + 5 * HZ;
4561da177e4SLinus Torvalds 
4571da177e4SLinus Torvalds 	writel(cmd, card->plx + PLX_MAILBOX_1);
4581da177e4SLinus Torvalds 	do {
4591da177e4SLinus Torvalds 		if (readl(card->plx + PLX_MAILBOX_1) == 0)
4601da177e4SLinus Torvalds 			return 0;
4611da177e4SLinus Torvalds 
4621da177e4SLinus Torvalds 		schedule();
4631da177e4SLinus Torvalds 	}while (time_after(timeout, jiffies));
4641da177e4SLinus Torvalds 
4651da177e4SLinus Torvalds 	return -1;
4661da177e4SLinus Torvalds }
4671da177e4SLinus Torvalds 
468db569581SHimangi Saraogi static void wanxl_reset(struct card *card)
4691da177e4SLinus Torvalds {
4701da177e4SLinus Torvalds 	u32 old_value = readl(card->plx + PLX_CONTROL) & ~PLX_CTL_RESET;
4711da177e4SLinus Torvalds 
4721da177e4SLinus Torvalds 	writel(0x80, card->plx + PLX_MAILBOX_0);
4731da177e4SLinus Torvalds 	writel(old_value | PLX_CTL_RESET, card->plx + PLX_CONTROL);
4741da177e4SLinus Torvalds 	readl(card->plx + PLX_CONTROL); /* wait for posted write */
4751da177e4SLinus Torvalds 	udelay(1);
4761da177e4SLinus Torvalds 	writel(old_value, card->plx + PLX_CONTROL);
4771da177e4SLinus Torvalds 	readl(card->plx + PLX_CONTROL); /* wait for posted write */
4781da177e4SLinus Torvalds }
4791da177e4SLinus Torvalds 
4801da177e4SLinus Torvalds static void wanxl_pci_remove_one(struct pci_dev *pdev)
4811da177e4SLinus Torvalds {
482db569581SHimangi Saraogi 	struct card *card = pci_get_drvdata(pdev);
4831da177e4SLinus Torvalds 	int i;
4841da177e4SLinus Torvalds 
4851da177e4SLinus Torvalds 	for (i = 0; i < card->n_ports; i++) {
4861da177e4SLinus Torvalds 		unregister_hdlc_device(card->ports[i].dev);
4871da177e4SLinus Torvalds 		free_netdev(card->ports[i].dev);
4881da177e4SLinus Torvalds 	}
4891da177e4SLinus Torvalds 
4901da177e4SLinus Torvalds 	/* unregister and free all host resources */
4911da177e4SLinus Torvalds 	if (card->irq)
4921da177e4SLinus Torvalds 		free_irq(card->irq, card);
4931da177e4SLinus Torvalds 
4941da177e4SLinus Torvalds 	wanxl_reset(card);
4951da177e4SLinus Torvalds 
4961da177e4SLinus Torvalds 	for (i = 0; i < RX_QUEUE_LENGTH; i++)
4971da177e4SLinus Torvalds 		if (card->rx_skbs[i]) {
49824dd377aSChristophe JAILLET 			dma_unmap_single(&card->pdev->dev,
4991da177e4SLinus Torvalds 					 card->status->rx_descs[i].address,
50024dd377aSChristophe JAILLET 					 BUFFER_LENGTH, DMA_FROM_DEVICE);
5011da177e4SLinus Torvalds 			dev_kfree_skb(card->rx_skbs[i]);
5021da177e4SLinus Torvalds 		}
5031da177e4SLinus Torvalds 
5041da177e4SLinus Torvalds 	if (card->plx)
5051da177e4SLinus Torvalds 		iounmap(card->plx);
5061da177e4SLinus Torvalds 
5071da177e4SLinus Torvalds 	if (card->status)
50824dd377aSChristophe JAILLET 		dma_free_coherent(&pdev->dev, sizeof(struct card_status),
5091da177e4SLinus Torvalds 				  card->status, card->status_address);
5101da177e4SLinus Torvalds 
5111da177e4SLinus Torvalds 	pci_release_regions(pdev);
5121da177e4SLinus Torvalds 	pci_disable_device(pdev);
5131da177e4SLinus Torvalds 	kfree(card);
5141da177e4SLinus Torvalds }
5151da177e4SLinus Torvalds 
5161da177e4SLinus Torvalds #include "wanxlfw.inc"
5171da177e4SLinus Torvalds 
518991990a1SKrzysztof Hałasa static const struct net_device_ops wanxl_ops = {
519991990a1SKrzysztof Hałasa 	.ndo_open       = wanxl_open,
520991990a1SKrzysztof Hałasa 	.ndo_stop       = wanxl_close,
521991990a1SKrzysztof Hałasa 	.ndo_start_xmit = hdlc_start_xmit,
522991990a1SKrzysztof Hałasa 	.ndo_do_ioctl   = wanxl_ioctl,
523991990a1SKrzysztof Hałasa 	.ndo_get_stats  = wanxl_get_stats,
524991990a1SKrzysztof Hałasa };
525991990a1SKrzysztof Hałasa 
526aeea6bbfSBill Pemberton static int wanxl_pci_init_one(struct pci_dev *pdev,
5271da177e4SLinus Torvalds 			      const struct pci_device_id *ent)
5281da177e4SLinus Torvalds {
529db569581SHimangi Saraogi 	struct card *card;
5301da177e4SLinus Torvalds 	u32 ramsize, stat;
5311da177e4SLinus Torvalds 	unsigned long timeout;
5321da177e4SLinus Torvalds 	u32 plx_phy;		/* PLX PCI base address */
5331da177e4SLinus Torvalds 	u32 mem_phy;		/* memory PCI base addr */
5341da177e4SLinus Torvalds 	u8 __iomem *mem;	/* memory virtual base addr */
535a3deec5bSGustavo A. R. Silva 	int i, ports;
5361da177e4SLinus Torvalds 
5371da177e4SLinus Torvalds #ifndef MODULE
53812a3bfefSJoe Perches 	pr_info_once("%s\n", version);
5391da177e4SLinus Torvalds #endif
5401da177e4SLinus Torvalds 
5411da177e4SLinus Torvalds 	i = pci_enable_device(pdev);
5421da177e4SLinus Torvalds 	if (i)
5431da177e4SLinus Torvalds 		return i;
5441da177e4SLinus Torvalds 
5451da177e4SLinus Torvalds 	/* QUICC can only access first 256 MB of host RAM directly,
5461da177e4SLinus Torvalds 	   but PLX9060 DMA does 32-bits for actual packet data transfers */
5471da177e4SLinus Torvalds 
5481da177e4SLinus Torvalds 	/* FIXME when PCI/DMA subsystems are fixed.
5491da177e4SLinus Torvalds 	   We set both dma_mask and consistent_dma_mask to 28 bits
5501da177e4SLinus Torvalds 	   and pray pci_alloc_consistent() will use this info. It should
5511da177e4SLinus Torvalds 	   work on most platforms */
55224dd377aSChristophe JAILLET 	if (dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(28)) ||
55324dd377aSChristophe JAILLET 	    dma_set_mask(&pdev->dev, DMA_BIT_MASK(28))) {
55412a3bfefSJoe Perches 		pr_err("No usable DMA configuration\n");
5557e074af2SSaurabh Sengar 		pci_disable_device(pdev);
5561da177e4SLinus Torvalds 		return -EIO;
5571da177e4SLinus Torvalds 	}
5581da177e4SLinus Torvalds 
5591da177e4SLinus Torvalds 	i = pci_request_regions(pdev, "wanXL");
5601da177e4SLinus Torvalds 	if (i) {
5611da177e4SLinus Torvalds 		pci_disable_device(pdev);
5621da177e4SLinus Torvalds 		return i;
5631da177e4SLinus Torvalds 	}
5641da177e4SLinus Torvalds 
5651da177e4SLinus Torvalds 	switch (pdev->device) {
5661da177e4SLinus Torvalds 	case PCI_DEVICE_ID_SBE_WANXL100: ports = 1; break;
5671da177e4SLinus Torvalds 	case PCI_DEVICE_ID_SBE_WANXL200: ports = 2; break;
5681da177e4SLinus Torvalds 	default: ports = 4;
5691da177e4SLinus Torvalds 	}
5701da177e4SLinus Torvalds 
571a3deec5bSGustavo A. R. Silva 	card = kzalloc(struct_size(card, ports, ports), GFP_KERNEL);
5721da177e4SLinus Torvalds 	if (card == NULL) {
5731da177e4SLinus Torvalds 		pci_release_regions(pdev);
5741da177e4SLinus Torvalds 		pci_disable_device(pdev);
5751da177e4SLinus Torvalds 		return -ENOBUFS;
5761da177e4SLinus Torvalds 	}
5771da177e4SLinus Torvalds 
5781da177e4SLinus Torvalds 	pci_set_drvdata(pdev, card);
5791da177e4SLinus Torvalds 	card->pdev = pdev;
5801da177e4SLinus Torvalds 
58124dd377aSChristophe JAILLET 	card->status = dma_alloc_coherent(&pdev->dev,
582db569581SHimangi Saraogi 					  sizeof(struct card_status),
58324dd377aSChristophe JAILLET 					  &card->status_address, GFP_KERNEL);
5841da177e4SLinus Torvalds 	if (card->status == NULL) {
5851da177e4SLinus Torvalds 		wanxl_pci_remove_one(pdev);
5861da177e4SLinus Torvalds 		return -ENOBUFS;
5871da177e4SLinus Torvalds 	}
5881da177e4SLinus Torvalds 
5891da177e4SLinus Torvalds #ifdef DEBUG_PCI
5901da177e4SLinus Torvalds 	printk(KERN_DEBUG "wanXL %s: pci_alloc_consistent() returned memory"
5911da177e4SLinus Torvalds 	       " at 0x%LX\n", pci_name(pdev),
5921da177e4SLinus Torvalds 	       (unsigned long long)card->status_address);
5931da177e4SLinus Torvalds #endif
5941da177e4SLinus Torvalds 
5951da177e4SLinus Torvalds 	/* FIXME when PCI/DMA subsystems are fixed.
5961da177e4SLinus Torvalds 	   We set both dma_mask and consistent_dma_mask back to 32 bits
5971da177e4SLinus Torvalds 	   to indicate the card can do 32-bit DMA addressing */
59824dd377aSChristophe JAILLET 	if (dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(32)) ||
59924dd377aSChristophe JAILLET 	    dma_set_mask(&pdev->dev, DMA_BIT_MASK(32))) {
60012a3bfefSJoe Perches 		pr_err("No usable DMA configuration\n");
6011da177e4SLinus Torvalds 		wanxl_pci_remove_one(pdev);
6021da177e4SLinus Torvalds 		return -EIO;
6031da177e4SLinus Torvalds 	}
6041da177e4SLinus Torvalds 
6051da177e4SLinus Torvalds 	/* set up PLX mapping */
6061da177e4SLinus Torvalds 	plx_phy = pci_resource_start(pdev, 0);
6074446065aSKrzysztof Halasa 
6084bdc0d67SChristoph Hellwig 	card->plx = ioremap(plx_phy, 0x70);
6094446065aSKrzysztof Halasa 	if (!card->plx) {
61012a3bfefSJoe Perches 		pr_err("ioremap() failed\n");
6114446065aSKrzysztof Halasa 		wanxl_pci_remove_one(pdev);
6124446065aSKrzysztof Halasa 		return -EFAULT;
6134446065aSKrzysztof Halasa 	}
6141da177e4SLinus Torvalds 
6151da177e4SLinus Torvalds #if RESET_WHILE_LOADING
6161da177e4SLinus Torvalds 	wanxl_reset(card);
6171da177e4SLinus Torvalds #endif
6181da177e4SLinus Torvalds 
6191da177e4SLinus Torvalds 	timeout = jiffies + 20 * HZ;
6201da177e4SLinus Torvalds 	while ((stat = readl(card->plx + PLX_MAILBOX_0)) != 0) {
6211da177e4SLinus Torvalds 		if (time_before(timeout, jiffies)) {
62212a3bfefSJoe Perches 			pr_warn("%s: timeout waiting for PUTS to complete\n",
62312a3bfefSJoe Perches 				pci_name(pdev));
6241da177e4SLinus Torvalds 			wanxl_pci_remove_one(pdev);
6251da177e4SLinus Torvalds 			return -ENODEV;
6261da177e4SLinus Torvalds 		}
6271da177e4SLinus Torvalds 
6281da177e4SLinus Torvalds 		switch(stat & 0xC0) {
6291da177e4SLinus Torvalds 		case 0x00:	/* hmm - PUTS completed with non-zero code? */
6301da177e4SLinus Torvalds 		case 0x80:	/* PUTS still testing the hardware */
6311da177e4SLinus Torvalds 			break;
6321da177e4SLinus Torvalds 
6331da177e4SLinus Torvalds 		default:
63412a3bfefSJoe Perches 			pr_warn("%s: PUTS test 0x%X failed\n",
63512a3bfefSJoe Perches 				pci_name(pdev), stat & 0x30);
6361da177e4SLinus Torvalds 			wanxl_pci_remove_one(pdev);
6371da177e4SLinus Torvalds 			return -ENODEV;
6381da177e4SLinus Torvalds 		}
6391da177e4SLinus Torvalds 
6401da177e4SLinus Torvalds 		schedule();
6411da177e4SLinus Torvalds 	}
6421da177e4SLinus Torvalds 
6431da177e4SLinus Torvalds 	/* get on-board memory size (PUTS detects no more than 4 MB) */
6441da177e4SLinus Torvalds 	ramsize = readl(card->plx + PLX_MAILBOX_2) & MBX2_MEMSZ_MASK;
6451da177e4SLinus Torvalds 
6461da177e4SLinus Torvalds 	/* set up on-board RAM mapping */
6471da177e4SLinus Torvalds 	mem_phy = pci_resource_start(pdev, 2);
6481da177e4SLinus Torvalds 
6491da177e4SLinus Torvalds 	/* sanity check the board's reported memory size */
6501da177e4SLinus Torvalds 	if (ramsize < BUFFERS_ADDR +
6511da177e4SLinus Torvalds 	    (TX_BUFFERS + RX_BUFFERS) * BUFFER_LENGTH * ports) {
65212a3bfefSJoe Perches 		pr_warn("%s: no enough on-board RAM (%u bytes detected, %u bytes required)\n",
65312a3bfefSJoe Perches 			pci_name(pdev), ramsize,
65412a3bfefSJoe Perches 			BUFFERS_ADDR +
6551da177e4SLinus Torvalds 			(TX_BUFFERS + RX_BUFFERS) * BUFFER_LENGTH * ports);
6561da177e4SLinus Torvalds 		wanxl_pci_remove_one(pdev);
6571da177e4SLinus Torvalds 		return -ENODEV;
6581da177e4SLinus Torvalds 	}
6591da177e4SLinus Torvalds 
6601da177e4SLinus Torvalds 	if (wanxl_puts_command(card, MBX1_CMD_BSWAP)) {
66112a3bfefSJoe Perches 		pr_warn("%s: unable to Set Byte Swap Mode\n", pci_name(pdev));
6621da177e4SLinus Torvalds 		wanxl_pci_remove_one(pdev);
6631da177e4SLinus Torvalds 		return -ENODEV;
6641da177e4SLinus Torvalds 	}
6651da177e4SLinus Torvalds 
6661da177e4SLinus Torvalds 	for (i = 0; i < RX_QUEUE_LENGTH; i++) {
6671da177e4SLinus Torvalds 		struct sk_buff *skb = dev_alloc_skb(BUFFER_LENGTH);
668*f0328a19SPeng Li 
6691da177e4SLinus Torvalds 		card->rx_skbs[i] = skb;
6701da177e4SLinus Torvalds 		if (skb)
6711da177e4SLinus Torvalds 			card->status->rx_descs[i].address =
67224dd377aSChristophe JAILLET 				dma_map_single(&card->pdev->dev, skb->data,
67324dd377aSChristophe JAILLET 					       BUFFER_LENGTH, DMA_FROM_DEVICE);
6741da177e4SLinus Torvalds 	}
6751da177e4SLinus Torvalds 
6764bdc0d67SChristoph Hellwig 	mem = ioremap(mem_phy, PDM_OFFSET + sizeof(firmware));
6774446065aSKrzysztof Halasa 	if (!mem) {
67812a3bfefSJoe Perches 		pr_err("ioremap() failed\n");
6794446065aSKrzysztof Halasa 		wanxl_pci_remove_one(pdev);
6804446065aSKrzysztof Halasa 		return -EFAULT;
6814446065aSKrzysztof Halasa 	}
6824446065aSKrzysztof Halasa 
6831da177e4SLinus Torvalds 	for (i = 0; i < sizeof(firmware); i += 4)
68490458401SAl Viro 		writel(ntohl(*(__be32 *)(firmware + i)), mem + PDM_OFFSET + i);
6851da177e4SLinus Torvalds 
6861da177e4SLinus Torvalds 	for (i = 0; i < ports; i++)
6871da177e4SLinus Torvalds 		writel(card->status_address +
6881da177e4SLinus Torvalds 		       (void *)&card->status->port_status[i] -
6891da177e4SLinus Torvalds 		       (void *)card->status, mem + PDM_OFFSET + 4 + i * 4);
6901da177e4SLinus Torvalds 	writel(card->status_address, mem + PDM_OFFSET + 20);
6911da177e4SLinus Torvalds 	writel(PDM_OFFSET, mem);
6921da177e4SLinus Torvalds 	iounmap(mem);
6931da177e4SLinus Torvalds 
6941da177e4SLinus Torvalds 	writel(0, card->plx + PLX_MAILBOX_5);
6951da177e4SLinus Torvalds 
6961da177e4SLinus Torvalds 	if (wanxl_puts_command(card, MBX1_CMD_ABORTJ)) {
69712a3bfefSJoe Perches 		pr_warn("%s: unable to Abort and Jump\n", pci_name(pdev));
6981da177e4SLinus Torvalds 		wanxl_pci_remove_one(pdev);
6991da177e4SLinus Torvalds 		return -ENODEV;
7001da177e4SLinus Torvalds 	}
7011da177e4SLinus Torvalds 
7021da177e4SLinus Torvalds 	timeout = jiffies + 5 * HZ;
7031da177e4SLinus Torvalds 	do {
7041da177e4SLinus Torvalds 		if ((stat = readl(card->plx + PLX_MAILBOX_5)) != 0)
7051da177e4SLinus Torvalds 			break;
7061da177e4SLinus Torvalds 		schedule();
7071da177e4SLinus Torvalds 	}while (time_after(timeout, jiffies));
7081da177e4SLinus Torvalds 
7091da177e4SLinus Torvalds 	if (!stat) {
71012a3bfefSJoe Perches 		pr_warn("%s: timeout while initializing card firmware\n",
71112a3bfefSJoe Perches 			pci_name(pdev));
7121da177e4SLinus Torvalds 		wanxl_pci_remove_one(pdev);
7131da177e4SLinus Torvalds 		return -ENODEV;
7141da177e4SLinus Torvalds 	}
7151da177e4SLinus Torvalds 
7161da177e4SLinus Torvalds #if DETECT_RAM
7171da177e4SLinus Torvalds 	ramsize = stat;
7181da177e4SLinus Torvalds #endif
7191da177e4SLinus Torvalds 
72012a3bfefSJoe Perches 	pr_info("%s: at 0x%X, %u KB of RAM at 0x%X, irq %u\n",
7211da177e4SLinus Torvalds 		pci_name(pdev), plx_phy, ramsize / 1024, mem_phy, pdev->irq);
7221da177e4SLinus Torvalds 
7231da177e4SLinus Torvalds 	/* Allocate IRQ */
7241fb9df5dSThomas Gleixner 	if (request_irq(pdev->irq, wanxl_intr, IRQF_SHARED, "wanXL", card)) {
72512a3bfefSJoe Perches 		pr_warn("%s: could not allocate IRQ%i\n",
7261da177e4SLinus Torvalds 			pci_name(pdev), pdev->irq);
7271da177e4SLinus Torvalds 		wanxl_pci_remove_one(pdev);
7281da177e4SLinus Torvalds 		return -EBUSY;
7291da177e4SLinus Torvalds 	}
7301da177e4SLinus Torvalds 	card->irq = pdev->irq;
7311da177e4SLinus Torvalds 
7321da177e4SLinus Torvalds 	for (i = 0; i < ports; i++) {
7331da177e4SLinus Torvalds 		hdlc_device *hdlc;
734db569581SHimangi Saraogi 		struct port *port = &card->ports[i];
7351da177e4SLinus Torvalds 		struct net_device *dev = alloc_hdlcdev(port);
736*f0328a19SPeng Li 
7371da177e4SLinus Torvalds 		if (!dev) {
73812a3bfefSJoe Perches 			pr_err("%s: unable to allocate memory\n",
73912a3bfefSJoe Perches 			       pci_name(pdev));
7401da177e4SLinus Torvalds 			wanxl_pci_remove_one(pdev);
7411da177e4SLinus Torvalds 			return -ENOMEM;
7421da177e4SLinus Torvalds 		}
7431da177e4SLinus Torvalds 
7441da177e4SLinus Torvalds 		port->dev = dev;
7451da177e4SLinus Torvalds 		hdlc = dev_to_hdlc(dev);
7461da177e4SLinus Torvalds 		spin_lock_init(&port->lock);
7471da177e4SLinus Torvalds 		dev->tx_queue_len = 50;
748991990a1SKrzysztof Hałasa 		dev->netdev_ops = &wanxl_ops;
7491da177e4SLinus Torvalds 		hdlc->attach = wanxl_attach;
7501da177e4SLinus Torvalds 		hdlc->xmit = wanxl_xmit;
7511da177e4SLinus Torvalds 		port->card = card;
7521da177e4SLinus Torvalds 		port->node = i;
7531da177e4SLinus Torvalds 		get_status(port)->clocking = CLOCK_EXT;
7541da177e4SLinus Torvalds 		if (register_hdlc_device(dev)) {
75512a3bfefSJoe Perches 			pr_err("%s: unable to register hdlc device\n",
75612a3bfefSJoe Perches 			       pci_name(pdev));
7571da177e4SLinus Torvalds 			free_netdev(dev);
7581da177e4SLinus Torvalds 			wanxl_pci_remove_one(pdev);
7591da177e4SLinus Torvalds 			return -ENOBUFS;
7601da177e4SLinus Torvalds 		}
7611da177e4SLinus Torvalds 		card->n_ports++;
7621da177e4SLinus Torvalds 	}
7631da177e4SLinus Torvalds 
76412a3bfefSJoe Perches 	pr_info("%s: port", pci_name(pdev));
7651da177e4SLinus Torvalds 	for (i = 0; i < ports; i++)
76612a3bfefSJoe Perches 		pr_cont("%s #%i: %s",
76712a3bfefSJoe Perches 			i ? "," : "", i, card->ports[i].dev->name);
76812a3bfefSJoe Perches 	pr_cont("\n");
7691da177e4SLinus Torvalds 
7701da177e4SLinus Torvalds 	for (i = 0; i < ports; i++)
7711da177e4SLinus Torvalds 		wanxl_cable_intr(&card->ports[i]); /* get carrier status etc.*/
7721da177e4SLinus Torvalds 
7731da177e4SLinus Torvalds 	return 0;
7741da177e4SLinus Torvalds }
7751da177e4SLinus Torvalds 
7769baa3c34SBenoit Taine static const struct pci_device_id wanxl_pci_tbl[] = {
7771da177e4SLinus Torvalds 	{ PCI_VENDOR_ID_SBE, PCI_DEVICE_ID_SBE_WANXL100, PCI_ANY_ID,
7781da177e4SLinus Torvalds 	  PCI_ANY_ID, 0, 0, 0 },
7791da177e4SLinus Torvalds 	{ PCI_VENDOR_ID_SBE, PCI_DEVICE_ID_SBE_WANXL200, PCI_ANY_ID,
7801da177e4SLinus Torvalds 	  PCI_ANY_ID, 0, 0, 0 },
7811da177e4SLinus Torvalds 	{ PCI_VENDOR_ID_SBE, PCI_DEVICE_ID_SBE_WANXL400, PCI_ANY_ID,
7821da177e4SLinus Torvalds 	  PCI_ANY_ID, 0, 0, 0 },
7831da177e4SLinus Torvalds 	{ 0, }
7841da177e4SLinus Torvalds };
7851da177e4SLinus Torvalds 
7861da177e4SLinus Torvalds static struct pci_driver wanxl_pci_driver = {
7871da177e4SLinus Torvalds 	.name		= "wanXL",
7881da177e4SLinus Torvalds 	.id_table	= wanxl_pci_tbl,
7891da177e4SLinus Torvalds 	.probe		= wanxl_pci_init_one,
7901da177e4SLinus Torvalds 	.remove		= wanxl_pci_remove_one,
7911da177e4SLinus Torvalds };
7921da177e4SLinus Torvalds 
7931da177e4SLinus Torvalds static int __init wanxl_init_module(void)
7941da177e4SLinus Torvalds {
7951da177e4SLinus Torvalds #ifdef MODULE
79612a3bfefSJoe Perches 	pr_info("%s\n", version);
7971da177e4SLinus Torvalds #endif
79829917620SJeff Garzik 	return pci_register_driver(&wanxl_pci_driver);
7991da177e4SLinus Torvalds }
8001da177e4SLinus Torvalds 
8011da177e4SLinus Torvalds static void __exit wanxl_cleanup_module(void)
8021da177e4SLinus Torvalds {
8031da177e4SLinus Torvalds 	pci_unregister_driver(&wanxl_pci_driver);
8041da177e4SLinus Torvalds }
8051da177e4SLinus Torvalds 
8061da177e4SLinus Torvalds MODULE_AUTHOR("Krzysztof Halasa <khc@pm.waw.pl>");
8071da177e4SLinus Torvalds MODULE_DESCRIPTION("SBE Inc. wanXL serial port driver");
8081da177e4SLinus Torvalds MODULE_LICENSE("GPL v2");
8091da177e4SLinus Torvalds MODULE_DEVICE_TABLE(pci, wanxl_pci_tbl);
8101da177e4SLinus Torvalds 
8111da177e4SLinus Torvalds module_init(wanxl_init_module);
8121da177e4SLinus Torvalds module_exit(wanxl_cleanup_module);
813