r815x.c 5.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234
  1. #include <linux/module.h>
  2. #include <linux/netdevice.h>
  3. #include <linux/mii.h>
  4. #include <linux/usb.h>
  5. #include <linux/usb/cdc.h>
  6. #include <linux/usb/usbnet.h>
  7. #define RTL815x_REQT_READ 0xc0
  8. #define RTL815x_REQT_WRITE 0x40
  9. #define RTL815x_REQ_GET_REGS 0x05
  10. #define RTL815x_REQ_SET_REGS 0x05
  11. #define MCU_TYPE_PLA 0x0100
  12. #define OCP_BASE 0xe86c
  13. #define BASE_MII 0xa400
  14. #define BYTE_EN_DWORD 0xff
  15. #define BYTE_EN_WORD 0x33
  16. #define BYTE_EN_BYTE 0x11
  17. #define R815x_PHY_ID 32
  18. #define REALTEK_VENDOR_ID 0x0bda
  19. static int pla_read_word(struct usb_device *udev, u16 index)
  20. {
  21. int data, ret;
  22. u8 shift = index & 2;
  23. __le32 ocp_data;
  24. index &= ~3;
  25. ret = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
  26. RTL815x_REQ_GET_REGS, RTL815x_REQT_READ,
  27. index, MCU_TYPE_PLA, &ocp_data, sizeof(ocp_data),
  28. 500);
  29. if (ret < 0)
  30. return ret;
  31. data = __le32_to_cpu(ocp_data);
  32. data >>= (shift * 8);
  33. data &= 0xffff;
  34. return data;
  35. }
  36. static int pla_write_word(struct usb_device *udev, u16 index, u32 data)
  37. {
  38. __le32 ocp_data;
  39. u32 mask = 0xffff;
  40. u16 byen = BYTE_EN_WORD;
  41. u8 shift = index & 2;
  42. int ret;
  43. data &= mask;
  44. if (shift) {
  45. byen <<= shift;
  46. mask <<= (shift * 8);
  47. data <<= (shift * 8);
  48. index &= ~3;
  49. }
  50. ret = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
  51. RTL815x_REQ_GET_REGS, RTL815x_REQT_READ,
  52. index, MCU_TYPE_PLA, &ocp_data, sizeof(ocp_data),
  53. 500);
  54. if (ret < 0)
  55. return ret;
  56. data |= __le32_to_cpu(ocp_data) & ~mask;
  57. ocp_data = __cpu_to_le32(data);
  58. ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
  59. RTL815x_REQ_SET_REGS, RTL815x_REQT_WRITE,
  60. index, MCU_TYPE_PLA | byen, &ocp_data,
  61. sizeof(ocp_data), 500);
  62. return ret;
  63. }
  64. static int ocp_reg_read(struct usbnet *dev, u16 addr)
  65. {
  66. u16 ocp_base, ocp_index;
  67. int ret;
  68. ocp_base = addr & 0xf000;
  69. ret = pla_write_word(dev->udev, OCP_BASE, ocp_base);
  70. if (ret < 0)
  71. goto out;
  72. ocp_index = (addr & 0x0fff) | 0xb000;
  73. ret = pla_read_word(dev->udev, ocp_index);
  74. out:
  75. return ret;
  76. }
  77. static int ocp_reg_write(struct usbnet *dev, u16 addr, u16 data)
  78. {
  79. u16 ocp_base, ocp_index;
  80. int ret;
  81. ocp_base = addr & 0xf000;
  82. ret = pla_write_word(dev->udev, OCP_BASE, ocp_base);
  83. if (ret < 0)
  84. goto out1;
  85. ocp_index = (addr & 0x0fff) | 0xb000;
  86. ret = pla_write_word(dev->udev, ocp_index, data);
  87. out1:
  88. return ret;
  89. }
  90. static int r815x_mdio_read(struct net_device *netdev, int phy_id, int reg)
  91. {
  92. struct usbnet *dev = netdev_priv(netdev);
  93. if (phy_id != R815x_PHY_ID)
  94. return -EINVAL;
  95. return ocp_reg_read(dev, BASE_MII + reg * 2);
  96. }
  97. static
  98. void r815x_mdio_write(struct net_device *netdev, int phy_id, int reg, int val)
  99. {
  100. struct usbnet *dev = netdev_priv(netdev);
  101. if (phy_id != R815x_PHY_ID)
  102. return;
  103. ocp_reg_write(dev, BASE_MII + reg * 2, val);
  104. }
  105. static int r8153_bind(struct usbnet *dev, struct usb_interface *intf)
  106. {
  107. int status;
  108. status = usbnet_cdc_bind(dev, intf);
  109. if (status < 0)
  110. return status;
  111. dev->mii.dev = dev->net;
  112. dev->mii.mdio_read = r815x_mdio_read;
  113. dev->mii.mdio_write = r815x_mdio_write;
  114. dev->mii.phy_id_mask = 0x3f;
  115. dev->mii.reg_num_mask = 0x1f;
  116. dev->mii.phy_id = R815x_PHY_ID;
  117. dev->mii.supports_gmii = 1;
  118. return 0;
  119. }
  120. static int r8152_bind(struct usbnet *dev, struct usb_interface *intf)
  121. {
  122. int status;
  123. status = usbnet_cdc_bind(dev, intf);
  124. if (status < 0)
  125. return status;
  126. dev->mii.dev = dev->net;
  127. dev->mii.mdio_read = r815x_mdio_read;
  128. dev->mii.mdio_write = r815x_mdio_write;
  129. dev->mii.phy_id_mask = 0x3f;
  130. dev->mii.reg_num_mask = 0x1f;
  131. dev->mii.phy_id = R815x_PHY_ID;
  132. dev->mii.supports_gmii = 0;
  133. return 0;
  134. }
  135. static const struct driver_info r8152_info = {
  136. .description = "RTL8152 ECM Device",
  137. .flags = FLAG_ETHER | FLAG_POINTTOPOINT,
  138. .bind = r8152_bind,
  139. .unbind = usbnet_cdc_unbind,
  140. .status = usbnet_cdc_status,
  141. .manage_power = usbnet_manage_power,
  142. };
  143. static const struct driver_info r8153_info = {
  144. .description = "RTL8153 ECM Device",
  145. .flags = FLAG_ETHER | FLAG_POINTTOPOINT,
  146. .bind = r8153_bind,
  147. .unbind = usbnet_cdc_unbind,
  148. .status = usbnet_cdc_status,
  149. .manage_power = usbnet_manage_power,
  150. };
  151. static const struct usb_device_id products[] = {
  152. {
  153. USB_DEVICE_AND_INTERFACE_INFO(REALTEK_VENDOR_ID, 0x8152, USB_CLASS_COMM,
  154. USB_CDC_SUBCLASS_ETHERNET, USB_CDC_PROTO_NONE),
  155. #if defined(CONFIG_USB_RTL8152) || defined(CONFIG_USB_RTL8152_MODULE)
  156. .driver_info = 0,
  157. #else
  158. .driver_info = (unsigned long) &r8152_info,
  159. #endif
  160. },
  161. {
  162. USB_DEVICE_AND_INTERFACE_INFO(REALTEK_VENDOR_ID, 0x8153, USB_CLASS_COMM,
  163. USB_CDC_SUBCLASS_ETHERNET, USB_CDC_PROTO_NONE),
  164. #if defined(CONFIG_USB_RTL8153) || defined(CONFIG_USB_RTL8153_MODULE)
  165. .driver_info = 0,
  166. #else
  167. .driver_info = (unsigned long) &r8153_info,
  168. #endif
  169. },
  170. { }, /* END */
  171. };
  172. MODULE_DEVICE_TABLE(usb, products);
  173. static struct usb_driver r815x_driver = {
  174. .name = "r815x",
  175. .id_table = products,
  176. .probe = usbnet_probe,
  177. .disconnect = usbnet_disconnect,
  178. .suspend = usbnet_suspend,
  179. .resume = usbnet_resume,
  180. .reset_resume = usbnet_resume,
  181. .supports_autosuspend = 1,
  182. .disable_hub_initiated_lpm = 1,
  183. };
  184. module_usb_driver(r815x_driver);
  185. MODULE_AUTHOR("Hayes Wang");
  186. MODULE_DESCRIPTION("Realtek USB ECM device");
  187. MODULE_LICENSE("GPL");