Linux Audio

Check our new training course

Loading...
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 *  Copyright (c) 2002 Petko Manolov (petkan@users.sourceforge.net)
  4 */
  5
  6#include <linux/signal.h>
  7#include <linux/slab.h>
  8#include <linux/module.h>
  9#include <linux/netdevice.h>
 10#include <linux/etherdevice.h>
 11#include <linux/mii.h>
 12#include <linux/ethtool.h>
 13#include <linux/usb.h>
 14#include <linux/uaccess.h>
 15
 16/* Version Information */
 17#define DRIVER_VERSION "v0.6.2 (2004/08/27)"
 18#define DRIVER_AUTHOR "Petko Manolov <petkan@users.sourceforge.net>"
 19#define DRIVER_DESC "rtl8150 based usb-ethernet driver"
 20
 21#define	IDR			0x0120
 22#define	MAR			0x0126
 23#define	CR			0x012e
 24#define	TCR			0x012f
 25#define	RCR			0x0130
 26#define	TSR			0x0132
 27#define	RSR			0x0133
 28#define	CON0			0x0135
 29#define	CON1			0x0136
 30#define	MSR			0x0137
 31#define	PHYADD			0x0138
 32#define	PHYDAT			0x0139
 33#define	PHYCNT			0x013b
 34#define	GPPC			0x013d
 35#define	BMCR			0x0140
 36#define	BMSR			0x0142
 37#define	ANAR			0x0144
 38#define	ANLP			0x0146
 39#define	AER			0x0148
 40#define CSCR			0x014C  /* This one has the link status */
 41#define CSCR_LINK_STATUS	(1 << 3)
 42
 43#define	IDR_EEPROM		0x1202
 44
 45#define	PHY_READ		0
 46#define	PHY_WRITE		0x20
 47#define	PHY_GO			0x40
 48
 49#define	MII_TIMEOUT		10
 50#define	INTBUFSIZE		8
 51
 52#define	RTL8150_REQT_READ	0xc0
 53#define	RTL8150_REQT_WRITE	0x40
 54#define	RTL8150_REQ_GET_REGS	0x05
 55#define	RTL8150_REQ_SET_REGS	0x05
 56
 57
 58/* Transmit status register errors */
 59#define TSR_ECOL		(1<<5)
 60#define TSR_LCOL		(1<<4)
 61#define TSR_LOSS_CRS		(1<<3)
 62#define TSR_JBR			(1<<2)
 63#define TSR_ERRORS		(TSR_ECOL | TSR_LCOL | TSR_LOSS_CRS | TSR_JBR)
 64/* Receive status register errors */
 65#define RSR_CRC			(1<<2)
 66#define RSR_FAE			(1<<1)
 67#define RSR_ERRORS		(RSR_CRC | RSR_FAE)
 68
 69/* Media status register definitions */
 70#define MSR_DUPLEX		(1<<4)
 71#define MSR_SPEED		(1<<3)
 72#define MSR_LINK		(1<<2)
 73
 74/* USB endpoints */
 75enum rtl8150_usb_ep {
 76	RTL8150_USB_EP_CONTROL = 0,
 77	RTL8150_USB_EP_BULK_IN = 1,
 78	RTL8150_USB_EP_BULK_OUT = 2,
 79	RTL8150_USB_EP_INT_IN = 3,
 80};
 81
 82/* Interrupt pipe data */
 83#define INT_TSR			0x00
 84#define INT_RSR			0x01
 85#define INT_MSR			0x02
 86#define INT_WAKSR		0x03
 87#define INT_TXOK_CNT		0x04
 88#define INT_RXLOST_CNT		0x05
 89#define INT_CRERR_CNT		0x06
 90#define INT_COL_CNT		0x07
 91
 92
 93#define	RTL8150_MTU		1540
 94#define	RTL8150_TX_TIMEOUT	(HZ)
 95#define	RX_SKB_POOL_SIZE	4
 96
 97/* rtl8150 flags */
 98#define	RTL8150_HW_CRC		0
 99#define	RX_REG_SET		1
100#define	RTL8150_UNPLUG		2
101#define	RX_URB_FAIL		3
102
103/* Define these values to match your device */
104#define	VENDOR_ID_REALTEK		0x0bda
105#define	VENDOR_ID_MELCO			0x0411
106#define	VENDOR_ID_MICRONET		0x3980
107#define	VENDOR_ID_LONGSHINE		0x07b8
108#define	VENDOR_ID_OQO			0x1557
109#define	VENDOR_ID_ZYXEL			0x0586
110
111#define PRODUCT_ID_RTL8150		0x8150
112#define	PRODUCT_ID_LUAKTX		0x0012
113#define	PRODUCT_ID_LCS8138TX		0x401a
114#define PRODUCT_ID_SP128AR		0x0003
115#define	PRODUCT_ID_PRESTIGE		0x401a
116
117#undef	EEPROM_WRITE
118
119/* table of devices that work with this driver */
120static const struct usb_device_id rtl8150_table[] = {
121	{USB_DEVICE(VENDOR_ID_REALTEK, PRODUCT_ID_RTL8150)},
122	{USB_DEVICE(VENDOR_ID_MELCO, PRODUCT_ID_LUAKTX)},
123	{USB_DEVICE(VENDOR_ID_MICRONET, PRODUCT_ID_SP128AR)},
124	{USB_DEVICE(VENDOR_ID_LONGSHINE, PRODUCT_ID_LCS8138TX)},
125	{USB_DEVICE(VENDOR_ID_OQO, PRODUCT_ID_RTL8150)},
126	{USB_DEVICE(VENDOR_ID_ZYXEL, PRODUCT_ID_PRESTIGE)},
127	{}
128};
129
130MODULE_DEVICE_TABLE(usb, rtl8150_table);
131
132struct rtl8150 {
133	unsigned long flags;
134	struct usb_device *udev;
135	struct tasklet_struct tl;
136	struct net_device *netdev;
137	struct urb *rx_urb, *tx_urb, *intr_urb;
138	struct sk_buff *tx_skb, *rx_skb;
139	struct sk_buff *rx_skb_pool[RX_SKB_POOL_SIZE];
140	spinlock_t rx_pool_lock;
141	struct usb_ctrlrequest dr;
142	int intr_interval;
143	u8 *intr_buff;
144	u8 phy;
145};
146
147typedef struct rtl8150 rtl8150_t;
148
149struct async_req {
150	struct usb_ctrlrequest dr;
151	u16 rx_creg;
152};
153
154static const char driver_name [] = "rtl8150";
155
156/*
157**
158**	device related part of the code
159**
160*/
161static int get_registers(rtl8150_t * dev, u16 indx, u16 size, void *data)
162{
163	return usb_control_msg_recv(dev->udev, 0, RTL8150_REQ_GET_REGS,
164				    RTL8150_REQT_READ, indx, 0, data, size,
165				    1000, GFP_NOIO);
 
 
 
 
 
 
 
 
 
 
 
166}
167
168static int set_registers(rtl8150_t * dev, u16 indx, u16 size, const void *data)
169{
170	return usb_control_msg_send(dev->udev, 0, RTL8150_REQ_SET_REGS,
171				    RTL8150_REQT_WRITE, indx, 0, data, size,
172				    1000, GFP_NOIO);
 
 
 
 
 
 
 
 
 
173}
174
175static void async_set_reg_cb(struct urb *urb)
176{
177	struct async_req *req = (struct async_req *)urb->context;
178	int status = urb->status;
179
180	if (status < 0)
181		dev_dbg(&urb->dev->dev, "%s failed with %d", __func__, status);
182	kfree(req);
183	usb_free_urb(urb);
184}
185
186static int async_set_registers(rtl8150_t *dev, u16 indx, u16 size, u16 reg)
187{
188	int res = -ENOMEM;
189	struct urb *async_urb;
190	struct async_req *req;
191
192	req = kmalloc(sizeof(struct async_req), GFP_ATOMIC);
193	if (req == NULL)
194		return res;
195	async_urb = usb_alloc_urb(0, GFP_ATOMIC);
196	if (async_urb == NULL) {
197		kfree(req);
198		return res;
199	}
200	req->rx_creg = cpu_to_le16(reg);
201	req->dr.bRequestType = RTL8150_REQT_WRITE;
202	req->dr.bRequest = RTL8150_REQ_SET_REGS;
203	req->dr.wIndex = 0;
204	req->dr.wValue = cpu_to_le16(indx);
205	req->dr.wLength = cpu_to_le16(size);
206	usb_fill_control_urb(async_urb, dev->udev,
207	                     usb_sndctrlpipe(dev->udev, 0), (void *)&req->dr,
208			     &req->rx_creg, size, async_set_reg_cb, req);
209	res = usb_submit_urb(async_urb, GFP_ATOMIC);
210	if (res) {
211		if (res == -ENODEV)
212			netif_device_detach(dev->netdev);
213		dev_err(&dev->udev->dev, "%s failed with %d\n", __func__, res);
214	}
215	return res;
216}
217
218static int read_mii_word(rtl8150_t * dev, u8 phy, __u8 indx, u16 * reg)
219{
220	int i;
221	u8 data[3], tmp;
222
223	data[0] = phy;
224	data[1] = data[2] = 0;
225	tmp = indx | PHY_READ | PHY_GO;
226	i = 0;
227
228	set_registers(dev, PHYADD, sizeof(data), data);
229	set_registers(dev, PHYCNT, 1, &tmp);
230	do {
231		get_registers(dev, PHYCNT, 1, data);
232	} while ((data[0] & PHY_GO) && (i++ < MII_TIMEOUT));
233
234	if (i <= MII_TIMEOUT) {
235		get_registers(dev, PHYDAT, 2, data);
236		*reg = data[0] | (data[1] << 8);
237		return 0;
238	} else
239		return 1;
240}
241
242static int write_mii_word(rtl8150_t * dev, u8 phy, __u8 indx, u16 reg)
243{
244	int i;
245	u8 data[3], tmp;
246
247	data[0] = phy;
248	data[1] = reg & 0xff;
249	data[2] = (reg >> 8) & 0xff;
250	tmp = indx | PHY_WRITE | PHY_GO;
251	i = 0;
252
253	set_registers(dev, PHYADD, sizeof(data), data);
254	set_registers(dev, PHYCNT, 1, &tmp);
255	do {
256		get_registers(dev, PHYCNT, 1, data);
257	} while ((data[0] & PHY_GO) && (i++ < MII_TIMEOUT));
258
259	if (i <= MII_TIMEOUT)
260		return 0;
261	else
262		return 1;
263}
264
265static void set_ethernet_addr(rtl8150_t *dev)
266{
267	u8 node_id[ETH_ALEN];
268	int ret;
269
270	ret = get_registers(dev, IDR, sizeof(node_id), node_id);
271
272	if (!ret) {
273		eth_hw_addr_set(dev->netdev, node_id);
274	} else {
275		eth_hw_addr_random(dev->netdev);
276		netdev_notice(dev->netdev, "Assigned a random MAC address: %pM\n",
277			      dev->netdev->dev_addr);
278	}
279}
280
281static int rtl8150_set_mac_address(struct net_device *netdev, void *p)
282{
283	struct sockaddr *addr = p;
284	rtl8150_t *dev = netdev_priv(netdev);
285
286	if (netif_running(netdev))
287		return -EBUSY;
288
289	eth_hw_addr_set(netdev, addr->sa_data);
290	netdev_dbg(netdev, "Setting MAC address to %pM\n", netdev->dev_addr);
291	/* Set the IDR registers. */
292	set_registers(dev, IDR, netdev->addr_len, netdev->dev_addr);
293#ifdef EEPROM_WRITE
294	{
295	int i;
296	u8 cr;
297	/* Get the CR contents. */
298	get_registers(dev, CR, 1, &cr);
299	/* Set the WEPROM bit (eeprom write enable). */
300	cr |= 0x20;
301	set_registers(dev, CR, 1, &cr);
302	/* Write the MAC address into eeprom. Eeprom writes must be word-sized,
303	   so we need to split them up. */
304	for (i = 0; i * 2 < netdev->addr_len; i++) {
305		set_registers(dev, IDR_EEPROM + (i * 2), 2,
306		netdev->dev_addr + (i * 2));
307	}
308	/* Clear the WEPROM bit (preventing accidental eeprom writes). */
309	cr &= 0xdf;
310	set_registers(dev, CR, 1, &cr);
311	}
312#endif
313	return 0;
314}
315
316static int rtl8150_reset(rtl8150_t * dev)
317{
318	u8 data = 0x10;
319	int i = HZ;
320
321	set_registers(dev, CR, 1, &data);
322	do {
323		get_registers(dev, CR, 1, &data);
324	} while ((data & 0x10) && --i);
325
326	return (i > 0) ? 1 : 0;
327}
328
329static int alloc_all_urbs(rtl8150_t * dev)
330{
331	dev->rx_urb = usb_alloc_urb(0, GFP_KERNEL);
332	if (!dev->rx_urb)
333		return 0;
334	dev->tx_urb = usb_alloc_urb(0, GFP_KERNEL);
335	if (!dev->tx_urb) {
336		usb_free_urb(dev->rx_urb);
337		return 0;
338	}
339	dev->intr_urb = usb_alloc_urb(0, GFP_KERNEL);
340	if (!dev->intr_urb) {
341		usb_free_urb(dev->rx_urb);
342		usb_free_urb(dev->tx_urb);
343		return 0;
344	}
345
346	return 1;
347}
348
349static void free_all_urbs(rtl8150_t * dev)
350{
351	usb_free_urb(dev->rx_urb);
352	usb_free_urb(dev->tx_urb);
353	usb_free_urb(dev->intr_urb);
354}
355
356static void unlink_all_urbs(rtl8150_t * dev)
357{
358	usb_kill_urb(dev->rx_urb);
359	usb_kill_urb(dev->tx_urb);
360	usb_kill_urb(dev->intr_urb);
361}
362
363static inline struct sk_buff *pull_skb(rtl8150_t *dev)
364{
365	struct sk_buff *skb;
366	int i;
367
368	for (i = 0; i < RX_SKB_POOL_SIZE; i++) {
369		if (dev->rx_skb_pool[i]) {
370			skb = dev->rx_skb_pool[i];
371			dev->rx_skb_pool[i] = NULL;
372			return skb;
373		}
374	}
375	return NULL;
376}
377
378static void read_bulk_callback(struct urb *urb)
379{
380	rtl8150_t *dev;
381	unsigned pkt_len, res;
382	struct sk_buff *skb;
383	struct net_device *netdev;
384	int status = urb->status;
385	int result;
386	unsigned long flags;
387
388	dev = urb->context;
389	if (!dev)
390		return;
391	if (test_bit(RTL8150_UNPLUG, &dev->flags))
392		return;
393	netdev = dev->netdev;
394	if (!netif_device_present(netdev))
395		return;
396
397	switch (status) {
398	case 0:
399		break;
400	case -ENOENT:
401		return;	/* the urb is in unlink state */
402	case -ETIME:
403		if (printk_ratelimit())
404			dev_warn(&urb->dev->dev, "may be reset is needed?..\n");
405		goto goon;
406	default:
407		if (printk_ratelimit())
408			dev_warn(&urb->dev->dev, "Rx status %d\n", status);
409		goto goon;
410	}
411
412	if (!dev->rx_skb)
413		goto resched;
414	/* protect against short packets (tell me why we got some?!?) */
415	if (urb->actual_length < 4)
416		goto goon;
417
418	res = urb->actual_length;
419	pkt_len = res - 4;
420
421	skb_put(dev->rx_skb, pkt_len);
422	dev->rx_skb->protocol = eth_type_trans(dev->rx_skb, netdev);
423	netif_rx(dev->rx_skb);
424	netdev->stats.rx_packets++;
425	netdev->stats.rx_bytes += pkt_len;
426
427	spin_lock_irqsave(&dev->rx_pool_lock, flags);
428	skb = pull_skb(dev);
429	spin_unlock_irqrestore(&dev->rx_pool_lock, flags);
430	if (!skb)
431		goto resched;
432
433	dev->rx_skb = skb;
434goon:
435	usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
436		      dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
437	result = usb_submit_urb(dev->rx_urb, GFP_ATOMIC);
438	if (result == -ENODEV)
439		netif_device_detach(dev->netdev);
440	else if (result) {
441		set_bit(RX_URB_FAIL, &dev->flags);
442		goto resched;
443	} else {
444		clear_bit(RX_URB_FAIL, &dev->flags);
445	}
446
447	return;
448resched:
449	tasklet_schedule(&dev->tl);
450}
451
452static void write_bulk_callback(struct urb *urb)
453{
454	rtl8150_t *dev;
455	int status = urb->status;
456
457	dev = urb->context;
458	if (!dev)
459		return;
460	dev_kfree_skb_irq(dev->tx_skb);
461	if (!netif_device_present(dev->netdev))
462		return;
463	if (status)
464		dev_info(&urb->dev->dev, "%s: Tx status %d\n",
465			 dev->netdev->name, status);
466	netif_trans_update(dev->netdev);
467	netif_wake_queue(dev->netdev);
468}
469
470static void intr_callback(struct urb *urb)
471{
472	rtl8150_t *dev;
473	__u8 *d;
474	int status = urb->status;
475	int res;
476
477	dev = urb->context;
478	if (!dev)
479		return;
480	switch (status) {
481	case 0:			/* success */
482		break;
483	case -ECONNRESET:	/* unlink */
484	case -ENOENT:
485	case -ESHUTDOWN:
486		return;
487	/* -EPIPE:  should clear the halt */
488	default:
489		dev_info(&urb->dev->dev, "%s: intr status %d\n",
490			 dev->netdev->name, status);
491		goto resubmit;
492	}
493
494	d = urb->transfer_buffer;
495	if (d[0] & TSR_ERRORS) {
496		dev->netdev->stats.tx_errors++;
497		if (d[INT_TSR] & (TSR_ECOL | TSR_JBR))
498			dev->netdev->stats.tx_aborted_errors++;
499		if (d[INT_TSR] & TSR_LCOL)
500			dev->netdev->stats.tx_window_errors++;
501		if (d[INT_TSR] & TSR_LOSS_CRS)
502			dev->netdev->stats.tx_carrier_errors++;
503	}
504	/* Report link status changes to the network stack */
505	if ((d[INT_MSR] & MSR_LINK) == 0) {
506		if (netif_carrier_ok(dev->netdev)) {
507			netif_carrier_off(dev->netdev);
508			netdev_dbg(dev->netdev, "%s: LINK LOST\n", __func__);
509		}
510	} else {
511		if (!netif_carrier_ok(dev->netdev)) {
512			netif_carrier_on(dev->netdev);
513			netdev_dbg(dev->netdev, "%s: LINK CAME BACK\n", __func__);
514		}
515	}
516
517resubmit:
518	res = usb_submit_urb (urb, GFP_ATOMIC);
519	if (res == -ENODEV)
520		netif_device_detach(dev->netdev);
521	else if (res)
522		dev_err(&dev->udev->dev,
523			"can't resubmit intr, %s-%s/input0, status %d\n",
524			dev->udev->bus->bus_name, dev->udev->devpath, res);
525}
526
527static int rtl8150_suspend(struct usb_interface *intf, pm_message_t message)
528{
529	rtl8150_t *dev = usb_get_intfdata(intf);
530
531	netif_device_detach(dev->netdev);
532
533	if (netif_running(dev->netdev)) {
534		usb_kill_urb(dev->rx_urb);
535		usb_kill_urb(dev->intr_urb);
536	}
537	return 0;
538}
539
540static int rtl8150_resume(struct usb_interface *intf)
541{
542	rtl8150_t *dev = usb_get_intfdata(intf);
543
544	netif_device_attach(dev->netdev);
545	if (netif_running(dev->netdev)) {
546		dev->rx_urb->status = 0;
547		dev->rx_urb->actual_length = 0;
548		read_bulk_callback(dev->rx_urb);
549
550		dev->intr_urb->status = 0;
551		dev->intr_urb->actual_length = 0;
552		intr_callback(dev->intr_urb);
553	}
554	return 0;
555}
556
557/*
558**
559**	network related part of the code
560**
561*/
562
563static void fill_skb_pool(rtl8150_t *dev)
564{
565	struct sk_buff *skb;
566	int i;
567
568	for (i = 0; i < RX_SKB_POOL_SIZE; i++) {
569		if (dev->rx_skb_pool[i])
570			continue;
571		skb = dev_alloc_skb(RTL8150_MTU + 2);
572		if (!skb) {
573			return;
574		}
575		skb_reserve(skb, 2);
576		dev->rx_skb_pool[i] = skb;
577	}
578}
579
580static void free_skb_pool(rtl8150_t *dev)
581{
582	int i;
583
584	for (i = 0; i < RX_SKB_POOL_SIZE; i++)
585		dev_kfree_skb(dev->rx_skb_pool[i]);
586}
587
588static void rx_fixup(struct tasklet_struct *t)
589{
590	struct rtl8150 *dev = from_tasklet(dev, t, tl);
591	struct sk_buff *skb;
592	int status;
593
594	spin_lock_irq(&dev->rx_pool_lock);
595	fill_skb_pool(dev);
596	spin_unlock_irq(&dev->rx_pool_lock);
597	if (test_bit(RX_URB_FAIL, &dev->flags))
598		if (dev->rx_skb)
599			goto try_again;
600	spin_lock_irq(&dev->rx_pool_lock);
601	skb = pull_skb(dev);
602	spin_unlock_irq(&dev->rx_pool_lock);
603	if (skb == NULL)
604		goto tlsched;
605	dev->rx_skb = skb;
606	usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
607		      dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
608try_again:
609	status = usb_submit_urb(dev->rx_urb, GFP_ATOMIC);
610	if (status == -ENODEV) {
611		netif_device_detach(dev->netdev);
612	} else if (status) {
613		set_bit(RX_URB_FAIL, &dev->flags);
614		goto tlsched;
615	} else {
616		clear_bit(RX_URB_FAIL, &dev->flags);
617	}
618
619	return;
620tlsched:
621	tasklet_schedule(&dev->tl);
622}
623
624static int enable_net_traffic(rtl8150_t * dev)
625{
626	u8 cr, tcr, rcr, msr;
627
628	if (!rtl8150_reset(dev)) {
629		dev_warn(&dev->udev->dev, "device reset failed\n");
630	}
631	/* RCR bit7=1 attach Rx info at the end;  =0 HW CRC (which is broken) */
632	rcr = 0x9e;
633	tcr = 0xd8;
634	cr = 0x0c;
635	if (!(rcr & 0x80))
636		set_bit(RTL8150_HW_CRC, &dev->flags);
637	set_registers(dev, RCR, 1, &rcr);
638	set_registers(dev, TCR, 1, &tcr);
639	set_registers(dev, CR, 1, &cr);
640	get_registers(dev, MSR, 1, &msr);
641
642	return 0;
643}
644
645static void disable_net_traffic(rtl8150_t * dev)
646{
647	u8 cr;
648
649	get_registers(dev, CR, 1, &cr);
650	cr &= 0xf3;
651	set_registers(dev, CR, 1, &cr);
652}
653
654static void rtl8150_tx_timeout(struct net_device *netdev, unsigned int txqueue)
655{
656	rtl8150_t *dev = netdev_priv(netdev);
657	dev_warn(&netdev->dev, "Tx timeout.\n");
658	usb_unlink_urb(dev->tx_urb);
659	netdev->stats.tx_errors++;
660}
661
662static void rtl8150_set_multicast(struct net_device *netdev)
663{
664	rtl8150_t *dev = netdev_priv(netdev);
665	u16 rx_creg = 0x9e;
666
667	netif_stop_queue(netdev);
668	if (netdev->flags & IFF_PROMISC) {
669		rx_creg |= 0x0001;
670		dev_info(&netdev->dev, "%s: promiscuous mode\n", netdev->name);
671	} else if (!netdev_mc_empty(netdev) ||
672		   (netdev->flags & IFF_ALLMULTI)) {
673		rx_creg &= 0xfffe;
674		rx_creg |= 0x0002;
675		dev_dbg(&netdev->dev, "%s: allmulti set\n", netdev->name);
676	} else {
677		/* ~RX_MULTICAST, ~RX_PROMISCUOUS */
678		rx_creg &= 0x00fc;
679	}
680	async_set_registers(dev, RCR, sizeof(rx_creg), rx_creg);
681	netif_wake_queue(netdev);
682}
683
684static netdev_tx_t rtl8150_start_xmit(struct sk_buff *skb,
685					    struct net_device *netdev)
686{
687	rtl8150_t *dev = netdev_priv(netdev);
688	int count, res;
689
690	netif_stop_queue(netdev);
691	count = (skb->len < 60) ? 60 : skb->len;
692	count = (count & 0x3f) ? count : count + 1;
693	dev->tx_skb = skb;
694	usb_fill_bulk_urb(dev->tx_urb, dev->udev, usb_sndbulkpipe(dev->udev, 2),
695		      skb->data, count, write_bulk_callback, dev);
696	if ((res = usb_submit_urb(dev->tx_urb, GFP_ATOMIC))) {
697		/* Can we get/handle EPIPE here? */
698		if (res == -ENODEV)
699			netif_device_detach(dev->netdev);
700		else {
701			dev_warn(&netdev->dev, "failed tx_urb %d\n", res);
702			netdev->stats.tx_errors++;
703			netif_start_queue(netdev);
704		}
705	} else {
706		netdev->stats.tx_packets++;
707		netdev->stats.tx_bytes += skb->len;
708		netif_trans_update(netdev);
709	}
710
711	return NETDEV_TX_OK;
712}
713
714
715static void set_carrier(struct net_device *netdev)
716{
717	rtl8150_t *dev = netdev_priv(netdev);
718	short tmp;
719
720	get_registers(dev, CSCR, 2, &tmp);
721	if (tmp & CSCR_LINK_STATUS)
722		netif_carrier_on(netdev);
723	else
724		netif_carrier_off(netdev);
725}
726
727static int rtl8150_open(struct net_device *netdev)
728{
729	rtl8150_t *dev = netdev_priv(netdev);
730	int res;
731
732	if (dev->rx_skb == NULL)
733		dev->rx_skb = pull_skb(dev);
734	if (!dev->rx_skb)
735		return -ENOMEM;
736
737	set_registers(dev, IDR, 6, netdev->dev_addr);
738
739	usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
740		      dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
741	if ((res = usb_submit_urb(dev->rx_urb, GFP_KERNEL))) {
742		if (res == -ENODEV)
743			netif_device_detach(dev->netdev);
744		dev_warn(&netdev->dev, "rx_urb submit failed: %d\n", res);
745		return res;
746	}
747	usb_fill_int_urb(dev->intr_urb, dev->udev, usb_rcvintpipe(dev->udev, 3),
748		     dev->intr_buff, INTBUFSIZE, intr_callback,
749		     dev, dev->intr_interval);
750	if ((res = usb_submit_urb(dev->intr_urb, GFP_KERNEL))) {
751		if (res == -ENODEV)
752			netif_device_detach(dev->netdev);
753		dev_warn(&netdev->dev, "intr_urb submit failed: %d\n", res);
754		usb_kill_urb(dev->rx_urb);
755		return res;
756	}
757	enable_net_traffic(dev);
758	set_carrier(netdev);
759	netif_start_queue(netdev);
760
761	return res;
762}
763
764static int rtl8150_close(struct net_device *netdev)
765{
766	rtl8150_t *dev = netdev_priv(netdev);
767
768	netif_stop_queue(netdev);
769	if (!test_bit(RTL8150_UNPLUG, &dev->flags))
770		disable_net_traffic(dev);
771	unlink_all_urbs(dev);
772
773	return 0;
774}
775
776static void rtl8150_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *info)
777{
778	rtl8150_t *dev = netdev_priv(netdev);
779
780	strscpy(info->driver, driver_name, sizeof(info->driver));
781	strscpy(info->version, DRIVER_VERSION, sizeof(info->version));
782	usb_make_path(dev->udev, info->bus_info, sizeof(info->bus_info));
783}
784
785static int rtl8150_get_link_ksettings(struct net_device *netdev,
786				      struct ethtool_link_ksettings *ecmd)
787{
788	rtl8150_t *dev = netdev_priv(netdev);
789	short lpa = 0;
790	short bmcr = 0;
791	u32 supported;
792
793	supported = (SUPPORTED_10baseT_Half |
794			  SUPPORTED_10baseT_Full |
795			  SUPPORTED_100baseT_Half |
796			  SUPPORTED_100baseT_Full |
797			  SUPPORTED_Autoneg |
798			  SUPPORTED_TP | SUPPORTED_MII);
799	ecmd->base.port = PORT_TP;
800	ecmd->base.phy_address = dev->phy;
801	get_registers(dev, BMCR, 2, &bmcr);
802	get_registers(dev, ANLP, 2, &lpa);
803	if (bmcr & BMCR_ANENABLE) {
804		u32 speed = ((lpa & (LPA_100HALF | LPA_100FULL)) ?
805			     SPEED_100 : SPEED_10);
806		ecmd->base.speed = speed;
807		ecmd->base.autoneg = AUTONEG_ENABLE;
808		if (speed == SPEED_100)
809			ecmd->base.duplex = (lpa & LPA_100FULL) ?
810			    DUPLEX_FULL : DUPLEX_HALF;
811		else
812			ecmd->base.duplex = (lpa & LPA_10FULL) ?
813			    DUPLEX_FULL : DUPLEX_HALF;
814	} else {
815		ecmd->base.autoneg = AUTONEG_DISABLE;
816		ecmd->base.speed = ((bmcr & BMCR_SPEED100) ?
817					     SPEED_100 : SPEED_10);
818		ecmd->base.duplex = (bmcr & BMCR_FULLDPLX) ?
819		    DUPLEX_FULL : DUPLEX_HALF;
820	}
821
822	ethtool_convert_legacy_u32_to_link_mode(ecmd->link_modes.supported,
823						supported);
824
825	return 0;
826}
827
828static const struct ethtool_ops ops = {
829	.get_drvinfo = rtl8150_get_drvinfo,
830	.get_link = ethtool_op_get_link,
831	.get_link_ksettings = rtl8150_get_link_ksettings,
832};
833
834static int rtl8150_siocdevprivate(struct net_device *netdev, struct ifreq *rq,
835				  void __user *udata, int cmd)
836{
837	rtl8150_t *dev = netdev_priv(netdev);
838	u16 *data = (u16 *) & rq->ifr_ifru;
839	int res = 0;
840
841	switch (cmd) {
842	case SIOCDEVPRIVATE:
843		data[0] = dev->phy;
844		fallthrough;
845	case SIOCDEVPRIVATE + 1:
846		read_mii_word(dev, dev->phy, (data[1] & 0x1f), &data[3]);
847		break;
848	case SIOCDEVPRIVATE + 2:
849		if (!capable(CAP_NET_ADMIN))
850			return -EPERM;
851		write_mii_word(dev, dev->phy, (data[1] & 0x1f), data[2]);
852		break;
853	default:
854		res = -EOPNOTSUPP;
855	}
856
857	return res;
858}
859
860static const struct net_device_ops rtl8150_netdev_ops = {
861	.ndo_open		= rtl8150_open,
862	.ndo_stop		= rtl8150_close,
863	.ndo_siocdevprivate	= rtl8150_siocdevprivate,
864	.ndo_start_xmit		= rtl8150_start_xmit,
865	.ndo_tx_timeout		= rtl8150_tx_timeout,
866	.ndo_set_rx_mode	= rtl8150_set_multicast,
867	.ndo_set_mac_address	= rtl8150_set_mac_address,
868
869	.ndo_validate_addr	= eth_validate_addr,
870};
871
872static int rtl8150_probe(struct usb_interface *intf,
873			 const struct usb_device_id *id)
874{
875	struct usb_device *udev = interface_to_usbdev(intf);
876	rtl8150_t *dev;
877	struct net_device *netdev;
878	static const u8 bulk_ep_addr[] = {
879		RTL8150_USB_EP_BULK_IN | USB_DIR_IN,
880		RTL8150_USB_EP_BULK_OUT | USB_DIR_OUT,
881		0};
882	static const u8 int_ep_addr[] = {
883		RTL8150_USB_EP_INT_IN | USB_DIR_IN,
884		0};
885
886	netdev = alloc_etherdev(sizeof(rtl8150_t));
887	if (!netdev)
888		return -ENOMEM;
889
890	dev = netdev_priv(netdev);
891
892	dev->intr_buff = kmalloc(INTBUFSIZE, GFP_KERNEL);
893	if (!dev->intr_buff) {
894		free_netdev(netdev);
895		return -ENOMEM;
896	}
897
898	/* Verify that all required endpoints are present */
899	if (!usb_check_bulk_endpoints(intf, bulk_ep_addr) ||
900	    !usb_check_int_endpoints(intf, int_ep_addr)) {
901		dev_err(&intf->dev, "couldn't find required endpoints\n");
902		goto out;
903	}
904
905	tasklet_setup(&dev->tl, rx_fixup);
906	spin_lock_init(&dev->rx_pool_lock);
907
908	dev->udev = udev;
909	dev->netdev = netdev;
910	netdev->netdev_ops = &rtl8150_netdev_ops;
911	netdev->watchdog_timeo = RTL8150_TX_TIMEOUT;
912	netdev->ethtool_ops = &ops;
913	dev->intr_interval = 100;	/* 100ms */
914
915	if (!alloc_all_urbs(dev)) {
916		dev_err(&intf->dev, "out of memory\n");
917		goto out;
918	}
919	if (!rtl8150_reset(dev)) {
920		dev_err(&intf->dev, "couldn't reset the device\n");
921		goto out1;
922	}
923	fill_skb_pool(dev);
924	set_ethernet_addr(dev);
925
926	usb_set_intfdata(intf, dev);
927	SET_NETDEV_DEV(netdev, &intf->dev);
928	if (register_netdev(netdev) != 0) {
929		dev_err(&intf->dev, "couldn't register the device\n");
930		goto out2;
931	}
932
933	dev_info(&intf->dev, "%s: rtl8150 is detected\n", netdev->name);
934
935	return 0;
936
937out2:
938	usb_set_intfdata(intf, NULL);
939	free_skb_pool(dev);
940out1:
941	free_all_urbs(dev);
942out:
943	kfree(dev->intr_buff);
944	free_netdev(netdev);
945	return -EIO;
946}
947
948static void rtl8150_disconnect(struct usb_interface *intf)
949{
950	rtl8150_t *dev = usb_get_intfdata(intf);
951
952	usb_set_intfdata(intf, NULL);
953	if (dev) {
954		set_bit(RTL8150_UNPLUG, &dev->flags);
955		tasklet_kill(&dev->tl);
956		unregister_netdev(dev->netdev);
957		unlink_all_urbs(dev);
958		free_all_urbs(dev);
959		free_skb_pool(dev);
960		dev_kfree_skb(dev->rx_skb);
961		kfree(dev->intr_buff);
962		free_netdev(dev->netdev);
963	}
964}
965
966static struct usb_driver rtl8150_driver = {
967	.name		= driver_name,
968	.probe		= rtl8150_probe,
969	.disconnect	= rtl8150_disconnect,
970	.id_table	= rtl8150_table,
971	.suspend	= rtl8150_suspend,
972	.resume		= rtl8150_resume,
973	.disable_hub_initiated_lpm = 1,
974};
975
976module_usb_driver(rtl8150_driver);
977
978MODULE_AUTHOR(DRIVER_AUTHOR);
979MODULE_DESCRIPTION(DRIVER_DESC);
980MODULE_LICENSE("GPL");
v5.4
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 *  Copyright (c) 2002 Petko Manolov (petkan@users.sourceforge.net)
  4 */
  5
  6#include <linux/signal.h>
  7#include <linux/slab.h>
  8#include <linux/module.h>
  9#include <linux/netdevice.h>
 10#include <linux/etherdevice.h>
 11#include <linux/mii.h>
 12#include <linux/ethtool.h>
 13#include <linux/usb.h>
 14#include <linux/uaccess.h>
 15
 16/* Version Information */
 17#define DRIVER_VERSION "v0.6.2 (2004/08/27)"
 18#define DRIVER_AUTHOR "Petko Manolov <petkan@users.sourceforge.net>"
 19#define DRIVER_DESC "rtl8150 based usb-ethernet driver"
 20
 21#define	IDR			0x0120
 22#define	MAR			0x0126
 23#define	CR			0x012e
 24#define	TCR			0x012f
 25#define	RCR			0x0130
 26#define	TSR			0x0132
 27#define	RSR			0x0133
 28#define	CON0			0x0135
 29#define	CON1			0x0136
 30#define	MSR			0x0137
 31#define	PHYADD			0x0138
 32#define	PHYDAT			0x0139
 33#define	PHYCNT			0x013b
 34#define	GPPC			0x013d
 35#define	BMCR			0x0140
 36#define	BMSR			0x0142
 37#define	ANAR			0x0144
 38#define	ANLP			0x0146
 39#define	AER			0x0148
 40#define CSCR			0x014C  /* This one has the link status */
 41#define CSCR_LINK_STATUS	(1 << 3)
 42
 43#define	IDR_EEPROM		0x1202
 44
 45#define	PHY_READ		0
 46#define	PHY_WRITE		0x20
 47#define	PHY_GO			0x40
 48
 49#define	MII_TIMEOUT		10
 50#define	INTBUFSIZE		8
 51
 52#define	RTL8150_REQT_READ	0xc0
 53#define	RTL8150_REQT_WRITE	0x40
 54#define	RTL8150_REQ_GET_REGS	0x05
 55#define	RTL8150_REQ_SET_REGS	0x05
 56
 57
 58/* Transmit status register errors */
 59#define TSR_ECOL		(1<<5)
 60#define TSR_LCOL		(1<<4)
 61#define TSR_LOSS_CRS		(1<<3)
 62#define TSR_JBR			(1<<2)
 63#define TSR_ERRORS		(TSR_ECOL | TSR_LCOL | TSR_LOSS_CRS | TSR_JBR)
 64/* Receive status register errors */
 65#define RSR_CRC			(1<<2)
 66#define RSR_FAE			(1<<1)
 67#define RSR_ERRORS		(RSR_CRC | RSR_FAE)
 68
 69/* Media status register definitions */
 70#define MSR_DUPLEX		(1<<4)
 71#define MSR_SPEED		(1<<3)
 72#define MSR_LINK		(1<<2)
 73
 
 
 
 
 
 
 
 
 74/* Interrupt pipe data */
 75#define INT_TSR			0x00
 76#define INT_RSR			0x01
 77#define INT_MSR			0x02
 78#define INT_WAKSR		0x03
 79#define INT_TXOK_CNT		0x04
 80#define INT_RXLOST_CNT		0x05
 81#define INT_CRERR_CNT		0x06
 82#define INT_COL_CNT		0x07
 83
 84
 85#define	RTL8150_MTU		1540
 86#define	RTL8150_TX_TIMEOUT	(HZ)
 87#define	RX_SKB_POOL_SIZE	4
 88
 89/* rtl8150 flags */
 90#define	RTL8150_HW_CRC		0
 91#define	RX_REG_SET		1
 92#define	RTL8150_UNPLUG		2
 93#define	RX_URB_FAIL		3
 94
 95/* Define these values to match your device */
 96#define	VENDOR_ID_REALTEK		0x0bda
 97#define	VENDOR_ID_MELCO			0x0411
 98#define	VENDOR_ID_MICRONET		0x3980
 99#define	VENDOR_ID_LONGSHINE		0x07b8
100#define	VENDOR_ID_OQO			0x1557
101#define	VENDOR_ID_ZYXEL			0x0586
102
103#define PRODUCT_ID_RTL8150		0x8150
104#define	PRODUCT_ID_LUAKTX		0x0012
105#define	PRODUCT_ID_LCS8138TX		0x401a
106#define PRODUCT_ID_SP128AR		0x0003
107#define	PRODUCT_ID_PRESTIGE		0x401a
108
109#undef	EEPROM_WRITE
110
111/* table of devices that work with this driver */
112static const struct usb_device_id rtl8150_table[] = {
113	{USB_DEVICE(VENDOR_ID_REALTEK, PRODUCT_ID_RTL8150)},
114	{USB_DEVICE(VENDOR_ID_MELCO, PRODUCT_ID_LUAKTX)},
115	{USB_DEVICE(VENDOR_ID_MICRONET, PRODUCT_ID_SP128AR)},
116	{USB_DEVICE(VENDOR_ID_LONGSHINE, PRODUCT_ID_LCS8138TX)},
117	{USB_DEVICE(VENDOR_ID_OQO, PRODUCT_ID_RTL8150)},
118	{USB_DEVICE(VENDOR_ID_ZYXEL, PRODUCT_ID_PRESTIGE)},
119	{}
120};
121
122MODULE_DEVICE_TABLE(usb, rtl8150_table);
123
124struct rtl8150 {
125	unsigned long flags;
126	struct usb_device *udev;
127	struct tasklet_struct tl;
128	struct net_device *netdev;
129	struct urb *rx_urb, *tx_urb, *intr_urb;
130	struct sk_buff *tx_skb, *rx_skb;
131	struct sk_buff *rx_skb_pool[RX_SKB_POOL_SIZE];
132	spinlock_t rx_pool_lock;
133	struct usb_ctrlrequest dr;
134	int intr_interval;
135	u8 *intr_buff;
136	u8 phy;
137};
138
139typedef struct rtl8150 rtl8150_t;
140
141struct async_req {
142	struct usb_ctrlrequest dr;
143	u16 rx_creg;
144};
145
146static const char driver_name [] = "rtl8150";
147
148/*
149**
150**	device related part of the code
151**
152*/
153static int get_registers(rtl8150_t * dev, u16 indx, u16 size, void *data)
154{
155	void *buf;
156	int ret;
157
158	buf = kmalloc(size, GFP_NOIO);
159	if (!buf)
160		return -ENOMEM;
161
162	ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0),
163			      RTL8150_REQ_GET_REGS, RTL8150_REQT_READ,
164			      indx, 0, buf, size, 500);
165	if (ret > 0 && ret <= size)
166		memcpy(data, buf, ret);
167	kfree(buf);
168	return ret;
169}
170
171static int set_registers(rtl8150_t * dev, u16 indx, u16 size, const void *data)
172{
173	void *buf;
174	int ret;
175
176	buf = kmemdup(data, size, GFP_NOIO);
177	if (!buf)
178		return -ENOMEM;
179
180	ret = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),
181			      RTL8150_REQ_SET_REGS, RTL8150_REQT_WRITE,
182			      indx, 0, buf, size, 500);
183	kfree(buf);
184	return ret;
185}
186
187static void async_set_reg_cb(struct urb *urb)
188{
189	struct async_req *req = (struct async_req *)urb->context;
190	int status = urb->status;
191
192	if (status < 0)
193		dev_dbg(&urb->dev->dev, "%s failed with %d", __func__, status);
194	kfree(req);
195	usb_free_urb(urb);
196}
197
198static int async_set_registers(rtl8150_t *dev, u16 indx, u16 size, u16 reg)
199{
200	int res = -ENOMEM;
201	struct urb *async_urb;
202	struct async_req *req;
203
204	req = kmalloc(sizeof(struct async_req), GFP_ATOMIC);
205	if (req == NULL)
206		return res;
207	async_urb = usb_alloc_urb(0, GFP_ATOMIC);
208	if (async_urb == NULL) {
209		kfree(req);
210		return res;
211	}
212	req->rx_creg = cpu_to_le16(reg);
213	req->dr.bRequestType = RTL8150_REQT_WRITE;
214	req->dr.bRequest = RTL8150_REQ_SET_REGS;
215	req->dr.wIndex = 0;
216	req->dr.wValue = cpu_to_le16(indx);
217	req->dr.wLength = cpu_to_le16(size);
218	usb_fill_control_urb(async_urb, dev->udev,
219	                     usb_sndctrlpipe(dev->udev, 0), (void *)&req->dr,
220			     &req->rx_creg, size, async_set_reg_cb, req);
221	res = usb_submit_urb(async_urb, GFP_ATOMIC);
222	if (res) {
223		if (res == -ENODEV)
224			netif_device_detach(dev->netdev);
225		dev_err(&dev->udev->dev, "%s failed with %d\n", __func__, res);
226	}
227	return res;
228}
229
230static int read_mii_word(rtl8150_t * dev, u8 phy, __u8 indx, u16 * reg)
231{
232	int i;
233	u8 data[3], tmp;
234
235	data[0] = phy;
236	data[1] = data[2] = 0;
237	tmp = indx | PHY_READ | PHY_GO;
238	i = 0;
239
240	set_registers(dev, PHYADD, sizeof(data), data);
241	set_registers(dev, PHYCNT, 1, &tmp);
242	do {
243		get_registers(dev, PHYCNT, 1, data);
244	} while ((data[0] & PHY_GO) && (i++ < MII_TIMEOUT));
245
246	if (i <= MII_TIMEOUT) {
247		get_registers(dev, PHYDAT, 2, data);
248		*reg = data[0] | (data[1] << 8);
249		return 0;
250	} else
251		return 1;
252}
253
254static int write_mii_word(rtl8150_t * dev, u8 phy, __u8 indx, u16 reg)
255{
256	int i;
257	u8 data[3], tmp;
258
259	data[0] = phy;
260	data[1] = reg & 0xff;
261	data[2] = (reg >> 8) & 0xff;
262	tmp = indx | PHY_WRITE | PHY_GO;
263	i = 0;
264
265	set_registers(dev, PHYADD, sizeof(data), data);
266	set_registers(dev, PHYCNT, 1, &tmp);
267	do {
268		get_registers(dev, PHYCNT, 1, data);
269	} while ((data[0] & PHY_GO) && (i++ < MII_TIMEOUT));
270
271	if (i <= MII_TIMEOUT)
272		return 0;
273	else
274		return 1;
275}
276
277static inline void set_ethernet_addr(rtl8150_t * dev)
278{
279	u8 node_id[6];
 
 
 
280
281	get_registers(dev, IDR, sizeof(node_id), node_id);
282	memcpy(dev->netdev->dev_addr, node_id, sizeof(node_id));
 
 
 
 
 
283}
284
285static int rtl8150_set_mac_address(struct net_device *netdev, void *p)
286{
287	struct sockaddr *addr = p;
288	rtl8150_t *dev = netdev_priv(netdev);
289
290	if (netif_running(netdev))
291		return -EBUSY;
292
293	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
294	netdev_dbg(netdev, "Setting MAC address to %pM\n", netdev->dev_addr);
295	/* Set the IDR registers. */
296	set_registers(dev, IDR, netdev->addr_len, netdev->dev_addr);
297#ifdef EEPROM_WRITE
298	{
299	int i;
300	u8 cr;
301	/* Get the CR contents. */
302	get_registers(dev, CR, 1, &cr);
303	/* Set the WEPROM bit (eeprom write enable). */
304	cr |= 0x20;
305	set_registers(dev, CR, 1, &cr);
306	/* Write the MAC address into eeprom. Eeprom writes must be word-sized,
307	   so we need to split them up. */
308	for (i = 0; i * 2 < netdev->addr_len; i++) {
309		set_registers(dev, IDR_EEPROM + (i * 2), 2,
310		netdev->dev_addr + (i * 2));
311	}
312	/* Clear the WEPROM bit (preventing accidental eeprom writes). */
313	cr &= 0xdf;
314	set_registers(dev, CR, 1, &cr);
315	}
316#endif
317	return 0;
318}
319
320static int rtl8150_reset(rtl8150_t * dev)
321{
322	u8 data = 0x10;
323	int i = HZ;
324
325	set_registers(dev, CR, 1, &data);
326	do {
327		get_registers(dev, CR, 1, &data);
328	} while ((data & 0x10) && --i);
329
330	return (i > 0) ? 1 : 0;
331}
332
333static int alloc_all_urbs(rtl8150_t * dev)
334{
335	dev->rx_urb = usb_alloc_urb(0, GFP_KERNEL);
336	if (!dev->rx_urb)
337		return 0;
338	dev->tx_urb = usb_alloc_urb(0, GFP_KERNEL);
339	if (!dev->tx_urb) {
340		usb_free_urb(dev->rx_urb);
341		return 0;
342	}
343	dev->intr_urb = usb_alloc_urb(0, GFP_KERNEL);
344	if (!dev->intr_urb) {
345		usb_free_urb(dev->rx_urb);
346		usb_free_urb(dev->tx_urb);
347		return 0;
348	}
349
350	return 1;
351}
352
353static void free_all_urbs(rtl8150_t * dev)
354{
355	usb_free_urb(dev->rx_urb);
356	usb_free_urb(dev->tx_urb);
357	usb_free_urb(dev->intr_urb);
358}
359
360static void unlink_all_urbs(rtl8150_t * dev)
361{
362	usb_kill_urb(dev->rx_urb);
363	usb_kill_urb(dev->tx_urb);
364	usb_kill_urb(dev->intr_urb);
365}
366
367static inline struct sk_buff *pull_skb(rtl8150_t *dev)
368{
369	struct sk_buff *skb;
370	int i;
371
372	for (i = 0; i < RX_SKB_POOL_SIZE; i++) {
373		if (dev->rx_skb_pool[i]) {
374			skb = dev->rx_skb_pool[i];
375			dev->rx_skb_pool[i] = NULL;
376			return skb;
377		}
378	}
379	return NULL;
380}
381
382static void read_bulk_callback(struct urb *urb)
383{
384	rtl8150_t *dev;
385	unsigned pkt_len, res;
386	struct sk_buff *skb;
387	struct net_device *netdev;
388	int status = urb->status;
389	int result;
390	unsigned long flags;
391
392	dev = urb->context;
393	if (!dev)
394		return;
395	if (test_bit(RTL8150_UNPLUG, &dev->flags))
396		return;
397	netdev = dev->netdev;
398	if (!netif_device_present(netdev))
399		return;
400
401	switch (status) {
402	case 0:
403		break;
404	case -ENOENT:
405		return;	/* the urb is in unlink state */
406	case -ETIME:
407		if (printk_ratelimit())
408			dev_warn(&urb->dev->dev, "may be reset is needed?..\n");
409		goto goon;
410	default:
411		if (printk_ratelimit())
412			dev_warn(&urb->dev->dev, "Rx status %d\n", status);
413		goto goon;
414	}
415
416	if (!dev->rx_skb)
417		goto resched;
418	/* protect against short packets (tell me why we got some?!?) */
419	if (urb->actual_length < 4)
420		goto goon;
421
422	res = urb->actual_length;
423	pkt_len = res - 4;
424
425	skb_put(dev->rx_skb, pkt_len);
426	dev->rx_skb->protocol = eth_type_trans(dev->rx_skb, netdev);
427	netif_rx(dev->rx_skb);
428	netdev->stats.rx_packets++;
429	netdev->stats.rx_bytes += pkt_len;
430
431	spin_lock_irqsave(&dev->rx_pool_lock, flags);
432	skb = pull_skb(dev);
433	spin_unlock_irqrestore(&dev->rx_pool_lock, flags);
434	if (!skb)
435		goto resched;
436
437	dev->rx_skb = skb;
438goon:
439	usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
440		      dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
441	result = usb_submit_urb(dev->rx_urb, GFP_ATOMIC);
442	if (result == -ENODEV)
443		netif_device_detach(dev->netdev);
444	else if (result) {
445		set_bit(RX_URB_FAIL, &dev->flags);
446		goto resched;
447	} else {
448		clear_bit(RX_URB_FAIL, &dev->flags);
449	}
450
451	return;
452resched:
453	tasklet_schedule(&dev->tl);
454}
455
456static void write_bulk_callback(struct urb *urb)
457{
458	rtl8150_t *dev;
459	int status = urb->status;
460
461	dev = urb->context;
462	if (!dev)
463		return;
464	dev_kfree_skb_irq(dev->tx_skb);
465	if (!netif_device_present(dev->netdev))
466		return;
467	if (status)
468		dev_info(&urb->dev->dev, "%s: Tx status %d\n",
469			 dev->netdev->name, status);
470	netif_trans_update(dev->netdev);
471	netif_wake_queue(dev->netdev);
472}
473
474static void intr_callback(struct urb *urb)
475{
476	rtl8150_t *dev;
477	__u8 *d;
478	int status = urb->status;
479	int res;
480
481	dev = urb->context;
482	if (!dev)
483		return;
484	switch (status) {
485	case 0:			/* success */
486		break;
487	case -ECONNRESET:	/* unlink */
488	case -ENOENT:
489	case -ESHUTDOWN:
490		return;
491	/* -EPIPE:  should clear the halt */
492	default:
493		dev_info(&urb->dev->dev, "%s: intr status %d\n",
494			 dev->netdev->name, status);
495		goto resubmit;
496	}
497
498	d = urb->transfer_buffer;
499	if (d[0] & TSR_ERRORS) {
500		dev->netdev->stats.tx_errors++;
501		if (d[INT_TSR] & (TSR_ECOL | TSR_JBR))
502			dev->netdev->stats.tx_aborted_errors++;
503		if (d[INT_TSR] & TSR_LCOL)
504			dev->netdev->stats.tx_window_errors++;
505		if (d[INT_TSR] & TSR_LOSS_CRS)
506			dev->netdev->stats.tx_carrier_errors++;
507	}
508	/* Report link status changes to the network stack */
509	if ((d[INT_MSR] & MSR_LINK) == 0) {
510		if (netif_carrier_ok(dev->netdev)) {
511			netif_carrier_off(dev->netdev);
512			netdev_dbg(dev->netdev, "%s: LINK LOST\n", __func__);
513		}
514	} else {
515		if (!netif_carrier_ok(dev->netdev)) {
516			netif_carrier_on(dev->netdev);
517			netdev_dbg(dev->netdev, "%s: LINK CAME BACK\n", __func__);
518		}
519	}
520
521resubmit:
522	res = usb_submit_urb (urb, GFP_ATOMIC);
523	if (res == -ENODEV)
524		netif_device_detach(dev->netdev);
525	else if (res)
526		dev_err(&dev->udev->dev,
527			"can't resubmit intr, %s-%s/input0, status %d\n",
528			dev->udev->bus->bus_name, dev->udev->devpath, res);
529}
530
531static int rtl8150_suspend(struct usb_interface *intf, pm_message_t message)
532{
533	rtl8150_t *dev = usb_get_intfdata(intf);
534
535	netif_device_detach(dev->netdev);
536
537	if (netif_running(dev->netdev)) {
538		usb_kill_urb(dev->rx_urb);
539		usb_kill_urb(dev->intr_urb);
540	}
541	return 0;
542}
543
544static int rtl8150_resume(struct usb_interface *intf)
545{
546	rtl8150_t *dev = usb_get_intfdata(intf);
547
548	netif_device_attach(dev->netdev);
549	if (netif_running(dev->netdev)) {
550		dev->rx_urb->status = 0;
551		dev->rx_urb->actual_length = 0;
552		read_bulk_callback(dev->rx_urb);
553
554		dev->intr_urb->status = 0;
555		dev->intr_urb->actual_length = 0;
556		intr_callback(dev->intr_urb);
557	}
558	return 0;
559}
560
561/*
562**
563**	network related part of the code
564**
565*/
566
567static void fill_skb_pool(rtl8150_t *dev)
568{
569	struct sk_buff *skb;
570	int i;
571
572	for (i = 0; i < RX_SKB_POOL_SIZE; i++) {
573		if (dev->rx_skb_pool[i])
574			continue;
575		skb = dev_alloc_skb(RTL8150_MTU + 2);
576		if (!skb) {
577			return;
578		}
579		skb_reserve(skb, 2);
580		dev->rx_skb_pool[i] = skb;
581	}
582}
583
584static void free_skb_pool(rtl8150_t *dev)
585{
586	int i;
587
588	for (i = 0; i < RX_SKB_POOL_SIZE; i++)
589		dev_kfree_skb(dev->rx_skb_pool[i]);
590}
591
592static void rx_fixup(unsigned long data)
593{
594	struct rtl8150 *dev = (struct rtl8150 *)data;
595	struct sk_buff *skb;
596	int status;
597
598	spin_lock_irq(&dev->rx_pool_lock);
599	fill_skb_pool(dev);
600	spin_unlock_irq(&dev->rx_pool_lock);
601	if (test_bit(RX_URB_FAIL, &dev->flags))
602		if (dev->rx_skb)
603			goto try_again;
604	spin_lock_irq(&dev->rx_pool_lock);
605	skb = pull_skb(dev);
606	spin_unlock_irq(&dev->rx_pool_lock);
607	if (skb == NULL)
608		goto tlsched;
609	dev->rx_skb = skb;
610	usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
611		      dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
612try_again:
613	status = usb_submit_urb(dev->rx_urb, GFP_ATOMIC);
614	if (status == -ENODEV) {
615		netif_device_detach(dev->netdev);
616	} else if (status) {
617		set_bit(RX_URB_FAIL, &dev->flags);
618		goto tlsched;
619	} else {
620		clear_bit(RX_URB_FAIL, &dev->flags);
621	}
622
623	return;
624tlsched:
625	tasklet_schedule(&dev->tl);
626}
627
628static int enable_net_traffic(rtl8150_t * dev)
629{
630	u8 cr, tcr, rcr, msr;
631
632	if (!rtl8150_reset(dev)) {
633		dev_warn(&dev->udev->dev, "device reset failed\n");
634	}
635	/* RCR bit7=1 attach Rx info at the end;  =0 HW CRC (which is broken) */
636	rcr = 0x9e;
637	tcr = 0xd8;
638	cr = 0x0c;
639	if (!(rcr & 0x80))
640		set_bit(RTL8150_HW_CRC, &dev->flags);
641	set_registers(dev, RCR, 1, &rcr);
642	set_registers(dev, TCR, 1, &tcr);
643	set_registers(dev, CR, 1, &cr);
644	get_registers(dev, MSR, 1, &msr);
645
646	return 0;
647}
648
649static void disable_net_traffic(rtl8150_t * dev)
650{
651	u8 cr;
652
653	get_registers(dev, CR, 1, &cr);
654	cr &= 0xf3;
655	set_registers(dev, CR, 1, &cr);
656}
657
658static void rtl8150_tx_timeout(struct net_device *netdev)
659{
660	rtl8150_t *dev = netdev_priv(netdev);
661	dev_warn(&netdev->dev, "Tx timeout.\n");
662	usb_unlink_urb(dev->tx_urb);
663	netdev->stats.tx_errors++;
664}
665
666static void rtl8150_set_multicast(struct net_device *netdev)
667{
668	rtl8150_t *dev = netdev_priv(netdev);
669	u16 rx_creg = 0x9e;
670
671	netif_stop_queue(netdev);
672	if (netdev->flags & IFF_PROMISC) {
673		rx_creg |= 0x0001;
674		dev_info(&netdev->dev, "%s: promiscuous mode\n", netdev->name);
675	} else if (!netdev_mc_empty(netdev) ||
676		   (netdev->flags & IFF_ALLMULTI)) {
677		rx_creg &= 0xfffe;
678		rx_creg |= 0x0002;
679		dev_dbg(&netdev->dev, "%s: allmulti set\n", netdev->name);
680	} else {
681		/* ~RX_MULTICAST, ~RX_PROMISCUOUS */
682		rx_creg &= 0x00fc;
683	}
684	async_set_registers(dev, RCR, sizeof(rx_creg), rx_creg);
685	netif_wake_queue(netdev);
686}
687
688static netdev_tx_t rtl8150_start_xmit(struct sk_buff *skb,
689					    struct net_device *netdev)
690{
691	rtl8150_t *dev = netdev_priv(netdev);
692	int count, res;
693
694	netif_stop_queue(netdev);
695	count = (skb->len < 60) ? 60 : skb->len;
696	count = (count & 0x3f) ? count : count + 1;
697	dev->tx_skb = skb;
698	usb_fill_bulk_urb(dev->tx_urb, dev->udev, usb_sndbulkpipe(dev->udev, 2),
699		      skb->data, count, write_bulk_callback, dev);
700	if ((res = usb_submit_urb(dev->tx_urb, GFP_ATOMIC))) {
701		/* Can we get/handle EPIPE here? */
702		if (res == -ENODEV)
703			netif_device_detach(dev->netdev);
704		else {
705			dev_warn(&netdev->dev, "failed tx_urb %d\n", res);
706			netdev->stats.tx_errors++;
707			netif_start_queue(netdev);
708		}
709	} else {
710		netdev->stats.tx_packets++;
711		netdev->stats.tx_bytes += skb->len;
712		netif_trans_update(netdev);
713	}
714
715	return NETDEV_TX_OK;
716}
717
718
719static void set_carrier(struct net_device *netdev)
720{
721	rtl8150_t *dev = netdev_priv(netdev);
722	short tmp;
723
724	get_registers(dev, CSCR, 2, &tmp);
725	if (tmp & CSCR_LINK_STATUS)
726		netif_carrier_on(netdev);
727	else
728		netif_carrier_off(netdev);
729}
730
731static int rtl8150_open(struct net_device *netdev)
732{
733	rtl8150_t *dev = netdev_priv(netdev);
734	int res;
735
736	if (dev->rx_skb == NULL)
737		dev->rx_skb = pull_skb(dev);
738	if (!dev->rx_skb)
739		return -ENOMEM;
740
741	set_registers(dev, IDR, 6, netdev->dev_addr);
742
743	usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
744		      dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
745	if ((res = usb_submit_urb(dev->rx_urb, GFP_KERNEL))) {
746		if (res == -ENODEV)
747			netif_device_detach(dev->netdev);
748		dev_warn(&netdev->dev, "rx_urb submit failed: %d\n", res);
749		return res;
750	}
751	usb_fill_int_urb(dev->intr_urb, dev->udev, usb_rcvintpipe(dev->udev, 3),
752		     dev->intr_buff, INTBUFSIZE, intr_callback,
753		     dev, dev->intr_interval);
754	if ((res = usb_submit_urb(dev->intr_urb, GFP_KERNEL))) {
755		if (res == -ENODEV)
756			netif_device_detach(dev->netdev);
757		dev_warn(&netdev->dev, "intr_urb submit failed: %d\n", res);
758		usb_kill_urb(dev->rx_urb);
759		return res;
760	}
761	enable_net_traffic(dev);
762	set_carrier(netdev);
763	netif_start_queue(netdev);
764
765	return res;
766}
767
768static int rtl8150_close(struct net_device *netdev)
769{
770	rtl8150_t *dev = netdev_priv(netdev);
771
772	netif_stop_queue(netdev);
773	if (!test_bit(RTL8150_UNPLUG, &dev->flags))
774		disable_net_traffic(dev);
775	unlink_all_urbs(dev);
776
777	return 0;
778}
779
780static void rtl8150_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *info)
781{
782	rtl8150_t *dev = netdev_priv(netdev);
783
784	strlcpy(info->driver, driver_name, sizeof(info->driver));
785	strlcpy(info->version, DRIVER_VERSION, sizeof(info->version));
786	usb_make_path(dev->udev, info->bus_info, sizeof(info->bus_info));
787}
788
789static int rtl8150_get_link_ksettings(struct net_device *netdev,
790				      struct ethtool_link_ksettings *ecmd)
791{
792	rtl8150_t *dev = netdev_priv(netdev);
793	short lpa, bmcr;
 
794	u32 supported;
795
796	supported = (SUPPORTED_10baseT_Half |
797			  SUPPORTED_10baseT_Full |
798			  SUPPORTED_100baseT_Half |
799			  SUPPORTED_100baseT_Full |
800			  SUPPORTED_Autoneg |
801			  SUPPORTED_TP | SUPPORTED_MII);
802	ecmd->base.port = PORT_TP;
803	ecmd->base.phy_address = dev->phy;
804	get_registers(dev, BMCR, 2, &bmcr);
805	get_registers(dev, ANLP, 2, &lpa);
806	if (bmcr & BMCR_ANENABLE) {
807		u32 speed = ((lpa & (LPA_100HALF | LPA_100FULL)) ?
808			     SPEED_100 : SPEED_10);
809		ecmd->base.speed = speed;
810		ecmd->base.autoneg = AUTONEG_ENABLE;
811		if (speed == SPEED_100)
812			ecmd->base.duplex = (lpa & LPA_100FULL) ?
813			    DUPLEX_FULL : DUPLEX_HALF;
814		else
815			ecmd->base.duplex = (lpa & LPA_10FULL) ?
816			    DUPLEX_FULL : DUPLEX_HALF;
817	} else {
818		ecmd->base.autoneg = AUTONEG_DISABLE;
819		ecmd->base.speed = ((bmcr & BMCR_SPEED100) ?
820					     SPEED_100 : SPEED_10);
821		ecmd->base.duplex = (bmcr & BMCR_FULLDPLX) ?
822		    DUPLEX_FULL : DUPLEX_HALF;
823	}
824
825	ethtool_convert_legacy_u32_to_link_mode(ecmd->link_modes.supported,
826						supported);
827
828	return 0;
829}
830
831static const struct ethtool_ops ops = {
832	.get_drvinfo = rtl8150_get_drvinfo,
833	.get_link = ethtool_op_get_link,
834	.get_link_ksettings = rtl8150_get_link_ksettings,
835};
836
837static int rtl8150_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
 
838{
839	rtl8150_t *dev = netdev_priv(netdev);
840	u16 *data = (u16 *) & rq->ifr_ifru;
841	int res = 0;
842
843	switch (cmd) {
844	case SIOCDEVPRIVATE:
845		data[0] = dev->phy;
846		/* fall through */
847	case SIOCDEVPRIVATE + 1:
848		read_mii_word(dev, dev->phy, (data[1] & 0x1f), &data[3]);
849		break;
850	case SIOCDEVPRIVATE + 2:
851		if (!capable(CAP_NET_ADMIN))
852			return -EPERM;
853		write_mii_word(dev, dev->phy, (data[1] & 0x1f), data[2]);
854		break;
855	default:
856		res = -EOPNOTSUPP;
857	}
858
859	return res;
860}
861
862static const struct net_device_ops rtl8150_netdev_ops = {
863	.ndo_open		= rtl8150_open,
864	.ndo_stop		= rtl8150_close,
865	.ndo_do_ioctl		= rtl8150_ioctl,
866	.ndo_start_xmit		= rtl8150_start_xmit,
867	.ndo_tx_timeout		= rtl8150_tx_timeout,
868	.ndo_set_rx_mode	= rtl8150_set_multicast,
869	.ndo_set_mac_address	= rtl8150_set_mac_address,
870
871	.ndo_validate_addr	= eth_validate_addr,
872};
873
874static int rtl8150_probe(struct usb_interface *intf,
875			 const struct usb_device_id *id)
876{
877	struct usb_device *udev = interface_to_usbdev(intf);
878	rtl8150_t *dev;
879	struct net_device *netdev;
 
 
 
 
 
 
 
880
881	netdev = alloc_etherdev(sizeof(rtl8150_t));
882	if (!netdev)
883		return -ENOMEM;
884
885	dev = netdev_priv(netdev);
886
887	dev->intr_buff = kmalloc(INTBUFSIZE, GFP_KERNEL);
888	if (!dev->intr_buff) {
889		free_netdev(netdev);
890		return -ENOMEM;
891	}
892
893	tasklet_init(&dev->tl, rx_fixup, (unsigned long)dev);
 
 
 
 
 
 
 
894	spin_lock_init(&dev->rx_pool_lock);
895
896	dev->udev = udev;
897	dev->netdev = netdev;
898	netdev->netdev_ops = &rtl8150_netdev_ops;
899	netdev->watchdog_timeo = RTL8150_TX_TIMEOUT;
900	netdev->ethtool_ops = &ops;
901	dev->intr_interval = 100;	/* 100ms */
902
903	if (!alloc_all_urbs(dev)) {
904		dev_err(&intf->dev, "out of memory\n");
905		goto out;
906	}
907	if (!rtl8150_reset(dev)) {
908		dev_err(&intf->dev, "couldn't reset the device\n");
909		goto out1;
910	}
911	fill_skb_pool(dev);
912	set_ethernet_addr(dev);
913
914	usb_set_intfdata(intf, dev);
915	SET_NETDEV_DEV(netdev, &intf->dev);
916	if (register_netdev(netdev) != 0) {
917		dev_err(&intf->dev, "couldn't register the device\n");
918		goto out2;
919	}
920
921	dev_info(&intf->dev, "%s: rtl8150 is detected\n", netdev->name);
922
923	return 0;
924
925out2:
926	usb_set_intfdata(intf, NULL);
927	free_skb_pool(dev);
928out1:
929	free_all_urbs(dev);
930out:
931	kfree(dev->intr_buff);
932	free_netdev(netdev);
933	return -EIO;
934}
935
936static void rtl8150_disconnect(struct usb_interface *intf)
937{
938	rtl8150_t *dev = usb_get_intfdata(intf);
939
940	usb_set_intfdata(intf, NULL);
941	if (dev) {
942		set_bit(RTL8150_UNPLUG, &dev->flags);
943		tasklet_kill(&dev->tl);
944		unregister_netdev(dev->netdev);
945		unlink_all_urbs(dev);
946		free_all_urbs(dev);
947		free_skb_pool(dev);
948		dev_kfree_skb(dev->rx_skb);
949		kfree(dev->intr_buff);
950		free_netdev(dev->netdev);
951	}
952}
953
954static struct usb_driver rtl8150_driver = {
955	.name		= driver_name,
956	.probe		= rtl8150_probe,
957	.disconnect	= rtl8150_disconnect,
958	.id_table	= rtl8150_table,
959	.suspend	= rtl8150_suspend,
960	.resume		= rtl8150_resume,
961	.disable_hub_initiated_lpm = 1,
962};
963
964module_usb_driver(rtl8150_driver);
965
966MODULE_AUTHOR(DRIVER_AUTHOR);
967MODULE_DESCRIPTION(DRIVER_DESC);
968MODULE_LICENSE("GPL");