ftgmac100.c 38 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257
  1. /*
  2. * Faraday FTGMAC100 Gigabit Ethernet
  3. *
  4. * Copyright (C) 2016-2017, IBM Corporation.
  5. *
  6. * Based on Coldfire Fast Ethernet Controller emulation.
  7. *
  8. * Copyright (c) 2007 CodeSourcery.
  9. *
  10. * This code is licensed under the GPL version 2 or later. See the
  11. * COPYING file in the top-level directory.
  12. */
  13. #include "qemu/osdep.h"
  14. #include "hw/irq.h"
  15. #include "hw/net/ftgmac100.h"
  16. #include "sysemu/dma.h"
  17. #include "qapi/error.h"
  18. #include "qemu/log.h"
  19. #include "qemu/module.h"
  20. #include "net/checksum.h"
  21. #include "net/eth.h"
  22. #include "hw/net/mii.h"
  23. #include "hw/qdev-properties.h"
  24. #include "migration/vmstate.h"
  25. /* For crc32 */
  26. #include <zlib.h>
  27. /*
  28. * FTGMAC100 registers
  29. */
  30. #define FTGMAC100_ISR 0x00
  31. #define FTGMAC100_IER 0x04
  32. #define FTGMAC100_MAC_MADR 0x08
  33. #define FTGMAC100_MAC_LADR 0x0c
  34. #define FTGMAC100_MATH0 0x10
  35. #define FTGMAC100_MATH1 0x14
  36. #define FTGMAC100_NPTXPD 0x18
  37. #define FTGMAC100_RXPD 0x1C
  38. #define FTGMAC100_NPTXR_BADR 0x20
  39. #define FTGMAC100_RXR_BADR 0x24
  40. #define FTGMAC100_HPTXPD 0x28
  41. #define FTGMAC100_HPTXR_BADR 0x2c
  42. #define FTGMAC100_ITC 0x30
  43. #define FTGMAC100_APTC 0x34
  44. #define FTGMAC100_DBLAC 0x38
  45. #define FTGMAC100_REVR 0x40
  46. #define FTGMAC100_FEAR1 0x44
  47. #define FTGMAC100_RBSR 0x4c
  48. #define FTGMAC100_TPAFCR 0x48
  49. #define FTGMAC100_MACCR 0x50
  50. #define FTGMAC100_MACSR 0x54
  51. #define FTGMAC100_PHYCR 0x60
  52. #define FTGMAC100_PHYDATA 0x64
  53. #define FTGMAC100_FCR 0x68
  54. /*
  55. * Interrupt status register & interrupt enable register
  56. */
  57. #define FTGMAC100_INT_RPKT_BUF (1 << 0)
  58. #define FTGMAC100_INT_RPKT_FIFO (1 << 1)
  59. #define FTGMAC100_INT_NO_RXBUF (1 << 2)
  60. #define FTGMAC100_INT_RPKT_LOST (1 << 3)
  61. #define FTGMAC100_INT_XPKT_ETH (1 << 4)
  62. #define FTGMAC100_INT_XPKT_FIFO (1 << 5)
  63. #define FTGMAC100_INT_NO_NPTXBUF (1 << 6)
  64. #define FTGMAC100_INT_XPKT_LOST (1 << 7)
  65. #define FTGMAC100_INT_AHB_ERR (1 << 8)
  66. #define FTGMAC100_INT_PHYSTS_CHG (1 << 9)
  67. #define FTGMAC100_INT_NO_HPTXBUF (1 << 10)
  68. /*
  69. * Automatic polling timer control register
  70. */
  71. #define FTGMAC100_APTC_RXPOLL_CNT(x) ((x) & 0xf)
  72. #define FTGMAC100_APTC_RXPOLL_TIME_SEL (1 << 4)
  73. #define FTGMAC100_APTC_TXPOLL_CNT(x) (((x) >> 8) & 0xf)
  74. #define FTGMAC100_APTC_TXPOLL_TIME_SEL (1 << 12)
  75. /*
  76. * PHY control register
  77. */
  78. #define FTGMAC100_PHYCR_MIIRD (1 << 26)
  79. #define FTGMAC100_PHYCR_MIIWR (1 << 27)
  80. #define FTGMAC100_PHYCR_DEV(x) (((x) >> 16) & 0x1f)
  81. #define FTGMAC100_PHYCR_REG(x) (((x) >> 21) & 0x1f)
  82. /*
  83. * PHY data register
  84. */
  85. #define FTGMAC100_PHYDATA_MIIWDATA(x) ((x) & 0xffff)
  86. #define FTGMAC100_PHYDATA_MIIRDATA(x) (((x) >> 16) & 0xffff)
  87. /*
  88. * PHY control register - New MDC/MDIO interface
  89. */
  90. #define FTGMAC100_PHYCR_NEW_DATA(x) (((x) >> 16) & 0xffff)
  91. #define FTGMAC100_PHYCR_NEW_FIRE (1 << 15)
  92. #define FTGMAC100_PHYCR_NEW_ST_22 (1 << 12)
  93. #define FTGMAC100_PHYCR_NEW_OP(x) (((x) >> 10) & 3)
  94. #define FTGMAC100_PHYCR_NEW_OP_WRITE 0x1
  95. #define FTGMAC100_PHYCR_NEW_OP_READ 0x2
  96. #define FTGMAC100_PHYCR_NEW_DEV(x) (((x) >> 5) & 0x1f)
  97. #define FTGMAC100_PHYCR_NEW_REG(x) ((x) & 0x1f)
  98. /*
  99. * Feature Register
  100. */
  101. #define FTGMAC100_REVR_NEW_MDIO_INTERFACE (1 << 31)
  102. /*
  103. * MAC control register
  104. */
  105. #define FTGMAC100_MACCR_TXDMA_EN (1 << 0)
  106. #define FTGMAC100_MACCR_RXDMA_EN (1 << 1)
  107. #define FTGMAC100_MACCR_TXMAC_EN (1 << 2)
  108. #define FTGMAC100_MACCR_RXMAC_EN (1 << 3)
  109. #define FTGMAC100_MACCR_RM_VLAN (1 << 4)
  110. #define FTGMAC100_MACCR_HPTXR_EN (1 << 5)
  111. #define FTGMAC100_MACCR_LOOP_EN (1 << 6)
  112. #define FTGMAC100_MACCR_ENRX_IN_HALFTX (1 << 7)
  113. #define FTGMAC100_MACCR_FULLDUP (1 << 8)
  114. #define FTGMAC100_MACCR_GIGA_MODE (1 << 9)
  115. #define FTGMAC100_MACCR_CRC_APD (1 << 10) /* not needed */
  116. #define FTGMAC100_MACCR_RX_RUNT (1 << 12)
  117. #define FTGMAC100_MACCR_JUMBO_LF (1 << 13)
  118. #define FTGMAC100_MACCR_RX_ALL (1 << 14)
  119. #define FTGMAC100_MACCR_HT_MULTI_EN (1 << 15)
  120. #define FTGMAC100_MACCR_RX_MULTIPKT (1 << 16)
  121. #define FTGMAC100_MACCR_RX_BROADPKT (1 << 17)
  122. #define FTGMAC100_MACCR_DISCARD_CRCERR (1 << 18)
  123. #define FTGMAC100_MACCR_FAST_MODE (1 << 19)
  124. #define FTGMAC100_MACCR_SW_RST (1 << 31)
  125. /*
  126. * Transmit descriptor
  127. */
  128. #define FTGMAC100_TXDES0_TXBUF_SIZE(x) ((x) & 0x3fff)
  129. #define FTGMAC100_TXDES0_EDOTR (1 << 15)
  130. #define FTGMAC100_TXDES0_CRC_ERR (1 << 19)
  131. #define FTGMAC100_TXDES0_LTS (1 << 28)
  132. #define FTGMAC100_TXDES0_FTS (1 << 29)
  133. #define FTGMAC100_TXDES0_EDOTR_ASPEED (1 << 30)
  134. #define FTGMAC100_TXDES0_TXDMA_OWN (1 << 31)
  135. #define FTGMAC100_TXDES1_VLANTAG_CI(x) ((x) & 0xffff)
  136. #define FTGMAC100_TXDES1_INS_VLANTAG (1 << 16)
  137. #define FTGMAC100_TXDES1_TCP_CHKSUM (1 << 17)
  138. #define FTGMAC100_TXDES1_UDP_CHKSUM (1 << 18)
  139. #define FTGMAC100_TXDES1_IP_CHKSUM (1 << 19)
  140. #define FTGMAC100_TXDES1_LLC (1 << 22)
  141. #define FTGMAC100_TXDES1_TX2FIC (1 << 30)
  142. #define FTGMAC100_TXDES1_TXIC (1 << 31)
  143. /*
  144. * Receive descriptor
  145. */
  146. #define FTGMAC100_RXDES0_VDBC 0x3fff
  147. #define FTGMAC100_RXDES0_EDORR (1 << 15)
  148. #define FTGMAC100_RXDES0_MULTICAST (1 << 16)
  149. #define FTGMAC100_RXDES0_BROADCAST (1 << 17)
  150. #define FTGMAC100_RXDES0_RX_ERR (1 << 18)
  151. #define FTGMAC100_RXDES0_CRC_ERR (1 << 19)
  152. #define FTGMAC100_RXDES0_FTL (1 << 20)
  153. #define FTGMAC100_RXDES0_RUNT (1 << 21)
  154. #define FTGMAC100_RXDES0_RX_ODD_NB (1 << 22)
  155. #define FTGMAC100_RXDES0_FIFO_FULL (1 << 23)
  156. #define FTGMAC100_RXDES0_PAUSE_OPCODE (1 << 24)
  157. #define FTGMAC100_RXDES0_PAUSE_FRAME (1 << 25)
  158. #define FTGMAC100_RXDES0_LRS (1 << 28)
  159. #define FTGMAC100_RXDES0_FRS (1 << 29)
  160. #define FTGMAC100_RXDES0_EDORR_ASPEED (1 << 30)
  161. #define FTGMAC100_RXDES0_RXPKT_RDY (1 << 31)
  162. #define FTGMAC100_RXDES1_VLANTAG_CI 0xffff
  163. #define FTGMAC100_RXDES1_PROT_MASK (0x3 << 20)
  164. #define FTGMAC100_RXDES1_PROT_NONIP (0x0 << 20)
  165. #define FTGMAC100_RXDES1_PROT_IP (0x1 << 20)
  166. #define FTGMAC100_RXDES1_PROT_TCPIP (0x2 << 20)
  167. #define FTGMAC100_RXDES1_PROT_UDPIP (0x3 << 20)
  168. #define FTGMAC100_RXDES1_LLC (1 << 22)
  169. #define FTGMAC100_RXDES1_DF (1 << 23)
  170. #define FTGMAC100_RXDES1_VLANTAG_AVAIL (1 << 24)
  171. #define FTGMAC100_RXDES1_TCP_CHKSUM_ERR (1 << 25)
  172. #define FTGMAC100_RXDES1_UDP_CHKSUM_ERR (1 << 26)
  173. #define FTGMAC100_RXDES1_IP_CHKSUM_ERR (1 << 27)
  174. /*
  175. * Receive and transmit Buffer Descriptor
  176. */
  177. typedef struct {
  178. uint32_t des0;
  179. uint32_t des1;
  180. uint32_t des2; /* not used by HW */
  181. uint32_t des3;
  182. } FTGMAC100Desc;
  183. /*
  184. * Specific RTL8211E MII Registers
  185. */
  186. #define RTL8211E_MII_PHYCR 16 /* PHY Specific Control */
  187. #define RTL8211E_MII_PHYSR 17 /* PHY Specific Status */
  188. #define RTL8211E_MII_INER 18 /* Interrupt Enable */
  189. #define RTL8211E_MII_INSR 19 /* Interrupt Status */
  190. #define RTL8211E_MII_RXERC 24 /* Receive Error Counter */
  191. #define RTL8211E_MII_LDPSR 27 /* Link Down Power Saving */
  192. #define RTL8211E_MII_EPAGSR 30 /* Extension Page Select */
  193. #define RTL8211E_MII_PAGSEL 31 /* Page Select */
  194. /*
  195. * RTL8211E Interrupt Status
  196. */
  197. #define PHY_INT_AUTONEG_ERROR (1 << 15)
  198. #define PHY_INT_PAGE_RECV (1 << 12)
  199. #define PHY_INT_AUTONEG_COMPLETE (1 << 11)
  200. #define PHY_INT_LINK_STATUS (1 << 10)
  201. #define PHY_INT_ERROR (1 << 9)
  202. #define PHY_INT_DOWN (1 << 8)
  203. #define PHY_INT_JABBER (1 << 0)
  204. /*
  205. * Max frame size for the receiving buffer
  206. */
  207. #define FTGMAC100_MAX_FRAME_SIZE 9220
  208. /* Limits depending on the type of the frame
  209. *
  210. * 9216 for Jumbo frames (+ 4 for VLAN)
  211. * 1518 for other frames (+ 4 for VLAN)
  212. */
  213. static int ftgmac100_max_frame_size(FTGMAC100State *s, uint16_t proto)
  214. {
  215. int max = (s->maccr & FTGMAC100_MACCR_JUMBO_LF ? 9216 : 1518);
  216. return max + (proto == ETH_P_VLAN ? 4 : 0);
  217. }
  218. static void ftgmac100_update_irq(FTGMAC100State *s)
  219. {
  220. qemu_set_irq(s->irq, s->isr & s->ier);
  221. }
  222. /*
  223. * The MII phy could raise a GPIO to the processor which in turn
  224. * could be handled as an interrpt by the OS.
  225. * For now we don't handle any GPIO/interrupt line, so the OS will
  226. * have to poll for the PHY status.
  227. */
  228. static void phy_update_irq(FTGMAC100State *s)
  229. {
  230. ftgmac100_update_irq(s);
  231. }
  232. static void phy_update_link(FTGMAC100State *s)
  233. {
  234. /* Autonegotiation status mirrors link status. */
  235. if (qemu_get_queue(s->nic)->link_down) {
  236. s->phy_status &= ~(MII_BMSR_LINK_ST | MII_BMSR_AN_COMP);
  237. s->phy_int |= PHY_INT_DOWN;
  238. } else {
  239. s->phy_status |= (MII_BMSR_LINK_ST | MII_BMSR_AN_COMP);
  240. s->phy_int |= PHY_INT_AUTONEG_COMPLETE;
  241. }
  242. phy_update_irq(s);
  243. }
  244. static void ftgmac100_set_link(NetClientState *nc)
  245. {
  246. phy_update_link(FTGMAC100(qemu_get_nic_opaque(nc)));
  247. }
  248. static void phy_reset(FTGMAC100State *s)
  249. {
  250. s->phy_status = (MII_BMSR_100TX_FD | MII_BMSR_100TX_HD | MII_BMSR_10T_FD |
  251. MII_BMSR_10T_HD | MII_BMSR_EXTSTAT | MII_BMSR_MFPS |
  252. MII_BMSR_AN_COMP | MII_BMSR_AUTONEG | MII_BMSR_LINK_ST |
  253. MII_BMSR_EXTCAP);
  254. s->phy_control = (MII_BMCR_AUTOEN | MII_BMCR_FD | MII_BMCR_SPEED1000);
  255. s->phy_advertise = (MII_ANAR_PAUSE_ASYM | MII_ANAR_PAUSE | MII_ANAR_TXFD |
  256. MII_ANAR_TX | MII_ANAR_10FD | MII_ANAR_10 |
  257. MII_ANAR_CSMACD);
  258. s->phy_int_mask = 0;
  259. s->phy_int = 0;
  260. }
  261. static uint16_t do_phy_read(FTGMAC100State *s, uint8_t reg)
  262. {
  263. uint16_t val;
  264. switch (reg) {
  265. case MII_BMCR: /* Basic Control */
  266. val = s->phy_control;
  267. break;
  268. case MII_BMSR: /* Basic Status */
  269. val = s->phy_status;
  270. break;
  271. case MII_PHYID1: /* ID1 */
  272. val = RTL8211E_PHYID1;
  273. break;
  274. case MII_PHYID2: /* ID2 */
  275. val = RTL8211E_PHYID2;
  276. break;
  277. case MII_ANAR: /* Auto-neg advertisement */
  278. val = s->phy_advertise;
  279. break;
  280. case MII_ANLPAR: /* Auto-neg Link Partner Ability */
  281. val = (MII_ANLPAR_ACK | MII_ANLPAR_PAUSE | MII_ANLPAR_TXFD |
  282. MII_ANLPAR_TX | MII_ANLPAR_10FD | MII_ANLPAR_10 |
  283. MII_ANLPAR_CSMACD);
  284. break;
  285. case MII_ANER: /* Auto-neg Expansion */
  286. val = MII_ANER_NWAY;
  287. break;
  288. case MII_CTRL1000: /* 1000BASE-T control */
  289. val = (MII_CTRL1000_HALF | MII_CTRL1000_FULL);
  290. break;
  291. case MII_STAT1000: /* 1000BASE-T status */
  292. val = MII_STAT1000_FULL;
  293. break;
  294. case RTL8211E_MII_INSR: /* Interrupt status. */
  295. val = s->phy_int;
  296. s->phy_int = 0;
  297. phy_update_irq(s);
  298. break;
  299. case RTL8211E_MII_INER: /* Interrupt enable */
  300. val = s->phy_int_mask;
  301. break;
  302. case RTL8211E_MII_PHYCR:
  303. case RTL8211E_MII_PHYSR:
  304. case RTL8211E_MII_RXERC:
  305. case RTL8211E_MII_LDPSR:
  306. case RTL8211E_MII_EPAGSR:
  307. case RTL8211E_MII_PAGSEL:
  308. qemu_log_mask(LOG_UNIMP, "%s: reg %d not implemented\n",
  309. __func__, reg);
  310. val = 0;
  311. break;
  312. default:
  313. qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad address at offset %d\n",
  314. __func__, reg);
  315. val = 0;
  316. break;
  317. }
  318. return val;
  319. }
  320. #define MII_BMCR_MASK (MII_BMCR_LOOPBACK | MII_BMCR_SPEED100 | \
  321. MII_BMCR_SPEED | MII_BMCR_AUTOEN | MII_BMCR_PDOWN | \
  322. MII_BMCR_FD | MII_BMCR_CTST)
  323. #define MII_ANAR_MASK 0x2d7f
  324. static void do_phy_write(FTGMAC100State *s, uint8_t reg, uint16_t val)
  325. {
  326. switch (reg) {
  327. case MII_BMCR: /* Basic Control */
  328. if (val & MII_BMCR_RESET) {
  329. phy_reset(s);
  330. } else {
  331. s->phy_control = val & MII_BMCR_MASK;
  332. /* Complete autonegotiation immediately. */
  333. if (val & MII_BMCR_AUTOEN) {
  334. s->phy_status |= MII_BMSR_AN_COMP;
  335. }
  336. }
  337. break;
  338. case MII_ANAR: /* Auto-neg advertisement */
  339. s->phy_advertise = (val & MII_ANAR_MASK) | MII_ANAR_TX;
  340. break;
  341. case RTL8211E_MII_INER: /* Interrupt enable */
  342. s->phy_int_mask = val & 0xff;
  343. phy_update_irq(s);
  344. break;
  345. case RTL8211E_MII_PHYCR:
  346. case RTL8211E_MII_PHYSR:
  347. case RTL8211E_MII_RXERC:
  348. case RTL8211E_MII_LDPSR:
  349. case RTL8211E_MII_EPAGSR:
  350. case RTL8211E_MII_PAGSEL:
  351. qemu_log_mask(LOG_UNIMP, "%s: reg %d not implemented\n",
  352. __func__, reg);
  353. break;
  354. default:
  355. qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad address at offset %d\n",
  356. __func__, reg);
  357. break;
  358. }
  359. }
  360. static void do_phy_new_ctl(FTGMAC100State *s)
  361. {
  362. uint8_t reg;
  363. uint16_t data;
  364. if (!(s->phycr & FTGMAC100_PHYCR_NEW_ST_22)) {
  365. qemu_log_mask(LOG_UNIMP, "%s: unsupported ST code\n", __func__);
  366. return;
  367. }
  368. /* Nothing to do */
  369. if (!(s->phycr & FTGMAC100_PHYCR_NEW_FIRE)) {
  370. return;
  371. }
  372. reg = FTGMAC100_PHYCR_NEW_REG(s->phycr);
  373. data = FTGMAC100_PHYCR_NEW_DATA(s->phycr);
  374. switch (FTGMAC100_PHYCR_NEW_OP(s->phycr)) {
  375. case FTGMAC100_PHYCR_NEW_OP_WRITE:
  376. do_phy_write(s, reg, data);
  377. break;
  378. case FTGMAC100_PHYCR_NEW_OP_READ:
  379. s->phydata = do_phy_read(s, reg) & 0xffff;
  380. break;
  381. default:
  382. qemu_log_mask(LOG_GUEST_ERROR, "%s: invalid OP code %08x\n",
  383. __func__, s->phycr);
  384. }
  385. s->phycr &= ~FTGMAC100_PHYCR_NEW_FIRE;
  386. }
  387. static void do_phy_ctl(FTGMAC100State *s)
  388. {
  389. uint8_t reg = FTGMAC100_PHYCR_REG(s->phycr);
  390. if (s->phycr & FTGMAC100_PHYCR_MIIWR) {
  391. do_phy_write(s, reg, s->phydata & 0xffff);
  392. s->phycr &= ~FTGMAC100_PHYCR_MIIWR;
  393. } else if (s->phycr & FTGMAC100_PHYCR_MIIRD) {
  394. s->phydata = do_phy_read(s, reg) << 16;
  395. s->phycr &= ~FTGMAC100_PHYCR_MIIRD;
  396. } else {
  397. qemu_log_mask(LOG_GUEST_ERROR, "%s: no OP code %08x\n",
  398. __func__, s->phycr);
  399. }
  400. }
  401. static int ftgmac100_read_bd(FTGMAC100Desc *bd, dma_addr_t addr)
  402. {
  403. if (dma_memory_read(&address_space_memory, addr, bd, sizeof(*bd))) {
  404. qemu_log_mask(LOG_GUEST_ERROR, "%s: failed to read descriptor @ 0x%"
  405. HWADDR_PRIx "\n", __func__, addr);
  406. return -1;
  407. }
  408. bd->des0 = le32_to_cpu(bd->des0);
  409. bd->des1 = le32_to_cpu(bd->des1);
  410. bd->des2 = le32_to_cpu(bd->des2);
  411. bd->des3 = le32_to_cpu(bd->des3);
  412. return 0;
  413. }
  414. static int ftgmac100_write_bd(FTGMAC100Desc *bd, dma_addr_t addr)
  415. {
  416. FTGMAC100Desc lebd;
  417. lebd.des0 = cpu_to_le32(bd->des0);
  418. lebd.des1 = cpu_to_le32(bd->des1);
  419. lebd.des2 = cpu_to_le32(bd->des2);
  420. lebd.des3 = cpu_to_le32(bd->des3);
  421. if (dma_memory_write(&address_space_memory, addr, &lebd, sizeof(lebd))) {
  422. qemu_log_mask(LOG_GUEST_ERROR, "%s: failed to write descriptor @ 0x%"
  423. HWADDR_PRIx "\n", __func__, addr);
  424. return -1;
  425. }
  426. return 0;
  427. }
  428. static void ftgmac100_do_tx(FTGMAC100State *s, uint32_t tx_ring,
  429. uint32_t tx_descriptor)
  430. {
  431. int frame_size = 0;
  432. uint8_t *ptr = s->frame;
  433. uint32_t addr = tx_descriptor;
  434. uint32_t flags = 0;
  435. while (1) {
  436. FTGMAC100Desc bd;
  437. int len;
  438. if (ftgmac100_read_bd(&bd, addr) ||
  439. ((bd.des0 & FTGMAC100_TXDES0_TXDMA_OWN) == 0)) {
  440. /* Run out of descriptors to transmit. */
  441. s->isr |= FTGMAC100_INT_NO_NPTXBUF;
  442. break;
  443. }
  444. /* record transmit flags as they are valid only on the first
  445. * segment */
  446. if (bd.des0 & FTGMAC100_TXDES0_FTS) {
  447. flags = bd.des1;
  448. }
  449. len = FTGMAC100_TXDES0_TXBUF_SIZE(bd.des0);
  450. if (frame_size + len > sizeof(s->frame)) {
  451. qemu_log_mask(LOG_GUEST_ERROR, "%s: frame too big : %d bytes\n",
  452. __func__, len);
  453. s->isr |= FTGMAC100_INT_XPKT_LOST;
  454. len = sizeof(s->frame) - frame_size;
  455. }
  456. if (dma_memory_read(&address_space_memory, bd.des3, ptr, len)) {
  457. qemu_log_mask(LOG_GUEST_ERROR, "%s: failed to read packet @ 0x%x\n",
  458. __func__, bd.des3);
  459. s->isr |= FTGMAC100_INT_NO_NPTXBUF;
  460. break;
  461. }
  462. /* Check for VLAN */
  463. if (bd.des0 & FTGMAC100_TXDES0_FTS &&
  464. bd.des1 & FTGMAC100_TXDES1_INS_VLANTAG &&
  465. be16_to_cpu(PKT_GET_ETH_HDR(ptr)->h_proto) != ETH_P_VLAN) {
  466. if (frame_size + len + 4 > sizeof(s->frame)) {
  467. qemu_log_mask(LOG_GUEST_ERROR, "%s: frame too big : %d bytes\n",
  468. __func__, len);
  469. s->isr |= FTGMAC100_INT_XPKT_LOST;
  470. len = sizeof(s->frame) - frame_size - 4;
  471. }
  472. memmove(ptr + 16, ptr + 12, len - 12);
  473. stw_be_p(ptr + 12, ETH_P_VLAN);
  474. stw_be_p(ptr + 14, bd.des1);
  475. len += 4;
  476. }
  477. ptr += len;
  478. frame_size += len;
  479. if (bd.des0 & FTGMAC100_TXDES0_LTS) {
  480. if (flags & FTGMAC100_TXDES1_IP_CHKSUM) {
  481. net_checksum_calculate(s->frame, frame_size);
  482. }
  483. /* Last buffer in frame. */
  484. qemu_send_packet(qemu_get_queue(s->nic), s->frame, frame_size);
  485. ptr = s->frame;
  486. frame_size = 0;
  487. if (flags & FTGMAC100_TXDES1_TXIC) {
  488. s->isr |= FTGMAC100_INT_XPKT_ETH;
  489. }
  490. }
  491. if (flags & FTGMAC100_TXDES1_TX2FIC) {
  492. s->isr |= FTGMAC100_INT_XPKT_FIFO;
  493. }
  494. bd.des0 &= ~FTGMAC100_TXDES0_TXDMA_OWN;
  495. /* Write back the modified descriptor. */
  496. ftgmac100_write_bd(&bd, addr);
  497. /* Advance to the next descriptor. */
  498. if (bd.des0 & s->txdes0_edotr) {
  499. addr = tx_ring;
  500. } else {
  501. addr += sizeof(FTGMAC100Desc);
  502. }
  503. }
  504. s->tx_descriptor = addr;
  505. ftgmac100_update_irq(s);
  506. }
  507. static int ftgmac100_can_receive(NetClientState *nc)
  508. {
  509. FTGMAC100State *s = FTGMAC100(qemu_get_nic_opaque(nc));
  510. FTGMAC100Desc bd;
  511. if ((s->maccr & (FTGMAC100_MACCR_RXDMA_EN | FTGMAC100_MACCR_RXMAC_EN))
  512. != (FTGMAC100_MACCR_RXDMA_EN | FTGMAC100_MACCR_RXMAC_EN)) {
  513. return 0;
  514. }
  515. if (ftgmac100_read_bd(&bd, s->rx_descriptor)) {
  516. return 0;
  517. }
  518. return !(bd.des0 & FTGMAC100_RXDES0_RXPKT_RDY);
  519. }
  520. /*
  521. * This is purely informative. The HW can poll the RW (and RX) ring
  522. * buffers for available descriptors but we don't need to trigger a
  523. * timer for that in qemu.
  524. */
  525. static uint32_t ftgmac100_rxpoll(FTGMAC100State *s)
  526. {
  527. /* Polling times :
  528. *
  529. * Speed TIME_SEL=0 TIME_SEL=1
  530. *
  531. * 10 51.2 ms 819.2 ms
  532. * 100 5.12 ms 81.92 ms
  533. * 1000 1.024 ms 16.384 ms
  534. */
  535. static const int div[] = { 20, 200, 1000 };
  536. uint32_t cnt = 1024 * FTGMAC100_APTC_RXPOLL_CNT(s->aptcr);
  537. uint32_t speed = (s->maccr & FTGMAC100_MACCR_FAST_MODE) ? 1 : 0;
  538. if (s->aptcr & FTGMAC100_APTC_RXPOLL_TIME_SEL) {
  539. cnt <<= 4;
  540. }
  541. if (s->maccr & FTGMAC100_MACCR_GIGA_MODE) {
  542. speed = 2;
  543. }
  544. return cnt / div[speed];
  545. }
  546. static void ftgmac100_reset(DeviceState *d)
  547. {
  548. FTGMAC100State *s = FTGMAC100(d);
  549. /* Reset the FTGMAC100 */
  550. s->isr = 0;
  551. s->ier = 0;
  552. s->rx_enabled = 0;
  553. s->rx_ring = 0;
  554. s->rbsr = 0x640;
  555. s->rx_descriptor = 0;
  556. s->tx_ring = 0;
  557. s->tx_descriptor = 0;
  558. s->math[0] = 0;
  559. s->math[1] = 0;
  560. s->itc = 0;
  561. s->aptcr = 1;
  562. s->dblac = 0x00022f00;
  563. s->revr = 0;
  564. s->fear1 = 0;
  565. s->tpafcr = 0xf1;
  566. s->maccr = 0;
  567. s->phycr = 0;
  568. s->phydata = 0;
  569. s->fcr = 0x400;
  570. /* and the PHY */
  571. phy_reset(s);
  572. }
  573. static uint64_t ftgmac100_read(void *opaque, hwaddr addr, unsigned size)
  574. {
  575. FTGMAC100State *s = FTGMAC100(opaque);
  576. switch (addr & 0xff) {
  577. case FTGMAC100_ISR:
  578. return s->isr;
  579. case FTGMAC100_IER:
  580. return s->ier;
  581. case FTGMAC100_MAC_MADR:
  582. return (s->conf.macaddr.a[0] << 8) | s->conf.macaddr.a[1];
  583. case FTGMAC100_MAC_LADR:
  584. return ((uint32_t) s->conf.macaddr.a[2] << 24) |
  585. (s->conf.macaddr.a[3] << 16) | (s->conf.macaddr.a[4] << 8) |
  586. s->conf.macaddr.a[5];
  587. case FTGMAC100_MATH0:
  588. return s->math[0];
  589. case FTGMAC100_MATH1:
  590. return s->math[1];
  591. case FTGMAC100_ITC:
  592. return s->itc;
  593. case FTGMAC100_DBLAC:
  594. return s->dblac;
  595. case FTGMAC100_REVR:
  596. return s->revr;
  597. case FTGMAC100_FEAR1:
  598. return s->fear1;
  599. case FTGMAC100_TPAFCR:
  600. return s->tpafcr;
  601. case FTGMAC100_FCR:
  602. return s->fcr;
  603. case FTGMAC100_MACCR:
  604. return s->maccr;
  605. case FTGMAC100_PHYCR:
  606. return s->phycr;
  607. case FTGMAC100_PHYDATA:
  608. return s->phydata;
  609. /* We might want to support these one day */
  610. case FTGMAC100_HPTXPD: /* High Priority Transmit Poll Demand */
  611. case FTGMAC100_HPTXR_BADR: /* High Priority Transmit Ring Base Address */
  612. case FTGMAC100_MACSR: /* MAC Status Register (MACSR) */
  613. qemu_log_mask(LOG_UNIMP, "%s: read to unimplemented register 0x%"
  614. HWADDR_PRIx "\n", __func__, addr);
  615. return 0;
  616. default:
  617. qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad address at offset 0x%"
  618. HWADDR_PRIx "\n", __func__, addr);
  619. return 0;
  620. }
  621. }
  622. static void ftgmac100_write(void *opaque, hwaddr addr,
  623. uint64_t value, unsigned size)
  624. {
  625. FTGMAC100State *s = FTGMAC100(opaque);
  626. switch (addr & 0xff) {
  627. case FTGMAC100_ISR: /* Interrupt status */
  628. s->isr &= ~value;
  629. break;
  630. case FTGMAC100_IER: /* Interrupt control */
  631. s->ier = value;
  632. break;
  633. case FTGMAC100_MAC_MADR: /* MAC */
  634. s->conf.macaddr.a[0] = value >> 8;
  635. s->conf.macaddr.a[1] = value;
  636. break;
  637. case FTGMAC100_MAC_LADR:
  638. s->conf.macaddr.a[2] = value >> 24;
  639. s->conf.macaddr.a[3] = value >> 16;
  640. s->conf.macaddr.a[4] = value >> 8;
  641. s->conf.macaddr.a[5] = value;
  642. break;
  643. case FTGMAC100_MATH0: /* Multicast Address Hash Table 0 */
  644. s->math[0] = value;
  645. break;
  646. case FTGMAC100_MATH1: /* Multicast Address Hash Table 1 */
  647. s->math[1] = value;
  648. break;
  649. case FTGMAC100_ITC: /* TODO: Interrupt Timer Control */
  650. s->itc = value;
  651. break;
  652. case FTGMAC100_RXR_BADR: /* Ring buffer address */
  653. s->rx_ring = value;
  654. s->rx_descriptor = s->rx_ring;
  655. break;
  656. case FTGMAC100_RBSR: /* DMA buffer size */
  657. s->rbsr = value;
  658. break;
  659. case FTGMAC100_NPTXR_BADR: /* Transmit buffer address */
  660. s->tx_ring = value;
  661. s->tx_descriptor = s->tx_ring;
  662. break;
  663. case FTGMAC100_NPTXPD: /* Trigger transmit */
  664. if ((s->maccr & (FTGMAC100_MACCR_TXDMA_EN | FTGMAC100_MACCR_TXMAC_EN))
  665. == (FTGMAC100_MACCR_TXDMA_EN | FTGMAC100_MACCR_TXMAC_EN)) {
  666. /* TODO: high priority tx ring */
  667. ftgmac100_do_tx(s, s->tx_ring, s->tx_descriptor);
  668. }
  669. if (ftgmac100_can_receive(qemu_get_queue(s->nic))) {
  670. qemu_flush_queued_packets(qemu_get_queue(s->nic));
  671. }
  672. break;
  673. case FTGMAC100_RXPD: /* Receive Poll Demand Register */
  674. if (ftgmac100_can_receive(qemu_get_queue(s->nic))) {
  675. qemu_flush_queued_packets(qemu_get_queue(s->nic));
  676. }
  677. break;
  678. case FTGMAC100_APTC: /* Automatic polling */
  679. s->aptcr = value;
  680. if (FTGMAC100_APTC_RXPOLL_CNT(s->aptcr)) {
  681. ftgmac100_rxpoll(s);
  682. }
  683. if (FTGMAC100_APTC_TXPOLL_CNT(s->aptcr)) {
  684. qemu_log_mask(LOG_UNIMP, "%s: no transmit polling\n", __func__);
  685. }
  686. break;
  687. case FTGMAC100_MACCR: /* MAC Device control */
  688. s->maccr = value;
  689. if (value & FTGMAC100_MACCR_SW_RST) {
  690. ftgmac100_reset(DEVICE(s));
  691. }
  692. if (ftgmac100_can_receive(qemu_get_queue(s->nic))) {
  693. qemu_flush_queued_packets(qemu_get_queue(s->nic));
  694. }
  695. break;
  696. case FTGMAC100_PHYCR: /* PHY Device control */
  697. s->phycr = value;
  698. if (s->revr & FTGMAC100_REVR_NEW_MDIO_INTERFACE) {
  699. do_phy_new_ctl(s);
  700. } else {
  701. do_phy_ctl(s);
  702. }
  703. break;
  704. case FTGMAC100_PHYDATA:
  705. s->phydata = value & 0xffff;
  706. break;
  707. case FTGMAC100_DBLAC: /* DMA Burst Length and Arbitration Control */
  708. s->dblac = value;
  709. break;
  710. case FTGMAC100_REVR: /* Feature Register */
  711. s->revr = value;
  712. break;
  713. case FTGMAC100_FEAR1: /* Feature Register 1 */
  714. s->fear1 = value;
  715. break;
  716. case FTGMAC100_TPAFCR: /* Transmit Priority Arbitration and FIFO Control */
  717. s->tpafcr = value;
  718. break;
  719. case FTGMAC100_FCR: /* Flow Control */
  720. s->fcr = value;
  721. break;
  722. case FTGMAC100_HPTXPD: /* High Priority Transmit Poll Demand */
  723. case FTGMAC100_HPTXR_BADR: /* High Priority Transmit Ring Base Address */
  724. case FTGMAC100_MACSR: /* MAC Status Register (MACSR) */
  725. qemu_log_mask(LOG_UNIMP, "%s: write to unimplemented register 0x%"
  726. HWADDR_PRIx "\n", __func__, addr);
  727. break;
  728. default:
  729. qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad address at offset 0x%"
  730. HWADDR_PRIx "\n", __func__, addr);
  731. break;
  732. }
  733. ftgmac100_update_irq(s);
  734. }
  735. static int ftgmac100_filter(FTGMAC100State *s, const uint8_t *buf, size_t len)
  736. {
  737. unsigned mcast_idx;
  738. if (s->maccr & FTGMAC100_MACCR_RX_ALL) {
  739. return 1;
  740. }
  741. switch (get_eth_packet_type(PKT_GET_ETH_HDR(buf))) {
  742. case ETH_PKT_BCAST:
  743. if (!(s->maccr & FTGMAC100_MACCR_RX_BROADPKT)) {
  744. return 0;
  745. }
  746. break;
  747. case ETH_PKT_MCAST:
  748. if (!(s->maccr & FTGMAC100_MACCR_RX_MULTIPKT)) {
  749. if (!(s->maccr & FTGMAC100_MACCR_HT_MULTI_EN)) {
  750. return 0;
  751. }
  752. mcast_idx = net_crc32_le(buf, ETH_ALEN);
  753. mcast_idx = (~(mcast_idx >> 2)) & 0x3f;
  754. if (!(s->math[mcast_idx / 32] & (1 << (mcast_idx % 32)))) {
  755. return 0;
  756. }
  757. }
  758. break;
  759. case ETH_PKT_UCAST:
  760. if (memcmp(s->conf.macaddr.a, buf, 6)) {
  761. return 0;
  762. }
  763. break;
  764. }
  765. return 1;
  766. }
  767. static ssize_t ftgmac100_receive(NetClientState *nc, const uint8_t *buf,
  768. size_t len)
  769. {
  770. FTGMAC100State *s = FTGMAC100(qemu_get_nic_opaque(nc));
  771. FTGMAC100Desc bd;
  772. uint32_t flags = 0;
  773. uint32_t addr;
  774. uint32_t crc;
  775. uint32_t buf_addr;
  776. uint8_t *crc_ptr;
  777. uint32_t buf_len;
  778. size_t size = len;
  779. uint32_t first = FTGMAC100_RXDES0_FRS;
  780. uint16_t proto = be16_to_cpu(PKT_GET_ETH_HDR(buf)->h_proto);
  781. int max_frame_size = ftgmac100_max_frame_size(s, proto);
  782. if ((s->maccr & (FTGMAC100_MACCR_RXDMA_EN | FTGMAC100_MACCR_RXMAC_EN))
  783. != (FTGMAC100_MACCR_RXDMA_EN | FTGMAC100_MACCR_RXMAC_EN)) {
  784. return -1;
  785. }
  786. /* TODO : Pad to minimum Ethernet frame length */
  787. /* handle small packets. */
  788. if (size < 10) {
  789. qemu_log_mask(LOG_GUEST_ERROR, "%s: dropped frame of %zd bytes\n",
  790. __func__, size);
  791. return size;
  792. }
  793. if (!ftgmac100_filter(s, buf, size)) {
  794. return size;
  795. }
  796. /* 4 bytes for the CRC. */
  797. size += 4;
  798. crc = cpu_to_be32(crc32(~0, buf, size));
  799. crc_ptr = (uint8_t *) &crc;
  800. /* Huge frames are truncated. */
  801. if (size > max_frame_size) {
  802. qemu_log_mask(LOG_GUEST_ERROR, "%s: frame too big : %zd bytes\n",
  803. __func__, size);
  804. size = max_frame_size;
  805. flags |= FTGMAC100_RXDES0_FTL;
  806. }
  807. switch (get_eth_packet_type(PKT_GET_ETH_HDR(buf))) {
  808. case ETH_PKT_BCAST:
  809. flags |= FTGMAC100_RXDES0_BROADCAST;
  810. break;
  811. case ETH_PKT_MCAST:
  812. flags |= FTGMAC100_RXDES0_MULTICAST;
  813. break;
  814. case ETH_PKT_UCAST:
  815. break;
  816. }
  817. addr = s->rx_descriptor;
  818. while (size > 0) {
  819. if (!ftgmac100_can_receive(nc)) {
  820. qemu_log_mask(LOG_GUEST_ERROR, "%s: Unexpected packet\n", __func__);
  821. return -1;
  822. }
  823. if (ftgmac100_read_bd(&bd, addr) ||
  824. (bd.des0 & FTGMAC100_RXDES0_RXPKT_RDY)) {
  825. /* No descriptors available. Bail out. */
  826. qemu_log_mask(LOG_GUEST_ERROR, "%s: Lost end of frame\n",
  827. __func__);
  828. s->isr |= FTGMAC100_INT_NO_RXBUF;
  829. break;
  830. }
  831. buf_len = (size <= s->rbsr) ? size : s->rbsr;
  832. bd.des0 |= buf_len & 0x3fff;
  833. size -= buf_len;
  834. /* The last 4 bytes are the CRC. */
  835. if (size < 4) {
  836. buf_len += size - 4;
  837. }
  838. buf_addr = bd.des3;
  839. if (first && proto == ETH_P_VLAN && buf_len >= 18) {
  840. bd.des1 = lduw_be_p(buf + 14) | FTGMAC100_RXDES1_VLANTAG_AVAIL;
  841. if (s->maccr & FTGMAC100_MACCR_RM_VLAN) {
  842. dma_memory_write(&address_space_memory, buf_addr, buf, 12);
  843. dma_memory_write(&address_space_memory, buf_addr + 12, buf + 16,
  844. buf_len - 16);
  845. } else {
  846. dma_memory_write(&address_space_memory, buf_addr, buf, buf_len);
  847. }
  848. } else {
  849. bd.des1 = 0;
  850. dma_memory_write(&address_space_memory, buf_addr, buf, buf_len);
  851. }
  852. buf += buf_len;
  853. if (size < 4) {
  854. dma_memory_write(&address_space_memory, buf_addr + buf_len,
  855. crc_ptr, 4 - size);
  856. crc_ptr += 4 - size;
  857. }
  858. bd.des0 |= first | FTGMAC100_RXDES0_RXPKT_RDY;
  859. first = 0;
  860. if (size == 0) {
  861. /* Last buffer in frame. */
  862. bd.des0 |= flags | FTGMAC100_RXDES0_LRS;
  863. s->isr |= FTGMAC100_INT_RPKT_BUF;
  864. } else {
  865. s->isr |= FTGMAC100_INT_RPKT_FIFO;
  866. }
  867. ftgmac100_write_bd(&bd, addr);
  868. if (bd.des0 & s->rxdes0_edorr) {
  869. addr = s->rx_ring;
  870. } else {
  871. addr += sizeof(FTGMAC100Desc);
  872. }
  873. }
  874. s->rx_descriptor = addr;
  875. ftgmac100_update_irq(s);
  876. return len;
  877. }
  878. static const MemoryRegionOps ftgmac100_ops = {
  879. .read = ftgmac100_read,
  880. .write = ftgmac100_write,
  881. .valid.min_access_size = 4,
  882. .valid.max_access_size = 4,
  883. .endianness = DEVICE_LITTLE_ENDIAN,
  884. };
  885. static void ftgmac100_cleanup(NetClientState *nc)
  886. {
  887. FTGMAC100State *s = FTGMAC100(qemu_get_nic_opaque(nc));
  888. s->nic = NULL;
  889. }
  890. static NetClientInfo net_ftgmac100_info = {
  891. .type = NET_CLIENT_DRIVER_NIC,
  892. .size = sizeof(NICState),
  893. .can_receive = ftgmac100_can_receive,
  894. .receive = ftgmac100_receive,
  895. .cleanup = ftgmac100_cleanup,
  896. .link_status_changed = ftgmac100_set_link,
  897. };
  898. static void ftgmac100_realize(DeviceState *dev, Error **errp)
  899. {
  900. FTGMAC100State *s = FTGMAC100(dev);
  901. SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
  902. if (s->aspeed) {
  903. s->txdes0_edotr = FTGMAC100_TXDES0_EDOTR_ASPEED;
  904. s->rxdes0_edorr = FTGMAC100_RXDES0_EDORR_ASPEED;
  905. } else {
  906. s->txdes0_edotr = FTGMAC100_TXDES0_EDOTR;
  907. s->rxdes0_edorr = FTGMAC100_RXDES0_EDORR;
  908. }
  909. memory_region_init_io(&s->iomem, OBJECT(dev), &ftgmac100_ops, s,
  910. TYPE_FTGMAC100, 0x2000);
  911. sysbus_init_mmio(sbd, &s->iomem);
  912. sysbus_init_irq(sbd, &s->irq);
  913. qemu_macaddr_default_if_unset(&s->conf.macaddr);
  914. s->nic = qemu_new_nic(&net_ftgmac100_info, &s->conf,
  915. object_get_typename(OBJECT(dev)), DEVICE(dev)->id,
  916. s);
  917. qemu_format_nic_info_str(qemu_get_queue(s->nic), s->conf.macaddr.a);
  918. }
  919. static const VMStateDescription vmstate_ftgmac100 = {
  920. .name = TYPE_FTGMAC100,
  921. .version_id = 1,
  922. .minimum_version_id = 1,
  923. .fields = (VMStateField[]) {
  924. VMSTATE_UINT32(irq_state, FTGMAC100State),
  925. VMSTATE_UINT32(isr, FTGMAC100State),
  926. VMSTATE_UINT32(ier, FTGMAC100State),
  927. VMSTATE_UINT32(rx_enabled, FTGMAC100State),
  928. VMSTATE_UINT32(rx_ring, FTGMAC100State),
  929. VMSTATE_UINT32(rbsr, FTGMAC100State),
  930. VMSTATE_UINT32(tx_ring, FTGMAC100State),
  931. VMSTATE_UINT32(rx_descriptor, FTGMAC100State),
  932. VMSTATE_UINT32(tx_descriptor, FTGMAC100State),
  933. VMSTATE_UINT32_ARRAY(math, FTGMAC100State, 2),
  934. VMSTATE_UINT32(itc, FTGMAC100State),
  935. VMSTATE_UINT32(aptcr, FTGMAC100State),
  936. VMSTATE_UINT32(dblac, FTGMAC100State),
  937. VMSTATE_UINT32(revr, FTGMAC100State),
  938. VMSTATE_UINT32(fear1, FTGMAC100State),
  939. VMSTATE_UINT32(tpafcr, FTGMAC100State),
  940. VMSTATE_UINT32(maccr, FTGMAC100State),
  941. VMSTATE_UINT32(phycr, FTGMAC100State),
  942. VMSTATE_UINT32(phydata, FTGMAC100State),
  943. VMSTATE_UINT32(fcr, FTGMAC100State),
  944. VMSTATE_UINT32(phy_status, FTGMAC100State),
  945. VMSTATE_UINT32(phy_control, FTGMAC100State),
  946. VMSTATE_UINT32(phy_advertise, FTGMAC100State),
  947. VMSTATE_UINT32(phy_int, FTGMAC100State),
  948. VMSTATE_UINT32(phy_int_mask, FTGMAC100State),
  949. VMSTATE_UINT32(txdes0_edotr, FTGMAC100State),
  950. VMSTATE_UINT32(rxdes0_edorr, FTGMAC100State),
  951. VMSTATE_END_OF_LIST()
  952. }
  953. };
  954. static Property ftgmac100_properties[] = {
  955. DEFINE_PROP_BOOL("aspeed", FTGMAC100State, aspeed, false),
  956. DEFINE_NIC_PROPERTIES(FTGMAC100State, conf),
  957. DEFINE_PROP_END_OF_LIST(),
  958. };
  959. static void ftgmac100_class_init(ObjectClass *klass, void *data)
  960. {
  961. DeviceClass *dc = DEVICE_CLASS(klass);
  962. dc->vmsd = &vmstate_ftgmac100;
  963. dc->reset = ftgmac100_reset;
  964. dc->props = ftgmac100_properties;
  965. set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
  966. dc->realize = ftgmac100_realize;
  967. dc->desc = "Faraday FTGMAC100 Gigabit Ethernet emulation";
  968. }
  969. static const TypeInfo ftgmac100_info = {
  970. .name = TYPE_FTGMAC100,
  971. .parent = TYPE_SYS_BUS_DEVICE,
  972. .instance_size = sizeof(FTGMAC100State),
  973. .class_init = ftgmac100_class_init,
  974. };
  975. /*
  976. * AST2600 MII controller
  977. */
  978. #define ASPEED_MII_PHYCR_FIRE BIT(31)
  979. #define ASPEED_MII_PHYCR_ST_22 BIT(28)
  980. #define ASPEED_MII_PHYCR_OP(x) ((x) & (ASPEED_MII_PHYCR_OP_WRITE | \
  981. ASPEED_MII_PHYCR_OP_READ))
  982. #define ASPEED_MII_PHYCR_OP_WRITE BIT(26)
  983. #define ASPEED_MII_PHYCR_OP_READ BIT(27)
  984. #define ASPEED_MII_PHYCR_DATA(x) (x & 0xffff)
  985. #define ASPEED_MII_PHYCR_PHY(x) (((x) >> 21) & 0x1f)
  986. #define ASPEED_MII_PHYCR_REG(x) (((x) >> 16) & 0x1f)
  987. #define ASPEED_MII_PHYDATA_IDLE BIT(16)
  988. static void aspeed_mii_transition(AspeedMiiState *s, bool fire)
  989. {
  990. if (fire) {
  991. s->phycr |= ASPEED_MII_PHYCR_FIRE;
  992. s->phydata &= ~ASPEED_MII_PHYDATA_IDLE;
  993. } else {
  994. s->phycr &= ~ASPEED_MII_PHYCR_FIRE;
  995. s->phydata |= ASPEED_MII_PHYDATA_IDLE;
  996. }
  997. }
  998. static void aspeed_mii_do_phy_ctl(AspeedMiiState *s)
  999. {
  1000. uint8_t reg;
  1001. uint16_t data;
  1002. if (!(s->phycr & ASPEED_MII_PHYCR_ST_22)) {
  1003. aspeed_mii_transition(s, !ASPEED_MII_PHYCR_FIRE);
  1004. qemu_log_mask(LOG_UNIMP, "%s: unsupported ST code\n", __func__);
  1005. return;
  1006. }
  1007. /* Nothing to do */
  1008. if (!(s->phycr & ASPEED_MII_PHYCR_FIRE)) {
  1009. return;
  1010. }
  1011. reg = ASPEED_MII_PHYCR_REG(s->phycr);
  1012. data = ASPEED_MII_PHYCR_DATA(s->phycr);
  1013. switch (ASPEED_MII_PHYCR_OP(s->phycr)) {
  1014. case ASPEED_MII_PHYCR_OP_WRITE:
  1015. do_phy_write(s->nic, reg, data);
  1016. break;
  1017. case ASPEED_MII_PHYCR_OP_READ:
  1018. s->phydata = (s->phydata & ~0xffff) | do_phy_read(s->nic, reg);
  1019. break;
  1020. default:
  1021. qemu_log_mask(LOG_GUEST_ERROR, "%s: invalid OP code %08x\n",
  1022. __func__, s->phycr);
  1023. }
  1024. aspeed_mii_transition(s, !ASPEED_MII_PHYCR_FIRE);
  1025. }
  1026. static uint64_t aspeed_mii_read(void *opaque, hwaddr addr, unsigned size)
  1027. {
  1028. AspeedMiiState *s = ASPEED_MII(opaque);
  1029. switch (addr) {
  1030. case 0x0:
  1031. return s->phycr;
  1032. case 0x4:
  1033. return s->phydata;
  1034. default:
  1035. g_assert_not_reached();
  1036. }
  1037. }
  1038. static void aspeed_mii_write(void *opaque, hwaddr addr,
  1039. uint64_t value, unsigned size)
  1040. {
  1041. AspeedMiiState *s = ASPEED_MII(opaque);
  1042. switch (addr) {
  1043. case 0x0:
  1044. s->phycr = value & ~(s->phycr & ASPEED_MII_PHYCR_FIRE);
  1045. break;
  1046. case 0x4:
  1047. s->phydata = value & ~(0xffff | ASPEED_MII_PHYDATA_IDLE);
  1048. break;
  1049. default:
  1050. g_assert_not_reached();
  1051. }
  1052. aspeed_mii_transition(s, !!(s->phycr & ASPEED_MII_PHYCR_FIRE));
  1053. aspeed_mii_do_phy_ctl(s);
  1054. }
  1055. static const MemoryRegionOps aspeed_mii_ops = {
  1056. .read = aspeed_mii_read,
  1057. .write = aspeed_mii_write,
  1058. .valid.min_access_size = 4,
  1059. .valid.max_access_size = 4,
  1060. .endianness = DEVICE_LITTLE_ENDIAN,
  1061. };
  1062. static void aspeed_mii_reset(DeviceState *dev)
  1063. {
  1064. AspeedMiiState *s = ASPEED_MII(dev);
  1065. s->phycr = 0;
  1066. s->phydata = 0;
  1067. aspeed_mii_transition(s, !!(s->phycr & ASPEED_MII_PHYCR_FIRE));
  1068. };
  1069. static void aspeed_mii_realize(DeviceState *dev, Error **errp)
  1070. {
  1071. AspeedMiiState *s = ASPEED_MII(dev);
  1072. SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
  1073. Object *obj;
  1074. Error *local_err = NULL;
  1075. obj = object_property_get_link(OBJECT(dev), "nic", &local_err);
  1076. if (!obj) {
  1077. error_propagate(errp, local_err);
  1078. error_prepend(errp, "required link 'nic' not found: ");
  1079. return;
  1080. }
  1081. s->nic = FTGMAC100(obj);
  1082. memory_region_init_io(&s->iomem, OBJECT(dev), &aspeed_mii_ops, s,
  1083. TYPE_ASPEED_MII, 0x8);
  1084. sysbus_init_mmio(sbd, &s->iomem);
  1085. }
  1086. static const VMStateDescription vmstate_aspeed_mii = {
  1087. .name = TYPE_ASPEED_MII,
  1088. .version_id = 1,
  1089. .minimum_version_id = 1,
  1090. .fields = (VMStateField[]) {
  1091. VMSTATE_UINT32(phycr, FTGMAC100State),
  1092. VMSTATE_UINT32(phydata, FTGMAC100State),
  1093. VMSTATE_END_OF_LIST()
  1094. }
  1095. };
  1096. static void aspeed_mii_class_init(ObjectClass *klass, void *data)
  1097. {
  1098. DeviceClass *dc = DEVICE_CLASS(klass);
  1099. dc->vmsd = &vmstate_aspeed_mii;
  1100. dc->reset = aspeed_mii_reset;
  1101. dc->realize = aspeed_mii_realize;
  1102. dc->desc = "Aspeed MII controller";
  1103. }
  1104. static const TypeInfo aspeed_mii_info = {
  1105. .name = TYPE_ASPEED_MII,
  1106. .parent = TYPE_SYS_BUS_DEVICE,
  1107. .instance_size = sizeof(AspeedMiiState),
  1108. .class_init = aspeed_mii_class_init,
  1109. };
  1110. static void ftgmac100_register_types(void)
  1111. {
  1112. type_register_static(&ftgmac100_info);
  1113. type_register_static(&aspeed_mii_info);
  1114. }
  1115. type_init(ftgmac100_register_types)