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.9
  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 void set_ethernet_addr(rtl8150_t *dev)
278{
279	u8 node_id[ETH_ALEN];
280	int ret;
281
282	ret = get_registers(dev, IDR, sizeof(node_id), node_id);
283
284	if (ret == sizeof(node_id)) {
285		ether_addr_copy(dev->netdev->dev_addr, node_id);
286	} else {
287		eth_hw_addr_random(dev->netdev);
288		netdev_notice(dev->netdev, "Assigned a random MAC address: %pM\n",
289			      dev->netdev->dev_addr);
290	}
291}
292
293static int rtl8150_set_mac_address(struct net_device *netdev, void *p)
294{
295	struct sockaddr *addr = p;
296	rtl8150_t *dev = netdev_priv(netdev);
297
298	if (netif_running(netdev))
299		return -EBUSY;
300
301	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
302	netdev_dbg(netdev, "Setting MAC address to %pM\n", netdev->dev_addr);
303	/* Set the IDR registers. */
304	set_registers(dev, IDR, netdev->addr_len, netdev->dev_addr);
305#ifdef EEPROM_WRITE
306	{
307	int i;
308	u8 cr;
309	/* Get the CR contents. */
310	get_registers(dev, CR, 1, &cr);
311	/* Set the WEPROM bit (eeprom write enable). */
312	cr |= 0x20;
313	set_registers(dev, CR, 1, &cr);
314	/* Write the MAC address into eeprom. Eeprom writes must be word-sized,
315	   so we need to split them up. */
316	for (i = 0; i * 2 < netdev->addr_len; i++) {
317		set_registers(dev, IDR_EEPROM + (i * 2), 2,
318		netdev->dev_addr + (i * 2));
319	}
320	/* Clear the WEPROM bit (preventing accidental eeprom writes). */
321	cr &= 0xdf;
322	set_registers(dev, CR, 1, &cr);
323	}
324#endif
325	return 0;
326}
327
328static int rtl8150_reset(rtl8150_t * dev)
329{
330	u8 data = 0x10;
331	int i = HZ;
332
333	set_registers(dev, CR, 1, &data);
334	do {
335		get_registers(dev, CR, 1, &data);
336	} while ((data & 0x10) && --i);
337
338	return (i > 0) ? 1 : 0;
339}
340
341static int alloc_all_urbs(rtl8150_t * dev)
342{
343	dev->rx_urb = usb_alloc_urb(0, GFP_KERNEL);
344	if (!dev->rx_urb)
345		return 0;
346	dev->tx_urb = usb_alloc_urb(0, GFP_KERNEL);
347	if (!dev->tx_urb) {
348		usb_free_urb(dev->rx_urb);
349		return 0;
350	}
351	dev->intr_urb = usb_alloc_urb(0, GFP_KERNEL);
352	if (!dev->intr_urb) {
353		usb_free_urb(dev->rx_urb);
354		usb_free_urb(dev->tx_urb);
355		return 0;
356	}
357
358	return 1;
359}
360
361static void free_all_urbs(rtl8150_t * dev)
362{
363	usb_free_urb(dev->rx_urb);
364	usb_free_urb(dev->tx_urb);
365	usb_free_urb(dev->intr_urb);
366}
367
368static void unlink_all_urbs(rtl8150_t * dev)
369{
370	usb_kill_urb(dev->rx_urb);
371	usb_kill_urb(dev->tx_urb);
372	usb_kill_urb(dev->intr_urb);
373}
374
375static inline struct sk_buff *pull_skb(rtl8150_t *dev)
376{
377	struct sk_buff *skb;
378	int i;
379
380	for (i = 0; i < RX_SKB_POOL_SIZE; i++) {
381		if (dev->rx_skb_pool[i]) {
382			skb = dev->rx_skb_pool[i];
383			dev->rx_skb_pool[i] = NULL;
384			return skb;
385		}
386	}
387	return NULL;
388}
389
390static void read_bulk_callback(struct urb *urb)
391{
392	rtl8150_t *dev;
393	unsigned pkt_len, res;
394	struct sk_buff *skb;
395	struct net_device *netdev;
396	int status = urb->status;
397	int result;
398	unsigned long flags;
399
400	dev = urb->context;
401	if (!dev)
402		return;
403	if (test_bit(RTL8150_UNPLUG, &dev->flags))
404		return;
405	netdev = dev->netdev;
406	if (!netif_device_present(netdev))
407		return;
408
409	switch (status) {
410	case 0:
411		break;
412	case -ENOENT:
413		return;	/* the urb is in unlink state */
414	case -ETIME:
415		if (printk_ratelimit())
416			dev_warn(&urb->dev->dev, "may be reset is needed?..\n");
417		goto goon;
418	default:
419		if (printk_ratelimit())
420			dev_warn(&urb->dev->dev, "Rx status %d\n", status);
421		goto goon;
422	}
423
424	if (!dev->rx_skb)
425		goto resched;
426	/* protect against short packets (tell me why we got some?!?) */
427	if (urb->actual_length < 4)
428		goto goon;
429
430	res = urb->actual_length;
431	pkt_len = res - 4;
432
433	skb_put(dev->rx_skb, pkt_len);
434	dev->rx_skb->protocol = eth_type_trans(dev->rx_skb, netdev);
435	netif_rx(dev->rx_skb);
436	netdev->stats.rx_packets++;
437	netdev->stats.rx_bytes += pkt_len;
438
439	spin_lock_irqsave(&dev->rx_pool_lock, flags);
440	skb = pull_skb(dev);
441	spin_unlock_irqrestore(&dev->rx_pool_lock, flags);
442	if (!skb)
443		goto resched;
444
445	dev->rx_skb = skb;
446goon:
447	usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
448		      dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
449	result = usb_submit_urb(dev->rx_urb, GFP_ATOMIC);
450	if (result == -ENODEV)
451		netif_device_detach(dev->netdev);
452	else if (result) {
453		set_bit(RX_URB_FAIL, &dev->flags);
454		goto resched;
455	} else {
456		clear_bit(RX_URB_FAIL, &dev->flags);
457	}
458
459	return;
460resched:
461	tasklet_schedule(&dev->tl);
462}
463
464static void write_bulk_callback(struct urb *urb)
465{
466	rtl8150_t *dev;
467	int status = urb->status;
468
469	dev = urb->context;
470	if (!dev)
471		return;
472	dev_kfree_skb_irq(dev->tx_skb);
473	if (!netif_device_present(dev->netdev))
474		return;
475	if (status)
476		dev_info(&urb->dev->dev, "%s: Tx status %d\n",
477			 dev->netdev->name, status);
478	netif_trans_update(dev->netdev);
479	netif_wake_queue(dev->netdev);
480}
481
482static void intr_callback(struct urb *urb)
483{
484	rtl8150_t *dev;
485	__u8 *d;
486	int status = urb->status;
487	int res;
488
489	dev = urb->context;
490	if (!dev)
491		return;
492	switch (status) {
493	case 0:			/* success */
494		break;
495	case -ECONNRESET:	/* unlink */
496	case -ENOENT:
497	case -ESHUTDOWN:
498		return;
499	/* -EPIPE:  should clear the halt */
500	default:
501		dev_info(&urb->dev->dev, "%s: intr status %d\n",
502			 dev->netdev->name, status);
503		goto resubmit;
504	}
505
506	d = urb->transfer_buffer;
507	if (d[0] & TSR_ERRORS) {
508		dev->netdev->stats.tx_errors++;
509		if (d[INT_TSR] & (TSR_ECOL | TSR_JBR))
510			dev->netdev->stats.tx_aborted_errors++;
511		if (d[INT_TSR] & TSR_LCOL)
512			dev->netdev->stats.tx_window_errors++;
513		if (d[INT_TSR] & TSR_LOSS_CRS)
514			dev->netdev->stats.tx_carrier_errors++;
515	}
516	/* Report link status changes to the network stack */
517	if ((d[INT_MSR] & MSR_LINK) == 0) {
518		if (netif_carrier_ok(dev->netdev)) {
519			netif_carrier_off(dev->netdev);
520			netdev_dbg(dev->netdev, "%s: LINK LOST\n", __func__);
521		}
522	} else {
523		if (!netif_carrier_ok(dev->netdev)) {
524			netif_carrier_on(dev->netdev);
525			netdev_dbg(dev->netdev, "%s: LINK CAME BACK\n", __func__);
526		}
527	}
528
529resubmit:
530	res = usb_submit_urb (urb, GFP_ATOMIC);
531	if (res == -ENODEV)
532		netif_device_detach(dev->netdev);
533	else if (res)
534		dev_err(&dev->udev->dev,
535			"can't resubmit intr, %s-%s/input0, status %d\n",
536			dev->udev->bus->bus_name, dev->udev->devpath, res);
537}
538
539static int rtl8150_suspend(struct usb_interface *intf, pm_message_t message)
540{
541	rtl8150_t *dev = usb_get_intfdata(intf);
542
543	netif_device_detach(dev->netdev);
544
545	if (netif_running(dev->netdev)) {
546		usb_kill_urb(dev->rx_urb);
547		usb_kill_urb(dev->intr_urb);
548	}
549	return 0;
550}
551
552static int rtl8150_resume(struct usb_interface *intf)
553{
554	rtl8150_t *dev = usb_get_intfdata(intf);
555
556	netif_device_attach(dev->netdev);
557	if (netif_running(dev->netdev)) {
558		dev->rx_urb->status = 0;
559		dev->rx_urb->actual_length = 0;
560		read_bulk_callback(dev->rx_urb);
561
562		dev->intr_urb->status = 0;
563		dev->intr_urb->actual_length = 0;
564		intr_callback(dev->intr_urb);
565	}
566	return 0;
567}
568
569/*
570**
571**	network related part of the code
572**
573*/
574
575static void fill_skb_pool(rtl8150_t *dev)
576{
577	struct sk_buff *skb;
578	int i;
579
580	for (i = 0; i < RX_SKB_POOL_SIZE; i++) {
581		if (dev->rx_skb_pool[i])
582			continue;
583		skb = dev_alloc_skb(RTL8150_MTU + 2);
584		if (!skb) {
585			return;
586		}
587		skb_reserve(skb, 2);
588		dev->rx_skb_pool[i] = skb;
589	}
590}
591
592static void free_skb_pool(rtl8150_t *dev)
593{
594	int i;
595
596	for (i = 0; i < RX_SKB_POOL_SIZE; i++)
597		dev_kfree_skb(dev->rx_skb_pool[i]);
598}
599
600static void rx_fixup(unsigned long data)
601{
602	struct rtl8150 *dev = (struct rtl8150 *)data;
603	struct sk_buff *skb;
604	int status;
605
606	spin_lock_irq(&dev->rx_pool_lock);
607	fill_skb_pool(dev);
608	spin_unlock_irq(&dev->rx_pool_lock);
609	if (test_bit(RX_URB_FAIL, &dev->flags))
610		if (dev->rx_skb)
611			goto try_again;
612	spin_lock_irq(&dev->rx_pool_lock);
613	skb = pull_skb(dev);
614	spin_unlock_irq(&dev->rx_pool_lock);
615	if (skb == NULL)
616		goto tlsched;
617	dev->rx_skb = skb;
618	usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
619		      dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
620try_again:
621	status = usb_submit_urb(dev->rx_urb, GFP_ATOMIC);
622	if (status == -ENODEV) {
623		netif_device_detach(dev->netdev);
624	} else if (status) {
625		set_bit(RX_URB_FAIL, &dev->flags);
626		goto tlsched;
627	} else {
628		clear_bit(RX_URB_FAIL, &dev->flags);
629	}
630
631	return;
632tlsched:
633	tasklet_schedule(&dev->tl);
634}
635
636static int enable_net_traffic(rtl8150_t * dev)
637{
638	u8 cr, tcr, rcr, msr;
639
640	if (!rtl8150_reset(dev)) {
641		dev_warn(&dev->udev->dev, "device reset failed\n");
642	}
643	/* RCR bit7=1 attach Rx info at the end;  =0 HW CRC (which is broken) */
644	rcr = 0x9e;
645	tcr = 0xd8;
646	cr = 0x0c;
647	if (!(rcr & 0x80))
648		set_bit(RTL8150_HW_CRC, &dev->flags);
649	set_registers(dev, RCR, 1, &rcr);
650	set_registers(dev, TCR, 1, &tcr);
651	set_registers(dev, CR, 1, &cr);
652	get_registers(dev, MSR, 1, &msr);
653
654	return 0;
655}
656
657static void disable_net_traffic(rtl8150_t * dev)
658{
659	u8 cr;
660
661	get_registers(dev, CR, 1, &cr);
662	cr &= 0xf3;
663	set_registers(dev, CR, 1, &cr);
664}
665
666static void rtl8150_tx_timeout(struct net_device *netdev, unsigned int txqueue)
667{
668	rtl8150_t *dev = netdev_priv(netdev);
669	dev_warn(&netdev->dev, "Tx timeout.\n");
670	usb_unlink_urb(dev->tx_urb);
671	netdev->stats.tx_errors++;
672}
673
674static void rtl8150_set_multicast(struct net_device *netdev)
675{
676	rtl8150_t *dev = netdev_priv(netdev);
677	u16 rx_creg = 0x9e;
678
679	netif_stop_queue(netdev);
680	if (netdev->flags & IFF_PROMISC) {
681		rx_creg |= 0x0001;
682		dev_info(&netdev->dev, "%s: promiscuous mode\n", netdev->name);
683	} else if (!netdev_mc_empty(netdev) ||
684		   (netdev->flags & IFF_ALLMULTI)) {
685		rx_creg &= 0xfffe;
686		rx_creg |= 0x0002;
687		dev_dbg(&netdev->dev, "%s: allmulti set\n", netdev->name);
688	} else {
689		/* ~RX_MULTICAST, ~RX_PROMISCUOUS */
690		rx_creg &= 0x00fc;
691	}
692	async_set_registers(dev, RCR, sizeof(rx_creg), rx_creg);
693	netif_wake_queue(netdev);
694}
695
696static netdev_tx_t rtl8150_start_xmit(struct sk_buff *skb,
697					    struct net_device *netdev)
698{
699	rtl8150_t *dev = netdev_priv(netdev);
700	int count, res;
701
702	netif_stop_queue(netdev);
703	count = (skb->len < 60) ? 60 : skb->len;
704	count = (count & 0x3f) ? count : count + 1;
705	dev->tx_skb = skb;
706	usb_fill_bulk_urb(dev->tx_urb, dev->udev, usb_sndbulkpipe(dev->udev, 2),
707		      skb->data, count, write_bulk_callback, dev);
708	if ((res = usb_submit_urb(dev->tx_urb, GFP_ATOMIC))) {
709		/* Can we get/handle EPIPE here? */
710		if (res == -ENODEV)
711			netif_device_detach(dev->netdev);
712		else {
713			dev_warn(&netdev->dev, "failed tx_urb %d\n", res);
714			netdev->stats.tx_errors++;
715			netif_start_queue(netdev);
716		}
717	} else {
718		netdev->stats.tx_packets++;
719		netdev->stats.tx_bytes += skb->len;
720		netif_trans_update(netdev);
721	}
722
723	return NETDEV_TX_OK;
724}
725
726
727static void set_carrier(struct net_device *netdev)
728{
729	rtl8150_t *dev = netdev_priv(netdev);
730	short tmp;
731
732	get_registers(dev, CSCR, 2, &tmp);
733	if (tmp & CSCR_LINK_STATUS)
734		netif_carrier_on(netdev);
735	else
736		netif_carrier_off(netdev);
737}
738
739static int rtl8150_open(struct net_device *netdev)
740{
741	rtl8150_t *dev = netdev_priv(netdev);
742	int res;
743
744	if (dev->rx_skb == NULL)
745		dev->rx_skb = pull_skb(dev);
746	if (!dev->rx_skb)
747		return -ENOMEM;
748
749	set_registers(dev, IDR, 6, netdev->dev_addr);
750
751	usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
752		      dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
753	if ((res = usb_submit_urb(dev->rx_urb, GFP_KERNEL))) {
754		if (res == -ENODEV)
755			netif_device_detach(dev->netdev);
756		dev_warn(&netdev->dev, "rx_urb submit failed: %d\n", res);
757		return res;
758	}
759	usb_fill_int_urb(dev->intr_urb, dev->udev, usb_rcvintpipe(dev->udev, 3),
760		     dev->intr_buff, INTBUFSIZE, intr_callback,
761		     dev, dev->intr_interval);
762	if ((res = usb_submit_urb(dev->intr_urb, GFP_KERNEL))) {
763		if (res == -ENODEV)
764			netif_device_detach(dev->netdev);
765		dev_warn(&netdev->dev, "intr_urb submit failed: %d\n", res);
766		usb_kill_urb(dev->rx_urb);
767		return res;
768	}
769	enable_net_traffic(dev);
770	set_carrier(netdev);
771	netif_start_queue(netdev);
772
773	return res;
774}
775
776static int rtl8150_close(struct net_device *netdev)
777{
778	rtl8150_t *dev = netdev_priv(netdev);
779
780	netif_stop_queue(netdev);
781	if (!test_bit(RTL8150_UNPLUG, &dev->flags))
782		disable_net_traffic(dev);
783	unlink_all_urbs(dev);
784
785	return 0;
786}
787
788static void rtl8150_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *info)
789{
790	rtl8150_t *dev = netdev_priv(netdev);
791
792	strlcpy(info->driver, driver_name, sizeof(info->driver));
793	strlcpy(info->version, DRIVER_VERSION, sizeof(info->version));
794	usb_make_path(dev->udev, info->bus_info, sizeof(info->bus_info));
795}
796
797static int rtl8150_get_link_ksettings(struct net_device *netdev,
798				      struct ethtool_link_ksettings *ecmd)
799{
800	rtl8150_t *dev = netdev_priv(netdev);
801	short lpa, bmcr;
 
802	u32 supported;
803
804	supported = (SUPPORTED_10baseT_Half |
805			  SUPPORTED_10baseT_Full |
806			  SUPPORTED_100baseT_Half |
807			  SUPPORTED_100baseT_Full |
808			  SUPPORTED_Autoneg |
809			  SUPPORTED_TP | SUPPORTED_MII);
810	ecmd->base.port = PORT_TP;
811	ecmd->base.phy_address = dev->phy;
812	get_registers(dev, BMCR, 2, &bmcr);
813	get_registers(dev, ANLP, 2, &lpa);
814	if (bmcr & BMCR_ANENABLE) {
815		u32 speed = ((lpa & (LPA_100HALF | LPA_100FULL)) ?
816			     SPEED_100 : SPEED_10);
817		ecmd->base.speed = speed;
818		ecmd->base.autoneg = AUTONEG_ENABLE;
819		if (speed == SPEED_100)
820			ecmd->base.duplex = (lpa & LPA_100FULL) ?
821			    DUPLEX_FULL : DUPLEX_HALF;
822		else
823			ecmd->base.duplex = (lpa & LPA_10FULL) ?
824			    DUPLEX_FULL : DUPLEX_HALF;
825	} else {
826		ecmd->base.autoneg = AUTONEG_DISABLE;
827		ecmd->base.speed = ((bmcr & BMCR_SPEED100) ?
828					     SPEED_100 : SPEED_10);
829		ecmd->base.duplex = (bmcr & BMCR_FULLDPLX) ?
830		    DUPLEX_FULL : DUPLEX_HALF;
831	}
832
833	ethtool_convert_legacy_u32_to_link_mode(ecmd->link_modes.supported,
834						supported);
835
836	return 0;
837}
838
839static const struct ethtool_ops ops = {
840	.get_drvinfo = rtl8150_get_drvinfo,
841	.get_link = ethtool_op_get_link,
842	.get_link_ksettings = rtl8150_get_link_ksettings,
843};
844
845static int rtl8150_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
 
846{
847	rtl8150_t *dev = netdev_priv(netdev);
848	u16 *data = (u16 *) & rq->ifr_ifru;
849	int res = 0;
850
851	switch (cmd) {
852	case SIOCDEVPRIVATE:
853		data[0] = dev->phy;
854		fallthrough;
855	case SIOCDEVPRIVATE + 1:
856		read_mii_word(dev, dev->phy, (data[1] & 0x1f), &data[3]);
857		break;
858	case SIOCDEVPRIVATE + 2:
859		if (!capable(CAP_NET_ADMIN))
860			return -EPERM;
861		write_mii_word(dev, dev->phy, (data[1] & 0x1f), data[2]);
862		break;
863	default:
864		res = -EOPNOTSUPP;
865	}
866
867	return res;
868}
869
870static const struct net_device_ops rtl8150_netdev_ops = {
871	.ndo_open		= rtl8150_open,
872	.ndo_stop		= rtl8150_close,
873	.ndo_do_ioctl		= rtl8150_ioctl,
874	.ndo_start_xmit		= rtl8150_start_xmit,
875	.ndo_tx_timeout		= rtl8150_tx_timeout,
876	.ndo_set_rx_mode	= rtl8150_set_multicast,
877	.ndo_set_mac_address	= rtl8150_set_mac_address,
878
879	.ndo_validate_addr	= eth_validate_addr,
880};
881
882static int rtl8150_probe(struct usb_interface *intf,
883			 const struct usb_device_id *id)
884{
885	struct usb_device *udev = interface_to_usbdev(intf);
886	rtl8150_t *dev;
887	struct net_device *netdev;
 
 
 
 
 
 
 
888
889	netdev = alloc_etherdev(sizeof(rtl8150_t));
890	if (!netdev)
891		return -ENOMEM;
892
893	dev = netdev_priv(netdev);
894
895	dev->intr_buff = kmalloc(INTBUFSIZE, GFP_KERNEL);
896	if (!dev->intr_buff) {
897		free_netdev(netdev);
898		return -ENOMEM;
899	}
900
901	tasklet_init(&dev->tl, rx_fixup, (unsigned long)dev);
 
 
 
 
 
 
 
902	spin_lock_init(&dev->rx_pool_lock);
903
904	dev->udev = udev;
905	dev->netdev = netdev;
906	netdev->netdev_ops = &rtl8150_netdev_ops;
907	netdev->watchdog_timeo = RTL8150_TX_TIMEOUT;
908	netdev->ethtool_ops = &ops;
909	dev->intr_interval = 100;	/* 100ms */
910
911	if (!alloc_all_urbs(dev)) {
912		dev_err(&intf->dev, "out of memory\n");
913		goto out;
914	}
915	if (!rtl8150_reset(dev)) {
916		dev_err(&intf->dev, "couldn't reset the device\n");
917		goto out1;
918	}
919	fill_skb_pool(dev);
920	set_ethernet_addr(dev);
921
922	usb_set_intfdata(intf, dev);
923	SET_NETDEV_DEV(netdev, &intf->dev);
924	if (register_netdev(netdev) != 0) {
925		dev_err(&intf->dev, "couldn't register the device\n");
926		goto out2;
927	}
928
929	dev_info(&intf->dev, "%s: rtl8150 is detected\n", netdev->name);
930
931	return 0;
932
933out2:
934	usb_set_intfdata(intf, NULL);
935	free_skb_pool(dev);
936out1:
937	free_all_urbs(dev);
938out:
939	kfree(dev->intr_buff);
940	free_netdev(netdev);
941	return -EIO;
942}
943
944static void rtl8150_disconnect(struct usb_interface *intf)
945{
946	rtl8150_t *dev = usb_get_intfdata(intf);
947
948	usb_set_intfdata(intf, NULL);
949	if (dev) {
950		set_bit(RTL8150_UNPLUG, &dev->flags);
951		tasklet_kill(&dev->tl);
952		unregister_netdev(dev->netdev);
953		unlink_all_urbs(dev);
954		free_all_urbs(dev);
955		free_skb_pool(dev);
956		dev_kfree_skb(dev->rx_skb);
957		kfree(dev->intr_buff);
958		free_netdev(dev->netdev);
959	}
960}
961
962static struct usb_driver rtl8150_driver = {
963	.name		= driver_name,
964	.probe		= rtl8150_probe,
965	.disconnect	= rtl8150_disconnect,
966	.id_table	= rtl8150_table,
967	.suspend	= rtl8150_suspend,
968	.resume		= rtl8150_resume,
969	.disable_hub_initiated_lpm = 1,
970};
971
972module_usb_driver(rtl8150_driver);
973
974MODULE_AUTHOR(DRIVER_AUTHOR);
975MODULE_DESCRIPTION(DRIVER_DESC);
976MODULE_LICENSE("GPL");