| 1 |
/* |
| 2 |
* USB 10M/100M ethernet adapter |
| 3 |
* |
| 4 |
* This file is licensed under the terms of the GNU General Public License |
| 5 |
* version 2. This program is licensed "as is" without any warranty of any |
| 6 |
* kind, whether express or implied |
| 7 |
* |
| 8 |
*/ |
| 9 |
|
| 10 |
#include <linux/kernel.h> |
| 11 |
#include <linux/module.h> |
| 12 |
#include <linux/sched.h> |
| 13 |
#include <linux/stddef.h> |
| 14 |
#include <linux/init.h> |
| 15 |
#include <linux/netdevice.h> |
| 16 |
#include <linux/etherdevice.h> |
| 17 |
#include <linux/ethtool.h> |
| 18 |
#include <linux/mii.h> |
| 19 |
#include <linux/usb.h> |
| 20 |
#include <linux/crc32.h> |
| 21 |
#include <linux/usb/usbnet.h> |
| 22 |
#include <linux/slab.h> |
| 23 |
|
| 24 |
#define CH9200_VID 0x1A86 |
| 25 |
#define CH9200_PID_E092 0xE092 |
| 26 |
|
| 27 |
#define CTRL_TIMEOUT_MS 1000 |
| 28 |
|
| 29 |
#define CONTROL_TIMEOUT_MS 1000 |
| 30 |
|
| 31 |
#define REQUEST_READ 0x0E |
| 32 |
#define REQUEST_WRITE 0x0F |
| 33 |
|
| 34 |
/* Address space: |
| 35 |
* 00-63 : MII |
| 36 |
* 64-128: MAC |
| 37 |
* |
| 38 |
* Note: all accesses must be 16-bit |
| 39 |
*/ |
| 40 |
|
| 41 |
#define MAC_REG_CTRL 64 |
| 42 |
#define MAC_REG_STATUS 66 |
| 43 |
#define MAC_REG_INTERRUPT_MASK 68 |
| 44 |
#define MAC_REG_PHY_COMMAND 70 |
| 45 |
#define MAC_REG_PHY_DATA 72 |
| 46 |
#define MAC_REG_STATION_L 74 |
| 47 |
#define MAC_REG_STATION_M 76 |
| 48 |
#define MAC_REG_STATION_H 78 |
| 49 |
#define MAC_REG_HASH_L 80 |
| 50 |
#define MAC_REG_HASH_M1 82 |
| 51 |
#define MAC_REG_HASH_M2 84 |
| 52 |
#define MAC_REG_HASH_H 86 |
| 53 |
#define MAC_REG_THRESHOLD 88 |
| 54 |
#define MAC_REG_FIFO_DEPTH 90 |
| 55 |
#define MAC_REG_PAUSE 92 |
| 56 |
#define MAC_REG_FLOW_CONTROL 94 |
| 57 |
|
| 58 |
/* Control register bits |
| 59 |
* |
| 60 |
* Note: bits 13 and 15 are reserved |
| 61 |
*/ |
| 62 |
#define LOOPBACK (0x01 << 14) |
| 63 |
#define BASE100X (0x01 << 12) |
| 64 |
#define MBPS_10 (0x01 << 11) |
| 65 |
#define DUPLEX_MODE (0x01 << 10) |
| 66 |
#define PAUSE_FRAME (0x01 << 9) |
| 67 |
#define PROMISCUOUS (0x01 << 8) |
| 68 |
#define MULTICAST (0x01 << 7) |
| 69 |
#define BROADCAST (0x01 << 6) |
| 70 |
#define HASH (0x01 << 5) |
| 71 |
#define APPEND_PAD (0x01 << 4) |
| 72 |
#define APPEND_CRC (0x01 << 3) |
| 73 |
#define TRANSMITTER_ACTION (0x01 << 2) |
| 74 |
#define RECEIVER_ACTION (0x01 << 1) |
| 75 |
#define DMA_ACTION (0x01 << 0) |
| 76 |
|
| 77 |
/* Status register bits |
| 78 |
* |
| 79 |
* Note: bits 7-15 are reserved |
| 80 |
*/ |
| 81 |
#define ALIGNMENT (0x01 << 6) |
| 82 |
#define FIFO_OVER_RUN (0x01 << 5) |
| 83 |
#define FIFO_UNDER_RUN (0x01 << 4) |
| 84 |
#define RX_ERROR (0x01 << 3) |
| 85 |
#define RX_COMPLETE (0x01 << 2) |
| 86 |
#define TX_ERROR (0x01 << 1) |
| 87 |
#define TX_COMPLETE (0x01 << 0) |
| 88 |
|
| 89 |
/* FIFO depth register bits |
| 90 |
* |
| 91 |
* Note: bits 6 and 14 are reserved |
| 92 |
*/ |
| 93 |
|
| 94 |
#define ETH_TXBD (0x01 << 15) |
| 95 |
#define ETN_TX_FIFO_DEPTH (0x01 << 8) |
| 96 |
#define ETH_RXBD (0x01 << 7) |
| 97 |
#define ETH_RX_FIFO_DEPTH (0x01 << 0) |
| 98 |
|
| 99 |
static int control_read(struct usbnet *dev, |
| 100 |
unsigned char request, unsigned short value, |
| 101 |
unsigned short index, void *data, unsigned short size, |
| 102 |
int timeout) |
| 103 |
{ |
| 104 |
unsigned char *buf = NULL; |
| 105 |
unsigned char request_type; |
| 106 |
int err = 0; |
| 107 |
|
| 108 |
if (request == REQUEST_READ) |
| 109 |
request_type = (USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_OTHER); |
| 110 |
else |
| 111 |
request_type = (USB_DIR_IN | USB_TYPE_VENDOR | |
| 112 |
USB_RECIP_DEVICE); |
| 113 |
|
| 114 |
netdev_dbg(dev->net, "%s() index=0x%02x size=%d\n", |
| 115 |
__func__, index, size); |
| 116 |
|
| 117 |
buf = kmalloc(size, GFP_KERNEL); |
| 118 |
if (!buf) { |
| 119 |
err = -ENOMEM; |
| 120 |
goto err_out; |
| 121 |
} |
| 122 |
|
| 123 |
err = usb_control_msg(dev->udev, |
| 124 |
usb_rcvctrlpipe(dev->udev, 0), |
| 125 |
request, request_type, value, index, buf, size, |
| 126 |
timeout); |
| 127 |
if (err == size) |
| 128 |
memcpy(data, buf, size); |
| 129 |
else if (err >= 0) |
| 130 |
err = -EINVAL; |
| 131 |
kfree(buf); |
| 132 |
|
| 133 |
err_out: |
| 134 |
return err; |
| 135 |
} |
| 136 |
|
| 137 |
static int control_write(struct usbnet *dev, unsigned char request, |
| 138 |
unsigned short value, unsigned short index, |
| 139 |
void *data, unsigned short size, int timeout) |
| 140 |
{ |
| 141 |
unsigned char *buf = NULL; |
| 142 |
unsigned char request_type; |
| 143 |
int err = 0; |
| 144 |
|
| 145 |
if (request == REQUEST_WRITE) |
| 146 |
request_type = (USB_DIR_OUT | USB_TYPE_VENDOR | |
| 147 |
USB_RECIP_OTHER); |
| 148 |
else |
| 149 |
request_type = (USB_DIR_OUT | USB_TYPE_VENDOR | |
| 150 |
USB_RECIP_DEVICE); |
| 151 |
|
| 152 |
netdev_dbg(dev->net, "%s() index=0x%02x size=%d\n", |
| 153 |
__func__, index, size); |
| 154 |
|
| 155 |
if (data) { |
| 156 |
buf = kmemdup(data, size, GFP_KERNEL); |
| 157 |
if (!buf) { |
| 158 |
err = -ENOMEM; |
| 159 |
goto err_out; |
| 160 |
} |
| 161 |
} |
| 162 |
|
| 163 |
err = usb_control_msg(dev->udev, |
| 164 |
usb_sndctrlpipe(dev->udev, 0), |
| 165 |
request, request_type, value, index, buf, size, |
| 166 |
timeout); |
| 167 |
if (err >= 0 && err < size) |
| 168 |
err = -EINVAL; |
| 169 |
kfree(buf); |
| 170 |
|
| 171 |
return 0; |
| 172 |
|
| 173 |
err_out: |
| 174 |
return err; |
| 175 |
} |
| 176 |
|
| 177 |
static int ch9200_mdio_read(struct net_device *netdev, int phy_id, int loc) |
| 178 |
{ |
| 179 |
struct usbnet *dev = netdev_priv(netdev); |
| 180 |
unsigned char buff[2]; |
| 181 |
int ret; |
| 182 |
|
| 183 |
netdev_dbg(netdev, "%s phy_id:%02x loc:%02x\n", |
| 184 |
__func__, phy_id, loc); |
| 185 |
|
| 186 |
if (phy_id != 0) |
| 187 |
return -ENODEV; |
| 188 |
|
| 189 |
ret = control_read(dev, REQUEST_READ, 0, loc * 2, buff, 0x02, |
| 190 |
CONTROL_TIMEOUT_MS); |
| 191 |
if (ret < 0) |
| 192 |
return ret; |
| 193 |
|
| 194 |
return (buff[0] | buff[1] << 8); |
| 195 |
} |
| 196 |
|
| 197 |
static void ch9200_mdio_write(struct net_device *netdev, |
| 198 |
int phy_id, int loc, int val) |
| 199 |
{ |
| 200 |
struct usbnet *dev = netdev_priv(netdev); |
| 201 |
unsigned char buff[2]; |
| 202 |
|
| 203 |
netdev_dbg(netdev, "%s() phy_id=%02x loc:%02x\n", |
| 204 |
__func__, phy_id, loc); |
| 205 |
|
| 206 |
if (phy_id != 0) |
| 207 |
return; |
| 208 |
|
| 209 |
buff[0] = (unsigned char)val; |
| 210 |
buff[1] = (unsigned char)(val >> 8); |
| 211 |
|
| 212 |
control_write(dev, REQUEST_WRITE, 0, loc * 2, buff, 0x02, |
| 213 |
CONTROL_TIMEOUT_MS); |
| 214 |
} |
| 215 |
|
| 216 |
static int ch9200_link_reset(struct usbnet *dev) |
| 217 |
{ |
| 218 |
struct ethtool_cmd ecmd; |
| 219 |
|
| 220 |
mii_check_media(&dev->mii, 1, 1); |
| 221 |
mii_ethtool_gset(&dev->mii, &ecmd); |
| 222 |
|
| 223 |
netdev_dbg(dev->net, "%s() speed:%d duplex:%d\n", |
| 224 |
__func__, ecmd.speed, ecmd.duplex); |
| 225 |
|
| 226 |
return 0; |
| 227 |
} |
| 228 |
|
| 229 |
static void ch9200_status(struct usbnet *dev, struct urb *urb) |
| 230 |
{ |
| 231 |
int link; |
| 232 |
unsigned char *buf; |
| 233 |
|
| 234 |
if (urb->actual_length < 16) |
| 235 |
return; |
| 236 |
|
| 237 |
buf = urb->transfer_buffer; |
| 238 |
link = !!(buf[0] & 0x01); |
| 239 |
|
| 240 |
if (link) { |
| 241 |
netif_carrier_on(dev->net); |
| 242 |
usbnet_defer_kevent(dev, EVENT_LINK_RESET); |
| 243 |
} else { |
| 244 |
netif_carrier_off(dev->net); |
| 245 |
} |
| 246 |
} |
| 247 |
|
| 248 |
static struct sk_buff *ch9200_tx_fixup(struct usbnet *dev, struct sk_buff *skb, |
| 249 |
gfp_t flags) |
| 250 |
{ |
| 251 |
int i = 0; |
| 252 |
int len = 0; |
| 253 |
int tx_overhead = 0; |
| 254 |
|
| 255 |
tx_overhead = 0x40; |
| 256 |
|
| 257 |
len = skb->len; |
| 258 |
if (skb_cow_head(skb, tx_overhead)) { |
| 259 |
dev_kfree_skb_any(skb); |
| 260 |
return NULL; |
| 261 |
} |
| 262 |
|
| 263 |
__skb_push(skb, tx_overhead); |
| 264 |
/* usbnet adds padding if length is a multiple of packet size |
| 265 |
* if so, adjust length value in header |
| 266 |
*/ |
| 267 |
if ((skb->len % dev->maxpacket) == 0) |
| 268 |
len++; |
| 269 |
|
| 270 |
skb->data[0] = len; |
| 271 |
skb->data[1] = len >> 8; |
| 272 |
skb->data[2] = 0x00; |
| 273 |
skb->data[3] = 0x80; |
| 274 |
|
| 275 |
for (i = 4; i < 48; i++) |
| 276 |
skb->data[i] = 0x00; |
| 277 |
|
| 278 |
skb->data[48] = len; |
| 279 |
skb->data[49] = len >> 8; |
| 280 |
skb->data[50] = 0x00; |
| 281 |
skb->data[51] = 0x80; |
| 282 |
|
| 283 |
for (i = 52; i < 64; i++) |
| 284 |
skb->data[i] = 0x00; |
| 285 |
|
| 286 |
return skb; |
| 287 |
} |
| 288 |
|
| 289 |
static int ch9200_rx_fixup(struct usbnet *dev, struct sk_buff *skb) |
| 290 |
{ |
| 291 |
int len = 0; |
| 292 |
int rx_overhead = 0; |
| 293 |
|
| 294 |
rx_overhead = 64; |
| 295 |
|
| 296 |
if (unlikely(skb->len < rx_overhead)) { |
| 297 |
dev_err(&dev->udev->dev, "unexpected tiny rx frame\n"); |
| 298 |
return 0; |
| 299 |
} |
| 300 |
|
| 301 |
len = (skb->data[skb->len - 16] | skb->data[skb->len - 15] << 8); |
| 302 |
skb_trim(skb, len); |
| 303 |
|
| 304 |
return 1; |
| 305 |
} |
| 306 |
|
| 307 |
static int get_mac_address(struct usbnet *dev, unsigned char *data) |
| 308 |
{ |
| 309 |
int err = 0; |
| 310 |
unsigned char mac_addr[0x06]; |
| 311 |
int rd_mac_len = 0; |
| 312 |
|
| 313 |
netdev_dbg(dev->net, "%s:\n\tusbnet VID:%0x PID:%0x\n", __func__, |
| 314 |
le16_to_cpu(dev->udev->descriptor.idVendor), |
| 315 |
le16_to_cpu(dev->udev->descriptor.idProduct)); |
| 316 |
|
| 317 |
memset(mac_addr, 0, sizeof(mac_addr)); |
| 318 |
rd_mac_len = control_read(dev, REQUEST_READ, 0, |
| 319 |
MAC_REG_STATION_L, mac_addr, 0x02, |
| 320 |
CONTROL_TIMEOUT_MS); |
| 321 |
rd_mac_len += control_read(dev, REQUEST_READ, 0, MAC_REG_STATION_M, |
| 322 |
mac_addr + 2, 0x02, CONTROL_TIMEOUT_MS); |
| 323 |
rd_mac_len += control_read(dev, REQUEST_READ, 0, MAC_REG_STATION_H, |
| 324 |
mac_addr + 4, 0x02, CONTROL_TIMEOUT_MS); |
| 325 |
if (rd_mac_len != ETH_ALEN) |
| 326 |
err = -EINVAL; |
| 327 |
|
| 328 |
data[0] = mac_addr[5]; |
| 329 |
data[1] = mac_addr[4]; |
| 330 |
data[2] = mac_addr[3]; |
| 331 |
data[3] = mac_addr[2]; |
| 332 |
data[4] = mac_addr[1]; |
| 333 |
data[5] = mac_addr[0]; |
| 334 |
|
| 335 |
return err; |
| 336 |
} |
| 337 |
|
| 338 |
static int ch9200_bind(struct usbnet *dev, struct usb_interface *intf) |
| 339 |
{ |
| 340 |
int retval = 0; |
| 341 |
unsigned char data[2]; |
| 342 |
u8 addr[ETH_ALEN]; |
| 343 |
|
| 344 |
retval = usbnet_get_endpoints(dev, intf); |
| 345 |
if (retval) |
| 346 |
return retval; |
| 347 |
|
| 348 |
dev->mii.dev = dev->net; |
| 349 |
dev->mii.mdio_read = ch9200_mdio_read; |
| 350 |
dev->mii.mdio_write = ch9200_mdio_write; |
| 351 |
dev->mii.reg_num_mask = 0x1f; |
| 352 |
|
| 353 |
dev->mii.phy_id_mask = 0x1f; |
| 354 |
|
| 355 |
dev->hard_mtu = dev->net->mtu + dev->net->hard_header_len; |
| 356 |
dev->rx_urb_size = 24 * 64 + 16; |
| 357 |
mii_nway_restart(&dev->mii); |
| 358 |
|
| 359 |
data[0] = 0x01; |
| 360 |
data[1] = 0x0F; |
| 361 |
retval = control_write(dev, REQUEST_WRITE, 0, MAC_REG_THRESHOLD, data, |
| 362 |
0x02, CONTROL_TIMEOUT_MS); |
| 363 |
|
| 364 |
data[0] = 0xA0; |
| 365 |
data[1] = 0x90; |
| 366 |
retval = control_write(dev, REQUEST_WRITE, 0, MAC_REG_FIFO_DEPTH, data, |
| 367 |
0x02, CONTROL_TIMEOUT_MS); |
| 368 |
|
| 369 |
data[0] = 0x30; |
| 370 |
data[1] = 0x00; |
| 371 |
retval = control_write(dev, REQUEST_WRITE, 0, MAC_REG_PAUSE, data, |
| 372 |
0x02, CONTROL_TIMEOUT_MS); |
| 373 |
|
| 374 |
data[0] = 0x17; |
| 375 |
data[1] = 0xD8; |
| 376 |
retval = control_write(dev, REQUEST_WRITE, 0, MAC_REG_FLOW_CONTROL, |
| 377 |
data, 0x02, CONTROL_TIMEOUT_MS); |
| 378 |
|
| 379 |
/* Undocumented register */ |
| 380 |
data[0] = 0x01; |
| 381 |
data[1] = 0x00; |
| 382 |
retval = control_write(dev, REQUEST_WRITE, 0, 254, data, 0x02, |
| 383 |
CONTROL_TIMEOUT_MS); |
| 384 |
|
| 385 |
data[0] = 0x5F; |
| 386 |
data[1] = 0x0D; |
| 387 |
retval = control_write(dev, REQUEST_WRITE, 0, MAC_REG_CTRL, data, 0x02, |
| 388 |
CONTROL_TIMEOUT_MS); |
| 389 |
|
| 390 |
retval = get_mac_address(dev, addr); |
| 391 |
eth_hw_addr_set(dev->net, addr); |
| 392 |
|
| 393 |
return retval; |
| 394 |
} |
| 395 |
|
| 396 |
static const struct driver_info ch9200_info = { |
| 397 |
.description = "CH9200 USB to Network Adaptor", |
| 398 |
.flags = FLAG_ETHER, |
| 399 |
.bind = ch9200_bind, |
| 400 |
.rx_fixup = ch9200_rx_fixup, |
| 401 |
.tx_fixup = ch9200_tx_fixup, |
| 402 |
.status = ch9200_status, |
| 403 |
.link_reset = ch9200_link_reset, |
| 404 |
.reset = ch9200_link_reset, |
| 405 |
}; |
| 406 |
|
| 407 |
static const struct usb_device_id ch9200_products[] = { |
| 408 |
{ |
| 409 |
USB_DEVICE(0x1A86, 0xE092), |
| 410 |
.driver_info = (unsigned long)&ch9200_info, |
| 411 |
}, |
| 412 |
{}, |
| 413 |
}; |
| 414 |
|
| 415 |
MODULE_DEVICE_TABLE(usb, ch9200_products); |
| 416 |
|
| 417 |
static struct usb_driver ch9200_driver = { |
| 418 |
.name = "ch9200", |
| 419 |
.id_table = ch9200_products, |
| 420 |
.probe = usbnet_probe, |
| 421 |
.disconnect = usbnet_disconnect, |
| 422 |
.suspend = usbnet_suspend, |
| 423 |
.resume = usbnet_resume, |
| 424 |
}; |
| 425 |
|
| 426 |
module_usb_driver(ch9200_driver); |
| 427 |
|
| 428 |
MODULE_DESCRIPTION("QinHeng CH9200 USB Network device"); |
| 429 |
MODULE_LICENSE("GPL"); |