rtl8366rb.c 32 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271
  1. /*
  2. * Platform driver for the Realtek RTL8366RB ethernet switch
  3. *
  4. * Copyright (C) 2009-2010 Gabor Juhos <[email protected]>
  5. * Copyright (C) 2010 Antti Seppälä <[email protected]>
  6. * Copyright (C) 2010 Roman Yeryomin <[email protected]>
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms of the GNU General Public License version 2 as published
  10. * by the Free Software Foundation.
  11. */
  12. #include <linux/kernel.h>
  13. #include <linux/module.h>
  14. #include <linux/init.h>
  15. #include <linux/platform_device.h>
  16. #include <linux/delay.h>
  17. #include <linux/skbuff.h>
  18. #include <linux/rtl8366.h>
  19. #include "rtl8366_smi.h"
  20. #define RTL8366RB_DRIVER_DESC "Realtek RTL8366RB ethernet switch driver"
  21. #define RTL8366RB_DRIVER_VER "0.2.3"
  22. #define RTL8366RB_PHY_NO_MAX 4
  23. #define RTL8366RB_PHY_PAGE_MAX 7
  24. #define RTL8366RB_PHY_ADDR_MAX 31
  25. /* Switch Global Configuration register */
  26. #define RTL8366RB_SGCR 0x0000
  27. #define RTL8366RB_SGCR_EN_BC_STORM_CTRL BIT(0)
  28. #define RTL8366RB_SGCR_MAX_LENGTH(_x) (_x << 4)
  29. #define RTL8366RB_SGCR_MAX_LENGTH_MASK RTL8366RB_SGCR_MAX_LENGTH(0x3)
  30. #define RTL8366RB_SGCR_MAX_LENGTH_1522 RTL8366RB_SGCR_MAX_LENGTH(0x0)
  31. #define RTL8366RB_SGCR_MAX_LENGTH_1536 RTL8366RB_SGCR_MAX_LENGTH(0x1)
  32. #define RTL8366RB_SGCR_MAX_LENGTH_1552 RTL8366RB_SGCR_MAX_LENGTH(0x2)
  33. #define RTL8366RB_SGCR_MAX_LENGTH_9216 RTL8366RB_SGCR_MAX_LENGTH(0x3)
  34. #define RTL8366RB_SGCR_EN_VLAN BIT(13)
  35. #define RTL8366RB_SGCR_EN_VLAN_4KTB BIT(14)
  36. /* Port Enable Control register */
  37. #define RTL8366RB_PECR 0x0001
  38. /* Switch Security Control registers */
  39. #define RTL8366RB_SSCR0 0x0002
  40. #define RTL8366RB_SSCR1 0x0003
  41. #define RTL8366RB_SSCR2 0x0004
  42. #define RTL8366RB_SSCR2_DROP_UNKNOWN_DA BIT(0)
  43. #define RTL8366RB_RESET_CTRL_REG 0x0100
  44. #define RTL8366RB_CHIP_CTRL_RESET_HW 1
  45. #define RTL8366RB_CHIP_CTRL_RESET_SW (1 << 1)
  46. #define RTL8366RB_CHIP_VERSION_CTRL_REG 0x050A
  47. #define RTL8366RB_CHIP_VERSION_MASK 0xf
  48. #define RTL8366RB_CHIP_ID_REG 0x0509
  49. #define RTL8366RB_CHIP_ID_8366 0x5937
  50. /* PHY registers control */
  51. #define RTL8366RB_PHY_ACCESS_CTRL_REG 0x8000
  52. #define RTL8366RB_PHY_ACCESS_DATA_REG 0x8002
  53. #define RTL8366RB_PHY_CTRL_READ 1
  54. #define RTL8366RB_PHY_CTRL_WRITE 0
  55. #define RTL8366RB_PHY_REG_MASK 0x1f
  56. #define RTL8366RB_PHY_PAGE_OFFSET 5
  57. #define RTL8366RB_PHY_PAGE_MASK (0xf << 5)
  58. #define RTL8366RB_PHY_NO_OFFSET 9
  59. #define RTL8366RB_PHY_NO_MASK (0x1f << 9)
  60. #define RTL8366RB_VLAN_INGRESS_CTRL2_REG 0x037f
  61. /* LED control registers */
  62. #define RTL8366RB_LED_BLINKRATE_REG 0x0430
  63. #define RTL8366RB_LED_BLINKRATE_BIT 0
  64. #define RTL8366RB_LED_BLINKRATE_MASK 0x0007
  65. #define RTL8366RB_LED_CTRL_REG 0x0431
  66. #define RTL8366RB_LED_0_1_CTRL_REG 0x0432
  67. #define RTL8366RB_LED_2_3_CTRL_REG 0x0433
  68. #define RTL8366RB_MIB_COUNT 33
  69. #define RTL8366RB_GLOBAL_MIB_COUNT 1
  70. #define RTL8366RB_MIB_COUNTER_PORT_OFFSET 0x0050
  71. #define RTL8366RB_MIB_COUNTER_BASE 0x1000
  72. #define RTL8366RB_MIB_CTRL_REG 0x13F0
  73. #define RTL8366RB_MIB_CTRL_USER_MASK 0x0FFC
  74. #define RTL8366RB_MIB_CTRL_BUSY_MASK BIT(0)
  75. #define RTL8366RB_MIB_CTRL_RESET_MASK BIT(1)
  76. #define RTL8366RB_MIB_CTRL_PORT_RESET(_p) BIT(2 + (_p))
  77. #define RTL8366RB_MIB_CTRL_GLOBAL_RESET BIT(11)
  78. #define RTL8366RB_PORT_VLAN_CTRL_BASE 0x0063
  79. #define RTL8366RB_PORT_VLAN_CTRL_REG(_p) \
  80. (RTL8366RB_PORT_VLAN_CTRL_BASE + (_p) / 4)
  81. #define RTL8366RB_PORT_VLAN_CTRL_MASK 0xf
  82. #define RTL8366RB_PORT_VLAN_CTRL_SHIFT(_p) (4 * ((_p) % 4))
  83. #define RTL8366RB_VLAN_TABLE_READ_BASE 0x018C
  84. #define RTL8366RB_VLAN_TABLE_WRITE_BASE 0x0185
  85. #define RTL8366RB_TABLE_ACCESS_CTRL_REG 0x0180
  86. #define RTL8366RB_TABLE_VLAN_READ_CTRL 0x0E01
  87. #define RTL8366RB_TABLE_VLAN_WRITE_CTRL 0x0F01
  88. #define RTL8366RB_VLAN_MC_BASE(_x) (0x0020 + (_x) * 3)
  89. #define RTL8366RB_PORT_LINK_STATUS_BASE 0x0014
  90. #define RTL8366RB_PORT_STATUS_SPEED_MASK 0x0003
  91. #define RTL8366RB_PORT_STATUS_DUPLEX_MASK 0x0004
  92. #define RTL8366RB_PORT_STATUS_LINK_MASK 0x0010
  93. #define RTL8366RB_PORT_STATUS_TXPAUSE_MASK 0x0020
  94. #define RTL8366RB_PORT_STATUS_RXPAUSE_MASK 0x0040
  95. #define RTL8366RB_PORT_STATUS_AN_MASK 0x0080
  96. #define RTL8366RB_PORT_NUM_CPU 5
  97. #define RTL8366RB_NUM_PORTS 6
  98. #define RTL8366RB_NUM_VLANS 16
  99. #define RTL8366RB_NUM_LEDGROUPS 4
  100. #define RTL8366RB_NUM_VIDS 4096
  101. #define RTL8366RB_PRIORITYMAX 7
  102. #define RTL8366RB_FIDMAX 7
  103. #define RTL8366RB_PORT_1 (1 << 0) /* In userspace port 0 */
  104. #define RTL8366RB_PORT_2 (1 << 1) /* In userspace port 1 */
  105. #define RTL8366RB_PORT_3 (1 << 2) /* In userspace port 2 */
  106. #define RTL8366RB_PORT_4 (1 << 3) /* In userspace port 3 */
  107. #define RTL8366RB_PORT_5 (1 << 4) /* In userspace port 4 */
  108. #define RTL8366RB_PORT_CPU (1 << 5) /* CPU port */
  109. #define RTL8366RB_PORT_ALL (RTL8366RB_PORT_1 | \
  110. RTL8366RB_PORT_2 | \
  111. RTL8366RB_PORT_3 | \
  112. RTL8366RB_PORT_4 | \
  113. RTL8366RB_PORT_5 | \
  114. RTL8366RB_PORT_CPU)
  115. #define RTL8366RB_PORT_ALL_BUT_CPU (RTL8366RB_PORT_1 | \
  116. RTL8366RB_PORT_2 | \
  117. RTL8366RB_PORT_3 | \
  118. RTL8366RB_PORT_4 | \
  119. RTL8366RB_PORT_5)
  120. #define RTL8366RB_PORT_ALL_EXTERNAL (RTL8366RB_PORT_1 | \
  121. RTL8366RB_PORT_2 | \
  122. RTL8366RB_PORT_3 | \
  123. RTL8366RB_PORT_4)
  124. #define RTL8366RB_PORT_ALL_INTERNAL RTL8366RB_PORT_CPU
  125. #define RTL8366RB_VLAN_VID_MASK 0xfff
  126. #define RTL8366RB_VLAN_PRIORITY_SHIFT 12
  127. #define RTL8366RB_VLAN_PRIORITY_MASK 0x7
  128. #define RTL8366RB_VLAN_UNTAG_SHIFT 8
  129. #define RTL8366RB_VLAN_UNTAG_MASK 0xff
  130. #define RTL8366RB_VLAN_MEMBER_MASK 0xff
  131. #define RTL8366RB_VLAN_FID_MASK 0x7
  132. /* Port ingress bandwidth control */
  133. #define RTL8366RB_IB_BASE 0x0200
  134. #define RTL8366RB_IB_REG(pnum) (RTL8366RB_IB_BASE + pnum)
  135. #define RTL8366RB_IB_BDTH_MASK 0x3fff
  136. #define RTL8366RB_IB_PREIFG_OFFSET 14
  137. #define RTL8366RB_IB_PREIFG_MASK (1 << RTL8366RB_IB_PREIFG_OFFSET)
  138. /* Port egress bandwidth control */
  139. #define RTL8366RB_EB_BASE 0x02d1
  140. #define RTL8366RB_EB_REG(pnum) (RTL8366RB_EB_BASE + pnum)
  141. #define RTL8366RB_EB_BDTH_MASK 0x3fff
  142. #define RTL8366RB_EB_PREIFG_REG 0x02f8
  143. #define RTL8366RB_EB_PREIFG_OFFSET 9
  144. #define RTL8366RB_EB_PREIFG_MASK (1 << RTL8366RB_EB_PREIFG_OFFSET)
  145. #define RTL8366RB_BDTH_SW_MAX 1048512
  146. #define RTL8366RB_BDTH_UNIT 64
  147. #define RTL8366RB_BDTH_REG_DEFAULT 16383
  148. /* QOS */
  149. #define RTL8366RB_QOS_BIT 15
  150. #define RTL8366RB_QOS_MASK (1 << RTL8366RB_QOS_BIT)
  151. /* Include/Exclude Preamble and IFG (20 bytes). 0:Exclude, 1:Include. */
  152. #define RTL8366RB_QOS_DEFAULT_PREIFG 1
  153. static struct rtl8366_mib_counter rtl8366rb_mib_counters[] = {
  154. { 0, 0, 4, "IfInOctets" },
  155. { 0, 4, 4, "EtherStatsOctets" },
  156. { 0, 8, 2, "EtherStatsUnderSizePkts" },
  157. { 0, 10, 2, "EtherFragments" },
  158. { 0, 12, 2, "EtherStatsPkts64Octets" },
  159. { 0, 14, 2, "EtherStatsPkts65to127Octets" },
  160. { 0, 16, 2, "EtherStatsPkts128to255Octets" },
  161. { 0, 18, 2, "EtherStatsPkts256to511Octets" },
  162. { 0, 20, 2, "EtherStatsPkts512to1023Octets" },
  163. { 0, 22, 2, "EtherStatsPkts1024to1518Octets" },
  164. { 0, 24, 2, "EtherOversizeStats" },
  165. { 0, 26, 2, "EtherStatsJabbers" },
  166. { 0, 28, 2, "IfInUcastPkts" },
  167. { 0, 30, 2, "EtherStatsMulticastPkts" },
  168. { 0, 32, 2, "EtherStatsBroadcastPkts" },
  169. { 0, 34, 2, "EtherStatsDropEvents" },
  170. { 0, 36, 2, "Dot3StatsFCSErrors" },
  171. { 0, 38, 2, "Dot3StatsSymbolErrors" },
  172. { 0, 40, 2, "Dot3InPauseFrames" },
  173. { 0, 42, 2, "Dot3ControlInUnknownOpcodes" },
  174. { 0, 44, 4, "IfOutOctets" },
  175. { 0, 48, 2, "Dot3StatsSingleCollisionFrames" },
  176. { 0, 50, 2, "Dot3StatMultipleCollisionFrames" },
  177. { 0, 52, 2, "Dot3sDeferredTransmissions" },
  178. { 0, 54, 2, "Dot3StatsLateCollisions" },
  179. { 0, 56, 2, "EtherStatsCollisions" },
  180. { 0, 58, 2, "Dot3StatsExcessiveCollisions" },
  181. { 0, 60, 2, "Dot3OutPauseFrames" },
  182. { 0, 62, 2, "Dot1dBasePortDelayExceededDiscards" },
  183. { 0, 64, 2, "Dot1dTpPortInDiscards" },
  184. { 0, 66, 2, "IfOutUcastPkts" },
  185. { 0, 68, 2, "IfOutMulticastPkts" },
  186. { 0, 70, 2, "IfOutBroadcastPkts" },
  187. };
  188. #define REG_WR(_smi, _reg, _val) \
  189. do { \
  190. err = rtl8366_smi_write_reg(_smi, _reg, _val); \
  191. if (err) \
  192. return err; \
  193. } while (0)
  194. #define REG_RMW(_smi, _reg, _mask, _val) \
  195. do { \
  196. err = rtl8366_smi_rmwr(_smi, _reg, _mask, _val); \
  197. if (err) \
  198. return err; \
  199. } while (0)
  200. static int rtl8366rb_reset_chip(struct rtl8366_smi *smi)
  201. {
  202. int timeout = 10;
  203. u32 data;
  204. rtl8366_smi_write_reg_noack(smi, RTL8366RB_RESET_CTRL_REG,
  205. RTL8366RB_CHIP_CTRL_RESET_HW);
  206. do {
  207. msleep(1);
  208. if (rtl8366_smi_read_reg(smi, RTL8366RB_RESET_CTRL_REG, &data))
  209. return -EIO;
  210. if (!(data & RTL8366RB_CHIP_CTRL_RESET_HW))
  211. break;
  212. } while (--timeout);
  213. if (!timeout) {
  214. printk("Timeout waiting for the switch to reset\n");
  215. return -EIO;
  216. }
  217. return 0;
  218. }
  219. static int rtl8366rb_setup(struct rtl8366_smi *smi)
  220. {
  221. int err;
  222. /* set maximum packet length to 1536 bytes */
  223. REG_RMW(smi, RTL8366RB_SGCR, RTL8366RB_SGCR_MAX_LENGTH_MASK,
  224. RTL8366RB_SGCR_MAX_LENGTH_1536);
  225. /* enable learning for all ports */
  226. REG_WR(smi, RTL8366RB_SSCR0, 0);
  227. /* enable auto ageing for all ports */
  228. REG_WR(smi, RTL8366RB_SSCR1, 0);
  229. /*
  230. * discard VLAN tagged packets if the port is not a member of
  231. * the VLAN with which the packets is associated.
  232. */
  233. REG_WR(smi, RTL8366RB_VLAN_INGRESS_CTRL2_REG, RTL8366RB_PORT_ALL);
  234. /* don't drop packets whose DA has not been learned */
  235. REG_RMW(smi, RTL8366RB_SSCR2, RTL8366RB_SSCR2_DROP_UNKNOWN_DA, 0);
  236. return 0;
  237. }
  238. static int rtl8366rb_read_phy_reg(struct rtl8366_smi *smi,
  239. u32 phy_no, u32 page, u32 addr, u32 *data)
  240. {
  241. u32 reg;
  242. int ret;
  243. if (phy_no > RTL8366RB_PHY_NO_MAX)
  244. return -EINVAL;
  245. if (page > RTL8366RB_PHY_PAGE_MAX)
  246. return -EINVAL;
  247. if (addr > RTL8366RB_PHY_ADDR_MAX)
  248. return -EINVAL;
  249. ret = rtl8366_smi_write_reg(smi, RTL8366RB_PHY_ACCESS_CTRL_REG,
  250. RTL8366RB_PHY_CTRL_READ);
  251. if (ret)
  252. return ret;
  253. reg = 0x8000 | (1 << (phy_no + RTL8366RB_PHY_NO_OFFSET)) |
  254. ((page << RTL8366RB_PHY_PAGE_OFFSET) & RTL8366RB_PHY_PAGE_MASK) |
  255. (addr & RTL8366RB_PHY_REG_MASK);
  256. ret = rtl8366_smi_write_reg(smi, reg, 0);
  257. if (ret)
  258. return ret;
  259. ret = rtl8366_smi_read_reg(smi, RTL8366RB_PHY_ACCESS_DATA_REG, data);
  260. if (ret)
  261. return ret;
  262. return 0;
  263. }
  264. static int rtl8366rb_write_phy_reg(struct rtl8366_smi *smi,
  265. u32 phy_no, u32 page, u32 addr, u32 data)
  266. {
  267. u32 reg;
  268. int ret;
  269. if (phy_no > RTL8366RB_PHY_NO_MAX)
  270. return -EINVAL;
  271. if (page > RTL8366RB_PHY_PAGE_MAX)
  272. return -EINVAL;
  273. if (addr > RTL8366RB_PHY_ADDR_MAX)
  274. return -EINVAL;
  275. ret = rtl8366_smi_write_reg(smi, RTL8366RB_PHY_ACCESS_CTRL_REG,
  276. RTL8366RB_PHY_CTRL_WRITE);
  277. if (ret)
  278. return ret;
  279. reg = 0x8000 | (1 << (phy_no + RTL8366RB_PHY_NO_OFFSET)) |
  280. ((page << RTL8366RB_PHY_PAGE_OFFSET) & RTL8366RB_PHY_PAGE_MASK) |
  281. (addr & RTL8366RB_PHY_REG_MASK);
  282. ret = rtl8366_smi_write_reg(smi, reg, data);
  283. if (ret)
  284. return ret;
  285. return 0;
  286. }
  287. static int rtl8366rb_get_mib_counter(struct rtl8366_smi *smi, int counter,
  288. int port, unsigned long long *val)
  289. {
  290. int i;
  291. int err;
  292. u32 addr, data;
  293. u64 mibvalue;
  294. if (port > RTL8366RB_NUM_PORTS || counter >= RTL8366RB_MIB_COUNT)
  295. return -EINVAL;
  296. addr = RTL8366RB_MIB_COUNTER_BASE +
  297. RTL8366RB_MIB_COUNTER_PORT_OFFSET * (port) +
  298. rtl8366rb_mib_counters[counter].offset;
  299. /*
  300. * Writing access counter address first
  301. * then ASIC will prepare 64bits counter wait for being retrived
  302. */
  303. data = 0; /* writing data will be discard by ASIC */
  304. err = rtl8366_smi_write_reg(smi, addr, data);
  305. if (err)
  306. return err;
  307. /* read MIB control register */
  308. err = rtl8366_smi_read_reg(smi, RTL8366RB_MIB_CTRL_REG, &data);
  309. if (err)
  310. return err;
  311. if (data & RTL8366RB_MIB_CTRL_BUSY_MASK)
  312. return -EBUSY;
  313. if (data & RTL8366RB_MIB_CTRL_RESET_MASK)
  314. return -EIO;
  315. mibvalue = 0;
  316. for (i = rtl8366rb_mib_counters[counter].length; i > 0; i--) {
  317. err = rtl8366_smi_read_reg(smi, addr + (i - 1), &data);
  318. if (err)
  319. return err;
  320. mibvalue = (mibvalue << 16) | (data & 0xFFFF);
  321. }
  322. *val = mibvalue;
  323. return 0;
  324. }
  325. static int rtl8366rb_get_vlan_4k(struct rtl8366_smi *smi, u32 vid,
  326. struct rtl8366_vlan_4k *vlan4k)
  327. {
  328. u32 data[3];
  329. int err;
  330. int i;
  331. memset(vlan4k, '\0', sizeof(struct rtl8366_vlan_4k));
  332. if (vid >= RTL8366RB_NUM_VIDS)
  333. return -EINVAL;
  334. /* write VID */
  335. err = rtl8366_smi_write_reg(smi, RTL8366RB_VLAN_TABLE_WRITE_BASE,
  336. vid & RTL8366RB_VLAN_VID_MASK);
  337. if (err)
  338. return err;
  339. /* write table access control word */
  340. err = rtl8366_smi_write_reg(smi, RTL8366RB_TABLE_ACCESS_CTRL_REG,
  341. RTL8366RB_TABLE_VLAN_READ_CTRL);
  342. if (err)
  343. return err;
  344. for (i = 0; i < 3; i++) {
  345. err = rtl8366_smi_read_reg(smi,
  346. RTL8366RB_VLAN_TABLE_READ_BASE + i,
  347. &data[i]);
  348. if (err)
  349. return err;
  350. }
  351. vlan4k->vid = vid;
  352. vlan4k->untag = (data[1] >> RTL8366RB_VLAN_UNTAG_SHIFT) &
  353. RTL8366RB_VLAN_UNTAG_MASK;
  354. vlan4k->member = data[1] & RTL8366RB_VLAN_MEMBER_MASK;
  355. vlan4k->fid = data[2] & RTL8366RB_VLAN_FID_MASK;
  356. return 0;
  357. }
  358. static int rtl8366rb_set_vlan_4k(struct rtl8366_smi *smi,
  359. const struct rtl8366_vlan_4k *vlan4k)
  360. {
  361. u32 data[3];
  362. int err;
  363. int i;
  364. if (vlan4k->vid >= RTL8366RB_NUM_VIDS ||
  365. vlan4k->member > RTL8366RB_VLAN_MEMBER_MASK ||
  366. vlan4k->untag > RTL8366RB_VLAN_UNTAG_MASK ||
  367. vlan4k->fid > RTL8366RB_FIDMAX)
  368. return -EINVAL;
  369. data[0] = vlan4k->vid & RTL8366RB_VLAN_VID_MASK;
  370. data[1] = (vlan4k->member & RTL8366RB_VLAN_MEMBER_MASK) |
  371. ((vlan4k->untag & RTL8366RB_VLAN_UNTAG_MASK) <<
  372. RTL8366RB_VLAN_UNTAG_SHIFT);
  373. data[2] = vlan4k->fid & RTL8366RB_VLAN_FID_MASK;
  374. for (i = 0; i < 3; i++) {
  375. err = rtl8366_smi_write_reg(smi,
  376. RTL8366RB_VLAN_TABLE_WRITE_BASE + i,
  377. data[i]);
  378. if (err)
  379. return err;
  380. }
  381. /* write table access control word */
  382. err = rtl8366_smi_write_reg(smi, RTL8366RB_TABLE_ACCESS_CTRL_REG,
  383. RTL8366RB_TABLE_VLAN_WRITE_CTRL);
  384. return err;
  385. }
  386. static int rtl8366rb_get_vlan_mc(struct rtl8366_smi *smi, u32 index,
  387. struct rtl8366_vlan_mc *vlanmc)
  388. {
  389. u32 data[3];
  390. int err;
  391. int i;
  392. memset(vlanmc, '\0', sizeof(struct rtl8366_vlan_mc));
  393. if (index >= RTL8366RB_NUM_VLANS)
  394. return -EINVAL;
  395. for (i = 0; i < 3; i++) {
  396. err = rtl8366_smi_read_reg(smi,
  397. RTL8366RB_VLAN_MC_BASE(index) + i,
  398. &data[i]);
  399. if (err)
  400. return err;
  401. }
  402. vlanmc->vid = data[0] & RTL8366RB_VLAN_VID_MASK;
  403. vlanmc->priority = (data[0] >> RTL8366RB_VLAN_PRIORITY_SHIFT) &
  404. RTL8366RB_VLAN_PRIORITY_MASK;
  405. vlanmc->untag = (data[1] >> RTL8366RB_VLAN_UNTAG_SHIFT) &
  406. RTL8366RB_VLAN_UNTAG_MASK;
  407. vlanmc->member = data[1] & RTL8366RB_VLAN_MEMBER_MASK;
  408. vlanmc->fid = data[2] & RTL8366RB_VLAN_FID_MASK;
  409. return 0;
  410. }
  411. static int rtl8366rb_set_vlan_mc(struct rtl8366_smi *smi, u32 index,
  412. const struct rtl8366_vlan_mc *vlanmc)
  413. {
  414. u32 data[3];
  415. int err;
  416. int i;
  417. if (index >= RTL8366RB_NUM_VLANS ||
  418. vlanmc->vid >= RTL8366RB_NUM_VIDS ||
  419. vlanmc->priority > RTL8366RB_PRIORITYMAX ||
  420. vlanmc->member > RTL8366RB_VLAN_MEMBER_MASK ||
  421. vlanmc->untag > RTL8366RB_VLAN_UNTAG_MASK ||
  422. vlanmc->fid > RTL8366RB_FIDMAX)
  423. return -EINVAL;
  424. data[0] = (vlanmc->vid & RTL8366RB_VLAN_VID_MASK) |
  425. ((vlanmc->priority & RTL8366RB_VLAN_PRIORITY_MASK) <<
  426. RTL8366RB_VLAN_PRIORITY_SHIFT);
  427. data[1] = (vlanmc->member & RTL8366RB_VLAN_MEMBER_MASK) |
  428. ((vlanmc->untag & RTL8366RB_VLAN_UNTAG_MASK) <<
  429. RTL8366RB_VLAN_UNTAG_SHIFT);
  430. data[2] = vlanmc->fid & RTL8366RB_VLAN_FID_MASK;
  431. for (i = 0; i < 3; i++) {
  432. err = rtl8366_smi_write_reg(smi,
  433. RTL8366RB_VLAN_MC_BASE(index) + i,
  434. data[i]);
  435. if (err)
  436. return err;
  437. }
  438. return 0;
  439. }
  440. static int rtl8366rb_get_mc_index(struct rtl8366_smi *smi, int port, int *val)
  441. {
  442. u32 data;
  443. int err;
  444. if (port >= RTL8366RB_NUM_PORTS)
  445. return -EINVAL;
  446. err = rtl8366_smi_read_reg(smi, RTL8366RB_PORT_VLAN_CTRL_REG(port),
  447. &data);
  448. if (err)
  449. return err;
  450. *val = (data >> RTL8366RB_PORT_VLAN_CTRL_SHIFT(port)) &
  451. RTL8366RB_PORT_VLAN_CTRL_MASK;
  452. return 0;
  453. }
  454. static int rtl8366rb_set_mc_index(struct rtl8366_smi *smi, int port, int index)
  455. {
  456. if (port >= RTL8366RB_NUM_PORTS || index >= RTL8366RB_NUM_VLANS)
  457. return -EINVAL;
  458. return rtl8366_smi_rmwr(smi, RTL8366RB_PORT_VLAN_CTRL_REG(port),
  459. RTL8366RB_PORT_VLAN_CTRL_MASK <<
  460. RTL8366RB_PORT_VLAN_CTRL_SHIFT(port),
  461. (index & RTL8366RB_PORT_VLAN_CTRL_MASK) <<
  462. RTL8366RB_PORT_VLAN_CTRL_SHIFT(port));
  463. }
  464. static int rtl8366rb_is_vlan_valid(struct rtl8366_smi *smi, unsigned vlan)
  465. {
  466. unsigned max = RTL8366RB_NUM_VLANS;
  467. if (smi->vlan4k_enabled)
  468. max = RTL8366RB_NUM_VIDS - 1;
  469. if (vlan == 0 || vlan >= max)
  470. return 0;
  471. return 1;
  472. }
  473. static int rtl8366rb_enable_vlan(struct rtl8366_smi *smi, int enable)
  474. {
  475. return rtl8366_smi_rmwr(smi, RTL8366RB_SGCR, RTL8366RB_SGCR_EN_VLAN,
  476. (enable) ? RTL8366RB_SGCR_EN_VLAN : 0);
  477. }
  478. static int rtl8366rb_enable_vlan4k(struct rtl8366_smi *smi, int enable)
  479. {
  480. return rtl8366_smi_rmwr(smi, RTL8366RB_SGCR,
  481. RTL8366RB_SGCR_EN_VLAN_4KTB,
  482. (enable) ? RTL8366RB_SGCR_EN_VLAN_4KTB : 0);
  483. }
  484. static int rtl8366rb_enable_port(struct rtl8366_smi *smi, int port, int enable)
  485. {
  486. return rtl8366_smi_rmwr(smi, RTL8366RB_PECR, (1 << port),
  487. (enable) ? 0 : (1 << port));
  488. }
  489. static int rtl8366rb_sw_reset_mibs(struct switch_dev *dev,
  490. const struct switch_attr *attr,
  491. struct switch_val *val)
  492. {
  493. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  494. return rtl8366_smi_rmwr(smi, RTL8366RB_MIB_CTRL_REG, 0,
  495. RTL8366RB_MIB_CTRL_GLOBAL_RESET);
  496. }
  497. static int rtl8366rb_sw_get_blinkrate(struct switch_dev *dev,
  498. const struct switch_attr *attr,
  499. struct switch_val *val)
  500. {
  501. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  502. u32 data;
  503. rtl8366_smi_read_reg(smi, RTL8366RB_LED_BLINKRATE_REG, &data);
  504. val->value.i = (data & (RTL8366RB_LED_BLINKRATE_MASK));
  505. return 0;
  506. }
  507. static int rtl8366rb_sw_set_blinkrate(struct switch_dev *dev,
  508. const struct switch_attr *attr,
  509. struct switch_val *val)
  510. {
  511. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  512. if (val->value.i >= 6)
  513. return -EINVAL;
  514. return rtl8366_smi_rmwr(smi, RTL8366RB_LED_BLINKRATE_REG,
  515. RTL8366RB_LED_BLINKRATE_MASK,
  516. val->value.i);
  517. }
  518. static int rtl8366rb_sw_get_learning_enable(struct switch_dev *dev,
  519. const struct switch_attr *attr,
  520. struct switch_val *val)
  521. {
  522. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  523. u32 data;
  524. rtl8366_smi_read_reg(smi, RTL8366RB_SSCR0, &data);
  525. val->value.i = !data;
  526. return 0;
  527. }
  528. static int rtl8366rb_sw_set_learning_enable(struct switch_dev *dev,
  529. const struct switch_attr *attr,
  530. struct switch_val *val)
  531. {
  532. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  533. u32 portmask = 0;
  534. int err = 0;
  535. if (!val->value.i)
  536. portmask = RTL8366RB_PORT_ALL;
  537. /* set learning for all ports */
  538. REG_WR(smi, RTL8366RB_SSCR0, portmask);
  539. /* set auto ageing for all ports */
  540. REG_WR(smi, RTL8366RB_SSCR1, portmask);
  541. return 0;
  542. }
  543. static int rtl8366rb_sw_get_port_link(struct switch_dev *dev,
  544. int port,
  545. struct switch_port_link *link)
  546. {
  547. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  548. u32 data = 0;
  549. u32 speed;
  550. if (port >= RTL8366RB_NUM_PORTS)
  551. return -EINVAL;
  552. rtl8366_smi_read_reg(smi, RTL8366RB_PORT_LINK_STATUS_BASE + (port / 2),
  553. &data);
  554. if (port % 2)
  555. data = data >> 8;
  556. link->link = !!(data & RTL8366RB_PORT_STATUS_LINK_MASK);
  557. if (!link->link)
  558. return 0;
  559. link->duplex = !!(data & RTL8366RB_PORT_STATUS_DUPLEX_MASK);
  560. link->rx_flow = !!(data & RTL8366RB_PORT_STATUS_RXPAUSE_MASK);
  561. link->tx_flow = !!(data & RTL8366RB_PORT_STATUS_TXPAUSE_MASK);
  562. link->aneg = !!(data & RTL8366RB_PORT_STATUS_AN_MASK);
  563. speed = (data & RTL8366RB_PORT_STATUS_SPEED_MASK);
  564. switch (speed) {
  565. case 0:
  566. link->speed = SWITCH_PORT_SPEED_10;
  567. break;
  568. case 1:
  569. link->speed = SWITCH_PORT_SPEED_100;
  570. break;
  571. case 2:
  572. link->speed = SWITCH_PORT_SPEED_1000;
  573. break;
  574. default:
  575. link->speed = SWITCH_PORT_SPEED_UNKNOWN;
  576. break;
  577. }
  578. return 0;
  579. }
  580. static int rtl8366rb_sw_set_port_led(struct switch_dev *dev,
  581. const struct switch_attr *attr,
  582. struct switch_val *val)
  583. {
  584. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  585. u32 data;
  586. u32 mask;
  587. u32 reg;
  588. if (val->port_vlan >= RTL8366RB_NUM_PORTS)
  589. return -EINVAL;
  590. if (val->port_vlan == RTL8366RB_PORT_NUM_CPU) {
  591. reg = RTL8366RB_LED_BLINKRATE_REG;
  592. mask = 0xF << 4;
  593. data = val->value.i << 4;
  594. } else {
  595. reg = RTL8366RB_LED_CTRL_REG;
  596. mask = 0xF << (val->port_vlan * 4),
  597. data = val->value.i << (val->port_vlan * 4);
  598. }
  599. return rtl8366_smi_rmwr(smi, reg, mask, data);
  600. }
  601. static int rtl8366rb_sw_get_port_led(struct switch_dev *dev,
  602. const struct switch_attr *attr,
  603. struct switch_val *val)
  604. {
  605. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  606. u32 data = 0;
  607. if (val->port_vlan >= RTL8366RB_NUM_LEDGROUPS)
  608. return -EINVAL;
  609. rtl8366_smi_read_reg(smi, RTL8366RB_LED_CTRL_REG, &data);
  610. val->value.i = (data >> (val->port_vlan * 4)) & 0x000F;
  611. return 0;
  612. }
  613. static int rtl8366rb_sw_set_port_disable(struct switch_dev *dev,
  614. const struct switch_attr *attr,
  615. struct switch_val *val)
  616. {
  617. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  618. u32 mask, data;
  619. if (val->port_vlan >= RTL8366RB_NUM_PORTS)
  620. return -EINVAL;
  621. mask = 1 << val->port_vlan ;
  622. if (val->value.i)
  623. data = mask;
  624. else
  625. data = 0;
  626. return rtl8366_smi_rmwr(smi, RTL8366RB_PECR, mask, data);
  627. }
  628. static int rtl8366rb_sw_get_port_disable(struct switch_dev *dev,
  629. const struct switch_attr *attr,
  630. struct switch_val *val)
  631. {
  632. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  633. u32 data;
  634. if (val->port_vlan >= RTL8366RB_NUM_PORTS)
  635. return -EINVAL;
  636. rtl8366_smi_read_reg(smi, RTL8366RB_PECR, &data);
  637. if (data & (1 << val->port_vlan))
  638. val->value.i = 1;
  639. else
  640. val->value.i = 0;
  641. return 0;
  642. }
  643. static int rtl8366rb_sw_set_port_rate_in(struct switch_dev *dev,
  644. const struct switch_attr *attr,
  645. struct switch_val *val)
  646. {
  647. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  648. if (val->port_vlan >= RTL8366RB_NUM_PORTS)
  649. return -EINVAL;
  650. if (val->value.i > 0 && val->value.i < RTL8366RB_BDTH_SW_MAX)
  651. val->value.i = (val->value.i - 1) / RTL8366RB_BDTH_UNIT;
  652. else
  653. val->value.i = RTL8366RB_BDTH_REG_DEFAULT;
  654. return rtl8366_smi_rmwr(smi, RTL8366RB_IB_REG(val->port_vlan),
  655. RTL8366RB_IB_BDTH_MASK | RTL8366RB_IB_PREIFG_MASK,
  656. val->value.i |
  657. (RTL8366RB_QOS_DEFAULT_PREIFG << RTL8366RB_IB_PREIFG_OFFSET));
  658. }
  659. static int rtl8366rb_sw_get_port_rate_in(struct switch_dev *dev,
  660. const struct switch_attr *attr,
  661. struct switch_val *val)
  662. {
  663. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  664. u32 data;
  665. if (val->port_vlan >= RTL8366RB_NUM_PORTS)
  666. return -EINVAL;
  667. rtl8366_smi_read_reg(smi, RTL8366RB_IB_REG(val->port_vlan), &data);
  668. data &= RTL8366RB_IB_BDTH_MASK;
  669. if (data < RTL8366RB_IB_BDTH_MASK)
  670. data += 1;
  671. val->value.i = (int)data * RTL8366RB_BDTH_UNIT;
  672. return 0;
  673. }
  674. static int rtl8366rb_sw_set_port_rate_out(struct switch_dev *dev,
  675. const struct switch_attr *attr,
  676. struct switch_val *val)
  677. {
  678. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  679. if (val->port_vlan >= RTL8366RB_NUM_PORTS)
  680. return -EINVAL;
  681. rtl8366_smi_rmwr(smi, RTL8366RB_EB_PREIFG_REG,
  682. RTL8366RB_EB_PREIFG_MASK,
  683. (RTL8366RB_QOS_DEFAULT_PREIFG << RTL8366RB_EB_PREIFG_OFFSET));
  684. if (val->value.i > 0 && val->value.i < RTL8366RB_BDTH_SW_MAX)
  685. val->value.i = (val->value.i - 1) / RTL8366RB_BDTH_UNIT;
  686. else
  687. val->value.i = RTL8366RB_BDTH_REG_DEFAULT;
  688. return rtl8366_smi_rmwr(smi, RTL8366RB_EB_REG(val->port_vlan),
  689. RTL8366RB_EB_BDTH_MASK, val->value.i );
  690. }
  691. static int rtl8366rb_sw_get_port_rate_out(struct switch_dev *dev,
  692. const struct switch_attr *attr,
  693. struct switch_val *val)
  694. {
  695. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  696. u32 data;
  697. if (val->port_vlan >= RTL8366RB_NUM_PORTS)
  698. return -EINVAL;
  699. rtl8366_smi_read_reg(smi, RTL8366RB_EB_REG(val->port_vlan), &data);
  700. data &= RTL8366RB_EB_BDTH_MASK;
  701. if (data < RTL8366RB_EB_BDTH_MASK)
  702. data += 1;
  703. val->value.i = (int)data * RTL8366RB_BDTH_UNIT;
  704. return 0;
  705. }
  706. static int rtl8366rb_sw_set_qos_enable(struct switch_dev *dev,
  707. const struct switch_attr *attr,
  708. struct switch_val *val)
  709. {
  710. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  711. u32 data;
  712. if (val->value.i)
  713. data = RTL8366RB_QOS_MASK;
  714. else
  715. data = 0;
  716. return rtl8366_smi_rmwr(smi, RTL8366RB_SGCR, RTL8366RB_QOS_MASK, data);
  717. }
  718. static int rtl8366rb_sw_get_qos_enable(struct switch_dev *dev,
  719. const struct switch_attr *attr,
  720. struct switch_val *val)
  721. {
  722. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  723. u32 data;
  724. rtl8366_smi_read_reg(smi, RTL8366RB_SGCR, &data);
  725. if (data & RTL8366RB_QOS_MASK)
  726. val->value.i = 1;
  727. else
  728. val->value.i = 0;
  729. return 0;
  730. }
  731. static int rtl8366rb_sw_reset_port_mibs(struct switch_dev *dev,
  732. const struct switch_attr *attr,
  733. struct switch_val *val)
  734. {
  735. struct rtl8366_smi *smi = sw_to_rtl8366_smi(dev);
  736. if (val->port_vlan >= RTL8366RB_NUM_PORTS)
  737. return -EINVAL;
  738. return rtl8366_smi_rmwr(smi, RTL8366RB_MIB_CTRL_REG, 0,
  739. RTL8366RB_MIB_CTRL_PORT_RESET(val->port_vlan));
  740. }
  741. static struct switch_attr rtl8366rb_globals[] = {
  742. {
  743. .type = SWITCH_TYPE_INT,
  744. .name = "enable_learning",
  745. .description = "Enable learning, enable aging",
  746. .set = rtl8366rb_sw_set_learning_enable,
  747. .get = rtl8366rb_sw_get_learning_enable,
  748. .max = 1
  749. }, {
  750. .type = SWITCH_TYPE_INT,
  751. .name = "enable_vlan",
  752. .description = "Enable VLAN mode",
  753. .set = rtl8366_sw_set_vlan_enable,
  754. .get = rtl8366_sw_get_vlan_enable,
  755. .max = 1,
  756. .ofs = 1
  757. }, {
  758. .type = SWITCH_TYPE_INT,
  759. .name = "enable_vlan4k",
  760. .description = "Enable VLAN 4K mode",
  761. .set = rtl8366_sw_set_vlan_enable,
  762. .get = rtl8366_sw_get_vlan_enable,
  763. .max = 1,
  764. .ofs = 2
  765. }, {
  766. .type = SWITCH_TYPE_NOVAL,
  767. .name = "reset_mibs",
  768. .description = "Reset all MIB counters",
  769. .set = rtl8366rb_sw_reset_mibs,
  770. }, {
  771. .type = SWITCH_TYPE_INT,
  772. .name = "blinkrate",
  773. .description = "Get/Set LED blinking rate (0 = 43ms, 1 = 84ms,"
  774. " 2 = 120ms, 3 = 170ms, 4 = 340ms, 5 = 670ms)",
  775. .set = rtl8366rb_sw_set_blinkrate,
  776. .get = rtl8366rb_sw_get_blinkrate,
  777. .max = 5
  778. }, {
  779. .type = SWITCH_TYPE_INT,
  780. .name = "enable_qos",
  781. .description = "Enable QOS",
  782. .set = rtl8366rb_sw_set_qos_enable,
  783. .get = rtl8366rb_sw_get_qos_enable,
  784. .max = 1
  785. },
  786. };
  787. static struct switch_attr rtl8366rb_port[] = {
  788. {
  789. .type = SWITCH_TYPE_NOVAL,
  790. .name = "reset_mib",
  791. .description = "Reset single port MIB counters",
  792. .set = rtl8366rb_sw_reset_port_mibs,
  793. }, {
  794. .type = SWITCH_TYPE_STRING,
  795. .name = "mib",
  796. .description = "Get MIB counters for port",
  797. .max = 33,
  798. .set = NULL,
  799. .get = rtl8366_sw_get_port_mib,
  800. }, {
  801. .type = SWITCH_TYPE_INT,
  802. .name = "led",
  803. .description = "Get/Set port group (0 - 3) led mode (0 - 15)",
  804. .max = 15,
  805. .set = rtl8366rb_sw_set_port_led,
  806. .get = rtl8366rb_sw_get_port_led,
  807. }, {
  808. .type = SWITCH_TYPE_INT,
  809. .name = "disable",
  810. .description = "Get/Set port state (enabled or disabled)",
  811. .max = 1,
  812. .set = rtl8366rb_sw_set_port_disable,
  813. .get = rtl8366rb_sw_get_port_disable,
  814. }, {
  815. .type = SWITCH_TYPE_INT,
  816. .name = "rate_in",
  817. .description = "Get/Set port ingress (incoming) bandwidth limit in kbps",
  818. .max = RTL8366RB_BDTH_SW_MAX,
  819. .set = rtl8366rb_sw_set_port_rate_in,
  820. .get = rtl8366rb_sw_get_port_rate_in,
  821. }, {
  822. .type = SWITCH_TYPE_INT,
  823. .name = "rate_out",
  824. .description = "Get/Set port egress (outgoing) bandwidth limit in kbps",
  825. .max = RTL8366RB_BDTH_SW_MAX,
  826. .set = rtl8366rb_sw_set_port_rate_out,
  827. .get = rtl8366rb_sw_get_port_rate_out,
  828. },
  829. };
  830. static struct switch_attr rtl8366rb_vlan[] = {
  831. {
  832. .type = SWITCH_TYPE_STRING,
  833. .name = "info",
  834. .description = "Get vlan information",
  835. .max = 1,
  836. .set = NULL,
  837. .get = rtl8366_sw_get_vlan_info,
  838. }, {
  839. .type = SWITCH_TYPE_INT,
  840. .name = "fid",
  841. .description = "Get/Set vlan FID",
  842. .max = RTL8366RB_FIDMAX,
  843. .set = rtl8366_sw_set_vlan_fid,
  844. .get = rtl8366_sw_get_vlan_fid,
  845. },
  846. };
  847. static const struct switch_dev_ops rtl8366_ops = {
  848. .attr_global = {
  849. .attr = rtl8366rb_globals,
  850. .n_attr = ARRAY_SIZE(rtl8366rb_globals),
  851. },
  852. .attr_port = {
  853. .attr = rtl8366rb_port,
  854. .n_attr = ARRAY_SIZE(rtl8366rb_port),
  855. },
  856. .attr_vlan = {
  857. .attr = rtl8366rb_vlan,
  858. .n_attr = ARRAY_SIZE(rtl8366rb_vlan),
  859. },
  860. .get_vlan_ports = rtl8366_sw_get_vlan_ports,
  861. .set_vlan_ports = rtl8366_sw_set_vlan_ports,
  862. .get_port_pvid = rtl8366_sw_get_port_pvid,
  863. .set_port_pvid = rtl8366_sw_set_port_pvid,
  864. .reset_switch = rtl8366_sw_reset_switch,
  865. .get_port_link = rtl8366rb_sw_get_port_link,
  866. };
  867. static int rtl8366rb_switch_init(struct rtl8366_smi *smi)
  868. {
  869. struct switch_dev *dev = &smi->sw_dev;
  870. int err;
  871. dev->name = "RTL8366RB";
  872. dev->cpu_port = RTL8366RB_PORT_NUM_CPU;
  873. dev->ports = RTL8366RB_NUM_PORTS;
  874. dev->vlans = RTL8366RB_NUM_VIDS;
  875. dev->ops = &rtl8366_ops;
  876. dev->alias = dev_name(smi->parent);
  877. err = register_switch(dev, NULL);
  878. if (err)
  879. dev_err(smi->parent, "switch registration failed\n");
  880. return err;
  881. }
  882. static void rtl8366rb_switch_cleanup(struct rtl8366_smi *smi)
  883. {
  884. unregister_switch(&smi->sw_dev);
  885. }
  886. static int rtl8366rb_mii_read(struct mii_bus *bus, int addr, int reg)
  887. {
  888. struct rtl8366_smi *smi = bus->priv;
  889. u32 val = 0;
  890. int err;
  891. err = rtl8366rb_read_phy_reg(smi, addr, 0, reg, &val);
  892. if (err)
  893. return 0xffff;
  894. return val;
  895. }
  896. static int rtl8366rb_mii_write(struct mii_bus *bus, int addr, int reg, u16 val)
  897. {
  898. struct rtl8366_smi *smi = bus->priv;
  899. u32 t;
  900. int err;
  901. err = rtl8366rb_write_phy_reg(smi, addr, 0, reg, val);
  902. /* flush write */
  903. (void) rtl8366rb_read_phy_reg(smi, addr, 0, reg, &t);
  904. return err;
  905. }
  906. static int rtl8366rb_detect(struct rtl8366_smi *smi)
  907. {
  908. u32 chip_id = 0;
  909. u32 chip_ver = 0;
  910. int ret;
  911. ret = rtl8366_smi_read_reg(smi, RTL8366RB_CHIP_ID_REG, &chip_id);
  912. if (ret) {
  913. dev_err(smi->parent, "unable to read chip id\n");
  914. return ret;
  915. }
  916. switch (chip_id) {
  917. case RTL8366RB_CHIP_ID_8366:
  918. break;
  919. default:
  920. dev_err(smi->parent, "unknown chip id (%04x)\n", chip_id);
  921. return -ENODEV;
  922. }
  923. ret = rtl8366_smi_read_reg(smi, RTL8366RB_CHIP_VERSION_CTRL_REG,
  924. &chip_ver);
  925. if (ret) {
  926. dev_err(smi->parent, "unable to read chip version\n");
  927. return ret;
  928. }
  929. dev_info(smi->parent, "RTL%04x ver. %u chip found\n",
  930. chip_id, chip_ver & RTL8366RB_CHIP_VERSION_MASK);
  931. return 0;
  932. }
  933. static struct rtl8366_smi_ops rtl8366rb_smi_ops = {
  934. .detect = rtl8366rb_detect,
  935. .reset_chip = rtl8366rb_reset_chip,
  936. .setup = rtl8366rb_setup,
  937. .mii_read = rtl8366rb_mii_read,
  938. .mii_write = rtl8366rb_mii_write,
  939. .get_vlan_mc = rtl8366rb_get_vlan_mc,
  940. .set_vlan_mc = rtl8366rb_set_vlan_mc,
  941. .get_vlan_4k = rtl8366rb_get_vlan_4k,
  942. .set_vlan_4k = rtl8366rb_set_vlan_4k,
  943. .get_mc_index = rtl8366rb_get_mc_index,
  944. .set_mc_index = rtl8366rb_set_mc_index,
  945. .get_mib_counter = rtl8366rb_get_mib_counter,
  946. .is_vlan_valid = rtl8366rb_is_vlan_valid,
  947. .enable_vlan = rtl8366rb_enable_vlan,
  948. .enable_vlan4k = rtl8366rb_enable_vlan4k,
  949. .enable_port = rtl8366rb_enable_port,
  950. };
  951. static int __devinit rtl8366rb_probe(struct platform_device *pdev)
  952. {
  953. static int rtl8366_smi_version_printed;
  954. struct rtl8366_platform_data *pdata;
  955. struct rtl8366_smi *smi;
  956. int err;
  957. if (!rtl8366_smi_version_printed++)
  958. printk(KERN_NOTICE RTL8366RB_DRIVER_DESC
  959. " version " RTL8366RB_DRIVER_VER"\n");
  960. pdata = pdev->dev.platform_data;
  961. if (!pdata) {
  962. dev_err(&pdev->dev, "no platform data specified\n");
  963. err = -EINVAL;
  964. goto err_out;
  965. }
  966. smi = rtl8366_smi_alloc(&pdev->dev);
  967. if (!smi) {
  968. err = -ENOMEM;
  969. goto err_out;
  970. }
  971. smi->gpio_sda = pdata->gpio_sda;
  972. smi->gpio_sck = pdata->gpio_sck;
  973. smi->hw_reset = pdata->hw_reset;
  974. smi->clk_delay = 10;
  975. smi->cmd_read = 0xa9;
  976. smi->cmd_write = 0xa8;
  977. smi->ops = &rtl8366rb_smi_ops;
  978. smi->cpu_port = RTL8366RB_PORT_NUM_CPU;
  979. smi->num_ports = RTL8366RB_NUM_PORTS;
  980. smi->num_vlan_mc = RTL8366RB_NUM_VLANS;
  981. smi->mib_counters = rtl8366rb_mib_counters;
  982. smi->num_mib_counters = ARRAY_SIZE(rtl8366rb_mib_counters);
  983. err = rtl8366_smi_init(smi);
  984. if (err)
  985. goto err_free_smi;
  986. platform_set_drvdata(pdev, smi);
  987. err = rtl8366rb_switch_init(smi);
  988. if (err)
  989. goto err_clear_drvdata;
  990. return 0;
  991. err_clear_drvdata:
  992. platform_set_drvdata(pdev, NULL);
  993. rtl8366_smi_cleanup(smi);
  994. err_free_smi:
  995. kfree(smi);
  996. err_out:
  997. return err;
  998. }
  999. static int __devexit rtl8366rb_remove(struct platform_device *pdev)
  1000. {
  1001. struct rtl8366_smi *smi = platform_get_drvdata(pdev);
  1002. if (smi) {
  1003. rtl8366rb_switch_cleanup(smi);
  1004. platform_set_drvdata(pdev, NULL);
  1005. rtl8366_smi_cleanup(smi);
  1006. kfree(smi);
  1007. }
  1008. return 0;
  1009. }
  1010. static struct platform_driver rtl8366rb_driver = {
  1011. .driver = {
  1012. .name = RTL8366RB_DRIVER_NAME,
  1013. .owner = THIS_MODULE,
  1014. },
  1015. .probe = rtl8366rb_probe,
  1016. .remove = __devexit_p(rtl8366rb_remove),
  1017. };
  1018. static int __init rtl8366rb_module_init(void)
  1019. {
  1020. return platform_driver_register(&rtl8366rb_driver);
  1021. }
  1022. module_init(rtl8366rb_module_init);
  1023. static void __exit rtl8366rb_module_exit(void)
  1024. {
  1025. platform_driver_unregister(&rtl8366rb_driver);
  1026. }
  1027. module_exit(rtl8366rb_module_exit);
  1028. MODULE_DESCRIPTION(RTL8366RB_DRIVER_DESC);
  1029. MODULE_VERSION(RTL8366RB_DRIVER_VER);
  1030. MODULE_AUTHOR("Gabor Juhos <[email protected]>");
  1031. MODULE_AUTHOR("Antti Seppälä <[email protected]>");
  1032. MODULE_AUTHOR("Roman Yeryomin <[email protected]>");
  1033. MODULE_LICENSE("GPL v2");
  1034. MODULE_ALIAS("platform:" RTL8366RB_DRIVER_NAME);