ftgmac100.c 45 KB

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