2
0

sungem.c 43 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454
  1. /*
  2. * QEMU model of SUN GEM ethernet controller
  3. *
  4. * As found in Apple ASICs among others
  5. *
  6. * Copyright 2016 Ben Herrenschmidt
  7. * Copyright 2017 Mark Cave-Ayland
  8. */
  9. #include "qemu/osdep.h"
  10. #include "hw/pci/pci_device.h"
  11. #include "hw/qdev-properties.h"
  12. #include "migration/vmstate.h"
  13. #include "qemu/log.h"
  14. #include "qemu/module.h"
  15. #include "net/net.h"
  16. #include "net/eth.h"
  17. #include "net/checksum.h"
  18. #include "hw/net/mii.h"
  19. #include "sysemu/sysemu.h"
  20. #include "trace.h"
  21. #include "qom/object.h"
  22. #define TYPE_SUNGEM "sungem"
  23. OBJECT_DECLARE_SIMPLE_TYPE(SunGEMState, SUNGEM)
  24. #define MAX_PACKET_SIZE 9016
  25. #define SUNGEM_MMIO_SIZE 0x200000
  26. /* Global registers */
  27. #define SUNGEM_MMIO_GREG_SIZE 0x2000
  28. #define GREG_SEBSTATE 0x0000UL /* SEB State Register */
  29. #define GREG_STAT 0x000CUL /* Status Register */
  30. #define GREG_STAT_TXINTME 0x00000001 /* TX INTME frame transferred */
  31. #define GREG_STAT_TXALL 0x00000002 /* All TX frames transferred */
  32. #define GREG_STAT_TXDONE 0x00000004 /* One TX frame transferred */
  33. #define GREG_STAT_RXDONE 0x00000010 /* One RX frame arrived */
  34. #define GREG_STAT_RXNOBUF 0x00000020 /* No free RX buffers available */
  35. #define GREG_STAT_RXTAGERR 0x00000040 /* RX tag framing is corrupt */
  36. #define GREG_STAT_TXMAC 0x00004000 /* TX MAC signalled interrupt */
  37. #define GREG_STAT_RXMAC 0x00008000 /* RX MAC signalled interrupt */
  38. #define GREG_STAT_MAC 0x00010000 /* MAC Control signalled irq */
  39. #define GREG_STAT_TXNR 0xfff80000 /* == TXDMA_TXDONE reg val */
  40. #define GREG_STAT_TXNR_SHIFT 19
  41. /* These interrupts are edge latches in the status register,
  42. * reading it (or writing the corresponding bit in IACK) will
  43. * clear them
  44. */
  45. #define GREG_STAT_LATCH (GREG_STAT_TXALL | GREG_STAT_TXINTME | \
  46. GREG_STAT_RXDONE | GREG_STAT_RXDONE | \
  47. GREG_STAT_RXNOBUF | GREG_STAT_RXTAGERR)
  48. #define GREG_IMASK 0x0010UL /* Interrupt Mask Register */
  49. #define GREG_IACK 0x0014UL /* Interrupt ACK Register */
  50. #define GREG_STAT2 0x001CUL /* Alias of GREG_STAT */
  51. #define GREG_PCIESTAT 0x1000UL /* PCI Error Status Register */
  52. #define GREG_PCIEMASK 0x1004UL /* PCI Error Mask Register */
  53. #define GREG_SWRST 0x1010UL /* Software Reset Register */
  54. #define GREG_SWRST_TXRST 0x00000001 /* TX Software Reset */
  55. #define GREG_SWRST_RXRST 0x00000002 /* RX Software Reset */
  56. #define GREG_SWRST_RSTOUT 0x00000004 /* Force RST# pin active */
  57. /* TX DMA Registers */
  58. #define SUNGEM_MMIO_TXDMA_SIZE 0x1000
  59. #define TXDMA_KICK 0x0000UL /* TX Kick Register */
  60. #define TXDMA_CFG 0x0004UL /* TX Configuration Register */
  61. #define TXDMA_CFG_ENABLE 0x00000001 /* Enable TX DMA channel */
  62. #define TXDMA_CFG_RINGSZ 0x0000001e /* TX descriptor ring size */
  63. #define TXDMA_DBLOW 0x0008UL /* TX Desc. Base Low */
  64. #define TXDMA_DBHI 0x000CUL /* TX Desc. Base High */
  65. #define TXDMA_PCNT 0x0024UL /* TX FIFO Packet Counter */
  66. #define TXDMA_SMACHINE 0x0028UL /* TX State Machine Register */
  67. #define TXDMA_DPLOW 0x0030UL /* TX Data Pointer Low */
  68. #define TXDMA_DPHI 0x0034UL /* TX Data Pointer High */
  69. #define TXDMA_TXDONE 0x0100UL /* TX Completion Register */
  70. #define TXDMA_FTAG 0x0108UL /* TX FIFO Tag */
  71. #define TXDMA_FSZ 0x0118UL /* TX FIFO Size */
  72. /* Receive DMA Registers */
  73. #define SUNGEM_MMIO_RXDMA_SIZE 0x2000
  74. #define RXDMA_CFG 0x0000UL /* RX Configuration Register */
  75. #define RXDMA_CFG_ENABLE 0x00000001 /* Enable RX DMA channel */
  76. #define RXDMA_CFG_RINGSZ 0x0000001e /* RX descriptor ring size */
  77. #define RXDMA_CFG_FBOFF 0x00001c00 /* Offset of first data byte */
  78. #define RXDMA_CFG_CSUMOFF 0x000fe000 /* Skip bytes before csum calc */
  79. #define RXDMA_DBLOW 0x0004UL /* RX Descriptor Base Low */
  80. #define RXDMA_DBHI 0x0008UL /* RX Descriptor Base High */
  81. #define RXDMA_PCNT 0x0018UL /* RX FIFO Packet Counter */
  82. #define RXDMA_SMACHINE 0x001CUL /* RX State Machine Register */
  83. #define RXDMA_PTHRESH 0x0020UL /* Pause Thresholds */
  84. #define RXDMA_DPLOW 0x0024UL /* RX Data Pointer Low */
  85. #define RXDMA_DPHI 0x0028UL /* RX Data Pointer High */
  86. #define RXDMA_KICK 0x0100UL /* RX Kick Register */
  87. #define RXDMA_DONE 0x0104UL /* RX Completion Register */
  88. #define RXDMA_BLANK 0x0108UL /* RX Blanking Register */
  89. #define RXDMA_FTAG 0x0110UL /* RX FIFO Tag */
  90. #define RXDMA_FSZ 0x0120UL /* RX FIFO Size */
  91. /* MAC Registers */
  92. #define SUNGEM_MMIO_MAC_SIZE 0x200
  93. #define MAC_TXRST 0x0000UL /* TX MAC Software Reset Command */
  94. #define MAC_RXRST 0x0004UL /* RX MAC Software Reset Command */
  95. #define MAC_TXSTAT 0x0010UL /* TX MAC Status Register */
  96. #define MAC_RXSTAT 0x0014UL /* RX MAC Status Register */
  97. #define MAC_CSTAT 0x0018UL /* MAC Control Status Register */
  98. #define MAC_CSTAT_PTR 0xffff0000 /* Pause Time Received */
  99. #define MAC_TXMASK 0x0020UL /* TX MAC Mask Register */
  100. #define MAC_RXMASK 0x0024UL /* RX MAC Mask Register */
  101. #define MAC_MCMASK 0x0028UL /* MAC Control Mask Register */
  102. #define MAC_TXCFG 0x0030UL /* TX MAC Configuration Register */
  103. #define MAC_TXCFG_ENAB 0x00000001 /* TX MAC Enable */
  104. #define MAC_RXCFG 0x0034UL /* RX MAC Configuration Register */
  105. #define MAC_RXCFG_ENAB 0x00000001 /* RX MAC Enable */
  106. #define MAC_RXCFG_SFCS 0x00000004 /* Strip FCS */
  107. #define MAC_RXCFG_PROM 0x00000008 /* Promiscuous Mode */
  108. #define MAC_RXCFG_PGRP 0x00000010 /* Promiscuous Group */
  109. #define MAC_RXCFG_HFE 0x00000020 /* Hash Filter Enable */
  110. #define MAC_XIFCFG 0x003CUL /* XIF Configuration Register */
  111. #define MAC_XIFCFG_LBCK 0x00000002 /* Loopback TX to RX */
  112. #define MAC_MINFSZ 0x0050UL /* MinFrameSize Register */
  113. #define MAC_MAXFSZ 0x0054UL /* MaxFrameSize Register */
  114. #define MAC_ADDR0 0x0080UL /* MAC Address 0 Register */
  115. #define MAC_ADDR1 0x0084UL /* MAC Address 1 Register */
  116. #define MAC_ADDR2 0x0088UL /* MAC Address 2 Register */
  117. #define MAC_ADDR3 0x008CUL /* MAC Address 3 Register */
  118. #define MAC_ADDR4 0x0090UL /* MAC Address 4 Register */
  119. #define MAC_ADDR5 0x0094UL /* MAC Address 5 Register */
  120. #define MAC_HASH0 0x00C0UL /* Hash Table 0 Register */
  121. #define MAC_PATMPS 0x0114UL /* Peak Attempts Register */
  122. #define MAC_SMACHINE 0x0134UL /* State Machine Register */
  123. /* MIF Registers */
  124. #define SUNGEM_MMIO_MIF_SIZE 0x20
  125. #define MIF_FRAME 0x000CUL /* MIF Frame/Output Register */
  126. #define MIF_FRAME_OP 0x30000000 /* OPcode */
  127. #define MIF_FRAME_PHYAD 0x0f800000 /* PHY ADdress */
  128. #define MIF_FRAME_REGAD 0x007c0000 /* REGister ADdress */
  129. #define MIF_FRAME_TALSB 0x00010000 /* Turn Around LSB */
  130. #define MIF_FRAME_DATA 0x0000ffff /* Instruction Payload */
  131. #define MIF_CFG 0x0010UL /* MIF Configuration Register */
  132. #define MIF_CFG_MDI0 0x00000100 /* MDIO_0 present or read-bit */
  133. #define MIF_CFG_MDI1 0x00000200 /* MDIO_1 present or read-bit */
  134. #define MIF_STATUS 0x0018UL /* MIF Status Register */
  135. #define MIF_SMACHINE 0x001CUL /* MIF State Machine Register */
  136. /* PCS/Serialink Registers */
  137. #define SUNGEM_MMIO_PCS_SIZE 0x60
  138. #define PCS_MIISTAT 0x0004UL /* PCS MII Status Register */
  139. #define PCS_ISTAT 0x0018UL /* PCS Interrupt Status Reg */
  140. #define PCS_SSTATE 0x005CUL /* Serialink State Register */
  141. /* Descriptors */
  142. struct gem_txd {
  143. uint64_t control_word;
  144. uint64_t buffer;
  145. };
  146. #define TXDCTRL_BUFSZ 0x0000000000007fffULL /* Buffer Size */
  147. #define TXDCTRL_CSTART 0x00000000001f8000ULL /* CSUM Start Offset */
  148. #define TXDCTRL_COFF 0x000000001fe00000ULL /* CSUM Stuff Offset */
  149. #define TXDCTRL_CENAB 0x0000000020000000ULL /* CSUM Enable */
  150. #define TXDCTRL_EOF 0x0000000040000000ULL /* End of Frame */
  151. #define TXDCTRL_SOF 0x0000000080000000ULL /* Start of Frame */
  152. #define TXDCTRL_INTME 0x0000000100000000ULL /* "Interrupt Me" */
  153. struct gem_rxd {
  154. uint64_t status_word;
  155. uint64_t buffer;
  156. };
  157. #define RXDCTRL_HPASS 0x1000000000000000ULL /* Passed Hash Filter */
  158. #define RXDCTRL_ALTMAC 0x2000000000000000ULL /* Matched ALT MAC */
  159. struct SunGEMState {
  160. PCIDevice pdev;
  161. MemoryRegion sungem;
  162. MemoryRegion greg;
  163. MemoryRegion txdma;
  164. MemoryRegion rxdma;
  165. MemoryRegion mac;
  166. MemoryRegion mif;
  167. MemoryRegion pcs;
  168. NICState *nic;
  169. NICConf conf;
  170. uint32_t phy_addr;
  171. uint32_t gregs[SUNGEM_MMIO_GREG_SIZE >> 2];
  172. uint32_t txdmaregs[SUNGEM_MMIO_TXDMA_SIZE >> 2];
  173. uint32_t rxdmaregs[SUNGEM_MMIO_RXDMA_SIZE >> 2];
  174. uint32_t macregs[SUNGEM_MMIO_MAC_SIZE >> 2];
  175. uint32_t mifregs[SUNGEM_MMIO_MIF_SIZE >> 2];
  176. uint32_t pcsregs[SUNGEM_MMIO_PCS_SIZE >> 2];
  177. /* Cache some useful things */
  178. uint32_t rx_mask;
  179. uint32_t tx_mask;
  180. /* Current tx packet */
  181. uint8_t tx_data[MAX_PACKET_SIZE];
  182. uint32_t tx_size;
  183. uint64_t tx_first_ctl;
  184. };
  185. static void sungem_eval_irq(SunGEMState *s)
  186. {
  187. uint32_t stat, mask;
  188. mask = s->gregs[GREG_IMASK >> 2];
  189. stat = s->gregs[GREG_STAT >> 2] & ~GREG_STAT_TXNR;
  190. if (stat & ~mask) {
  191. pci_set_irq(PCI_DEVICE(s), 1);
  192. } else {
  193. pci_set_irq(PCI_DEVICE(s), 0);
  194. }
  195. }
  196. static void sungem_update_status(SunGEMState *s, uint32_t bits, bool val)
  197. {
  198. uint32_t stat;
  199. stat = s->gregs[GREG_STAT >> 2];
  200. if (val) {
  201. stat |= bits;
  202. } else {
  203. stat &= ~bits;
  204. }
  205. s->gregs[GREG_STAT >> 2] = stat;
  206. sungem_eval_irq(s);
  207. }
  208. static void sungem_eval_cascade_irq(SunGEMState *s)
  209. {
  210. uint32_t stat, mask;
  211. mask = s->macregs[MAC_TXSTAT >> 2];
  212. stat = s->macregs[MAC_TXMASK >> 2];
  213. if (stat & ~mask) {
  214. sungem_update_status(s, GREG_STAT_TXMAC, true);
  215. } else {
  216. sungem_update_status(s, GREG_STAT_TXMAC, false);
  217. }
  218. mask = s->macregs[MAC_RXSTAT >> 2];
  219. stat = s->macregs[MAC_RXMASK >> 2];
  220. if (stat & ~mask) {
  221. sungem_update_status(s, GREG_STAT_RXMAC, true);
  222. } else {
  223. sungem_update_status(s, GREG_STAT_RXMAC, false);
  224. }
  225. mask = s->macregs[MAC_CSTAT >> 2];
  226. stat = s->macregs[MAC_MCMASK >> 2] & ~MAC_CSTAT_PTR;
  227. if (stat & ~mask) {
  228. sungem_update_status(s, GREG_STAT_MAC, true);
  229. } else {
  230. sungem_update_status(s, GREG_STAT_MAC, false);
  231. }
  232. }
  233. static void sungem_do_tx_csum(SunGEMState *s)
  234. {
  235. uint16_t start, off;
  236. uint32_t csum;
  237. start = (s->tx_first_ctl & TXDCTRL_CSTART) >> 15;
  238. off = (s->tx_first_ctl & TXDCTRL_COFF) >> 21;
  239. trace_sungem_tx_checksum(start, off);
  240. if (start > (s->tx_size - 2) || off > (s->tx_size - 2)) {
  241. trace_sungem_tx_checksum_oob();
  242. return;
  243. }
  244. csum = net_raw_checksum(s->tx_data + start, s->tx_size - start);
  245. stw_be_p(s->tx_data + off, csum);
  246. }
  247. static void sungem_send_packet(SunGEMState *s, const uint8_t *buf,
  248. int size)
  249. {
  250. NetClientState *nc = qemu_get_queue(s->nic);
  251. if (s->macregs[MAC_XIFCFG >> 2] & MAC_XIFCFG_LBCK) {
  252. qemu_receive_packet(nc, buf, size);
  253. } else {
  254. qemu_send_packet(nc, buf, size);
  255. }
  256. }
  257. static void sungem_process_tx_desc(SunGEMState *s, struct gem_txd *desc)
  258. {
  259. PCIDevice *d = PCI_DEVICE(s);
  260. uint32_t len;
  261. /* If it's a start of frame, discard anything we had in the
  262. * buffer and start again. This should be an error condition
  263. * if we had something ... for now we ignore it
  264. */
  265. if (desc->control_word & TXDCTRL_SOF) {
  266. if (s->tx_first_ctl) {
  267. trace_sungem_tx_unfinished();
  268. }
  269. s->tx_size = 0;
  270. s->tx_first_ctl = desc->control_word;
  271. }
  272. /* Grab data size */
  273. len = desc->control_word & TXDCTRL_BUFSZ;
  274. /* Clamp it to our max size */
  275. if ((s->tx_size + len) > MAX_PACKET_SIZE) {
  276. trace_sungem_tx_overflow();
  277. len = MAX_PACKET_SIZE - s->tx_size;
  278. }
  279. /* Read the data */
  280. pci_dma_read(d, desc->buffer, &s->tx_data[s->tx_size], len);
  281. s->tx_size += len;
  282. /* If end of frame, send packet */
  283. if (desc->control_word & TXDCTRL_EOF) {
  284. trace_sungem_tx_finished(s->tx_size);
  285. /* Handle csum */
  286. if (s->tx_first_ctl & TXDCTRL_CENAB) {
  287. sungem_do_tx_csum(s);
  288. }
  289. /* Send it */
  290. sungem_send_packet(s, s->tx_data, s->tx_size);
  291. /* No more pending packet */
  292. s->tx_size = 0;
  293. s->tx_first_ctl = 0;
  294. }
  295. }
  296. static void sungem_tx_kick(SunGEMState *s)
  297. {
  298. PCIDevice *d = PCI_DEVICE(s);
  299. uint32_t comp, kick;
  300. uint32_t txdma_cfg, txmac_cfg, ints;
  301. uint64_t dbase;
  302. trace_sungem_tx_kick();
  303. /* Check that both TX MAC and TX DMA are enabled. We don't
  304. * handle DMA-less direct FIFO operations (we don't emulate
  305. * the FIFO at all).
  306. *
  307. * A write to TXDMA_KICK while DMA isn't enabled can happen
  308. * when the driver is resetting the pointer.
  309. */
  310. txdma_cfg = s->txdmaregs[TXDMA_CFG >> 2];
  311. txmac_cfg = s->macregs[MAC_TXCFG >> 2];
  312. if (!(txdma_cfg & TXDMA_CFG_ENABLE) ||
  313. !(txmac_cfg & MAC_TXCFG_ENAB)) {
  314. trace_sungem_tx_disabled();
  315. return;
  316. }
  317. /* XXX Test min frame size register ? */
  318. /* XXX Test max frame size register ? */
  319. dbase = s->txdmaregs[TXDMA_DBHI >> 2];
  320. dbase = (dbase << 32) | s->txdmaregs[TXDMA_DBLOW >> 2];
  321. comp = s->txdmaregs[TXDMA_TXDONE >> 2] & s->tx_mask;
  322. kick = s->txdmaregs[TXDMA_KICK >> 2] & s->tx_mask;
  323. trace_sungem_tx_process(comp, kick, s->tx_mask + 1);
  324. /* This is rather primitive for now, we just send everything we
  325. * can in one go, like e1000. Ideally we should do the sending
  326. * from some kind of background task
  327. */
  328. while (comp != kick) {
  329. struct gem_txd desc;
  330. /* Read the next descriptor */
  331. pci_dma_read(d, dbase + comp * sizeof(desc), &desc, sizeof(desc));
  332. /* Byteswap descriptor */
  333. desc.control_word = le64_to_cpu(desc.control_word);
  334. desc.buffer = le64_to_cpu(desc.buffer);
  335. trace_sungem_tx_desc(comp, desc.control_word, desc.buffer);
  336. /* Send it for processing */
  337. sungem_process_tx_desc(s, &desc);
  338. /* Interrupt */
  339. ints = GREG_STAT_TXDONE;
  340. if (desc.control_word & TXDCTRL_INTME) {
  341. ints |= GREG_STAT_TXINTME;
  342. }
  343. sungem_update_status(s, ints, true);
  344. /* Next ! */
  345. comp = (comp + 1) & s->tx_mask;
  346. s->txdmaregs[TXDMA_TXDONE >> 2] = comp;
  347. }
  348. /* We sent everything, set status/irq bit */
  349. sungem_update_status(s, GREG_STAT_TXALL, true);
  350. }
  351. static bool sungem_rx_full(SunGEMState *s, uint32_t kick, uint32_t done)
  352. {
  353. return kick == ((done + 1) & s->rx_mask);
  354. }
  355. static bool sungem_can_receive(NetClientState *nc)
  356. {
  357. SunGEMState *s = qemu_get_nic_opaque(nc);
  358. uint32_t kick, done, rxdma_cfg, rxmac_cfg;
  359. bool full;
  360. rxmac_cfg = s->macregs[MAC_RXCFG >> 2];
  361. rxdma_cfg = s->rxdmaregs[RXDMA_CFG >> 2];
  362. /* If MAC disabled, can't receive */
  363. if ((rxmac_cfg & MAC_RXCFG_ENAB) == 0) {
  364. trace_sungem_rx_mac_disabled();
  365. return false;
  366. }
  367. if ((rxdma_cfg & RXDMA_CFG_ENABLE) == 0) {
  368. trace_sungem_rx_txdma_disabled();
  369. return false;
  370. }
  371. /* Check RX availability */
  372. kick = s->rxdmaregs[RXDMA_KICK >> 2];
  373. done = s->rxdmaregs[RXDMA_DONE >> 2];
  374. full = sungem_rx_full(s, kick, done);
  375. trace_sungem_rx_check(!full, kick, done);
  376. return !full;
  377. }
  378. enum {
  379. rx_no_match,
  380. rx_match_promisc,
  381. rx_match_bcast,
  382. rx_match_allmcast,
  383. rx_match_mcast,
  384. rx_match_mac,
  385. rx_match_altmac,
  386. };
  387. static int sungem_check_rx_mac(SunGEMState *s, const uint8_t *mac, uint32_t crc)
  388. {
  389. uint32_t rxcfg = s->macregs[MAC_RXCFG >> 2];
  390. uint32_t mac0, mac1, mac2;
  391. /* Promisc enabled ? */
  392. if (rxcfg & MAC_RXCFG_PROM) {
  393. return rx_match_promisc;
  394. }
  395. /* Format MAC address into dwords */
  396. mac0 = (mac[4] << 8) | mac[5];
  397. mac1 = (mac[2] << 8) | mac[3];
  398. mac2 = (mac[0] << 8) | mac[1];
  399. trace_sungem_rx_mac_check(mac0, mac1, mac2);
  400. /* Is this a broadcast frame ? */
  401. if (mac0 == 0xffff && mac1 == 0xffff && mac2 == 0xffff) {
  402. return rx_match_bcast;
  403. }
  404. /* TODO: Implement address filter registers (or we don't care ?) */
  405. /* Is this a multicast frame ? */
  406. if (mac[0] & 1) {
  407. trace_sungem_rx_mac_multicast();
  408. /* Promisc group enabled ? */
  409. if (rxcfg & MAC_RXCFG_PGRP) {
  410. return rx_match_allmcast;
  411. }
  412. /* TODO: Check MAC control frames (or we don't care) ? */
  413. /* Check hash filter (somebody check that's correct ?) */
  414. if (rxcfg & MAC_RXCFG_HFE) {
  415. uint32_t hash, idx;
  416. crc >>= 24;
  417. idx = (crc >> 2) & 0x3c;
  418. hash = s->macregs[(MAC_HASH0 + idx) >> 2];
  419. if (hash & (1 << (15 - (crc & 0xf)))) {
  420. return rx_match_mcast;
  421. }
  422. }
  423. return rx_no_match;
  424. }
  425. /* Main MAC check */
  426. trace_sungem_rx_mac_compare(s->macregs[MAC_ADDR0 >> 2],
  427. s->macregs[MAC_ADDR1 >> 2],
  428. s->macregs[MAC_ADDR2 >> 2]);
  429. if (mac0 == s->macregs[MAC_ADDR0 >> 2] &&
  430. mac1 == s->macregs[MAC_ADDR1 >> 2] &&
  431. mac2 == s->macregs[MAC_ADDR2 >> 2]) {
  432. return rx_match_mac;
  433. }
  434. /* Alt MAC check */
  435. if (mac0 == s->macregs[MAC_ADDR3 >> 2] &&
  436. mac1 == s->macregs[MAC_ADDR4 >> 2] &&
  437. mac2 == s->macregs[MAC_ADDR5 >> 2]) {
  438. return rx_match_altmac;
  439. }
  440. return rx_no_match;
  441. }
  442. static ssize_t sungem_receive(NetClientState *nc, const uint8_t *buf,
  443. size_t size)
  444. {
  445. SunGEMState *s = qemu_get_nic_opaque(nc);
  446. PCIDevice *d = PCI_DEVICE(s);
  447. uint32_t mac_crc, done, kick, max_fsize;
  448. uint32_t fcs_size, ints, rxdma_cfg, rxmac_cfg, csum, coff;
  449. uint8_t smallbuf[60];
  450. struct gem_rxd desc;
  451. uint64_t dbase, baddr;
  452. unsigned int rx_cond;
  453. trace_sungem_rx_packet(size);
  454. rxmac_cfg = s->macregs[MAC_RXCFG >> 2];
  455. rxdma_cfg = s->rxdmaregs[RXDMA_CFG >> 2];
  456. max_fsize = s->macregs[MAC_MAXFSZ >> 2] & 0x7fff;
  457. /* If MAC or DMA disabled, can't receive */
  458. if (!(rxdma_cfg & RXDMA_CFG_ENABLE) ||
  459. !(rxmac_cfg & MAC_RXCFG_ENAB)) {
  460. trace_sungem_rx_disabled();
  461. return 0;
  462. }
  463. /* Size adjustment for FCS */
  464. if (rxmac_cfg & MAC_RXCFG_SFCS) {
  465. fcs_size = 0;
  466. } else {
  467. fcs_size = 4;
  468. }
  469. /* Discard frame smaller than a MAC or larger than max frame size
  470. * (when accounting for FCS)
  471. */
  472. if (size < 6 || (size + 4) > max_fsize) {
  473. trace_sungem_rx_bad_frame_size(size);
  474. /* XXX Increment error statistics ? */
  475. return size;
  476. }
  477. /* We don't drop too small frames since we get them in qemu, we pad
  478. * them instead. We should probably use the min frame size register
  479. * but I don't want to use a variable size staging buffer and I
  480. * know both MacOS and Linux use the default 64 anyway. We use 60
  481. * here to account for the non-existent FCS.
  482. */
  483. if (size < 60) {
  484. memcpy(smallbuf, buf, size);
  485. memset(&smallbuf[size], 0, 60 - size);
  486. buf = smallbuf;
  487. size = 60;
  488. }
  489. /* Get MAC crc */
  490. mac_crc = net_crc32_le(buf, ETH_ALEN);
  491. /* Packet isn't for me ? */
  492. rx_cond = sungem_check_rx_mac(s, buf, mac_crc);
  493. if (rx_cond == rx_no_match) {
  494. /* Just drop it */
  495. trace_sungem_rx_unmatched();
  496. return size;
  497. }
  498. /* Get ring pointers */
  499. kick = s->rxdmaregs[RXDMA_KICK >> 2] & s->rx_mask;
  500. done = s->rxdmaregs[RXDMA_DONE >> 2] & s->rx_mask;
  501. trace_sungem_rx_process(done, kick, s->rx_mask + 1);
  502. /* Ring full ? Can't receive */
  503. if (sungem_rx_full(s, kick, done)) {
  504. trace_sungem_rx_ringfull();
  505. return 0;
  506. }
  507. /* Note: The real GEM will fetch descriptors in blocks of 4,
  508. * for now we handle them one at a time, I think the driver will
  509. * cope
  510. */
  511. dbase = s->rxdmaregs[RXDMA_DBHI >> 2];
  512. dbase = (dbase << 32) | s->rxdmaregs[RXDMA_DBLOW >> 2];
  513. /* Read the next descriptor */
  514. pci_dma_read(d, dbase + done * sizeof(desc), &desc, sizeof(desc));
  515. trace_sungem_rx_desc(le64_to_cpu(desc.status_word),
  516. le64_to_cpu(desc.buffer));
  517. /* Effective buffer address */
  518. baddr = le64_to_cpu(desc.buffer) & ~7ull;
  519. baddr |= (rxdma_cfg & RXDMA_CFG_FBOFF) >> 10;
  520. /* Write buffer out */
  521. pci_dma_write(d, baddr, buf, size);
  522. if (fcs_size) {
  523. /* Should we add an FCS ? Linux doesn't ask us to strip it,
  524. * however I believe nothing checks it... For now we just
  525. * do nothing. It's faster this way.
  526. */
  527. }
  528. /* Calculate the checksum */
  529. coff = (rxdma_cfg & RXDMA_CFG_CSUMOFF) >> 13;
  530. csum = net_raw_checksum((uint8_t *)buf + coff, size - coff);
  531. /* Build the updated descriptor */
  532. desc.status_word = (size + fcs_size) << 16;
  533. desc.status_word |= ((uint64_t)(mac_crc >> 16)) << 44;
  534. desc.status_word |= csum;
  535. if (rx_cond == rx_match_mcast) {
  536. desc.status_word |= RXDCTRL_HPASS;
  537. }
  538. if (rx_cond == rx_match_altmac) {
  539. desc.status_word |= RXDCTRL_ALTMAC;
  540. }
  541. desc.status_word = cpu_to_le64(desc.status_word);
  542. pci_dma_write(d, dbase + done * sizeof(desc), &desc, sizeof(desc));
  543. done = (done + 1) & s->rx_mask;
  544. s->rxdmaregs[RXDMA_DONE >> 2] = done;
  545. /* XXX Unconditionally set RX interrupt for now. The interrupt
  546. * mitigation timer might well end up adding more overhead than
  547. * helping here...
  548. */
  549. ints = GREG_STAT_RXDONE;
  550. if (sungem_rx_full(s, kick, done)) {
  551. ints |= GREG_STAT_RXNOBUF;
  552. }
  553. sungem_update_status(s, ints, true);
  554. return size;
  555. }
  556. static void sungem_set_link_status(NetClientState *nc)
  557. {
  558. /* We don't do anything for now as I believe none of the OSes
  559. * drivers use the MIF autopoll feature nor the PHY interrupt
  560. */
  561. }
  562. static void sungem_update_masks(SunGEMState *s)
  563. {
  564. uint32_t sz;
  565. sz = 1 << (((s->rxdmaregs[RXDMA_CFG >> 2] & RXDMA_CFG_RINGSZ) >> 1) + 5);
  566. s->rx_mask = sz - 1;
  567. sz = 1 << (((s->txdmaregs[TXDMA_CFG >> 2] & TXDMA_CFG_RINGSZ) >> 1) + 5);
  568. s->tx_mask = sz - 1;
  569. }
  570. static void sungem_reset_rx(SunGEMState *s)
  571. {
  572. trace_sungem_rx_reset();
  573. /* XXX Do RXCFG */
  574. /* XXX Check value */
  575. s->rxdmaregs[RXDMA_FSZ >> 2] = 0x140;
  576. s->rxdmaregs[RXDMA_DONE >> 2] = 0;
  577. s->rxdmaregs[RXDMA_KICK >> 2] = 0;
  578. s->rxdmaregs[RXDMA_CFG >> 2] = 0x1000010;
  579. s->rxdmaregs[RXDMA_PTHRESH >> 2] = 0xf8;
  580. s->rxdmaregs[RXDMA_BLANK >> 2] = 0;
  581. sungem_update_masks(s);
  582. }
  583. static void sungem_reset_tx(SunGEMState *s)
  584. {
  585. trace_sungem_tx_reset();
  586. /* XXX Do TXCFG */
  587. /* XXX Check value */
  588. s->txdmaregs[TXDMA_FSZ >> 2] = 0x90;
  589. s->txdmaregs[TXDMA_TXDONE >> 2] = 0;
  590. s->txdmaregs[TXDMA_KICK >> 2] = 0;
  591. s->txdmaregs[TXDMA_CFG >> 2] = 0x118010;
  592. sungem_update_masks(s);
  593. s->tx_size = 0;
  594. s->tx_first_ctl = 0;
  595. }
  596. static void sungem_reset_all(SunGEMState *s, bool pci_reset)
  597. {
  598. trace_sungem_reset(pci_reset);
  599. sungem_reset_rx(s);
  600. sungem_reset_tx(s);
  601. s->gregs[GREG_IMASK >> 2] = 0xFFFFFFF;
  602. s->gregs[GREG_STAT >> 2] = 0;
  603. if (pci_reset) {
  604. uint8_t *ma = s->conf.macaddr.a;
  605. s->gregs[GREG_SWRST >> 2] = 0;
  606. s->macregs[MAC_ADDR0 >> 2] = (ma[4] << 8) | ma[5];
  607. s->macregs[MAC_ADDR1 >> 2] = (ma[2] << 8) | ma[3];
  608. s->macregs[MAC_ADDR2 >> 2] = (ma[0] << 8) | ma[1];
  609. } else {
  610. s->gregs[GREG_SWRST >> 2] &= GREG_SWRST_RSTOUT;
  611. }
  612. s->mifregs[MIF_CFG >> 2] = MIF_CFG_MDI0;
  613. }
  614. static void sungem_mii_write(SunGEMState *s, uint8_t phy_addr,
  615. uint8_t reg_addr, uint16_t val)
  616. {
  617. trace_sungem_mii_write(phy_addr, reg_addr, val);
  618. /* XXX TODO */
  619. }
  620. static uint16_t __sungem_mii_read(SunGEMState *s, uint8_t phy_addr,
  621. uint8_t reg_addr)
  622. {
  623. if (phy_addr != s->phy_addr) {
  624. return 0xffff;
  625. }
  626. /* Primitive emulation of a BCM5201 to please the driver,
  627. * ID is 0x00406210. TODO: Do a gigabit PHY like BCM5400
  628. */
  629. switch (reg_addr) {
  630. case MII_BMCR:
  631. return 0;
  632. case MII_PHYID1:
  633. return 0x0040;
  634. case MII_PHYID2:
  635. return 0x6210;
  636. case MII_BMSR:
  637. if (qemu_get_queue(s->nic)->link_down) {
  638. return MII_BMSR_100TX_FD | MII_BMSR_AUTONEG;
  639. } else {
  640. return MII_BMSR_100TX_FD | MII_BMSR_AN_COMP |
  641. MII_BMSR_AUTONEG | MII_BMSR_LINK_ST;
  642. }
  643. case MII_ANLPAR:
  644. case MII_ANAR:
  645. return MII_ANLPAR_TXFD;
  646. case 0x18: /* 5201 AUX status */
  647. return 3; /* 100FD */
  648. default:
  649. return 0;
  650. };
  651. }
  652. static uint16_t sungem_mii_read(SunGEMState *s, uint8_t phy_addr,
  653. uint8_t reg_addr)
  654. {
  655. uint16_t val;
  656. val = __sungem_mii_read(s, phy_addr, reg_addr);
  657. trace_sungem_mii_read(phy_addr, reg_addr, val);
  658. return val;
  659. }
  660. static uint32_t sungem_mii_op(SunGEMState *s, uint32_t val)
  661. {
  662. uint8_t phy_addr, reg_addr, op;
  663. /* Ignore not start of frame */
  664. if ((val >> 30) != 1) {
  665. trace_sungem_mii_invalid_sof(val >> 30);
  666. return 0xffff;
  667. }
  668. phy_addr = (val & MIF_FRAME_PHYAD) >> 23;
  669. reg_addr = (val & MIF_FRAME_REGAD) >> 18;
  670. op = (val & MIF_FRAME_OP) >> 28;
  671. switch (op) {
  672. case 1:
  673. sungem_mii_write(s, phy_addr, reg_addr, val & MIF_FRAME_DATA);
  674. return val | MIF_FRAME_TALSB;
  675. case 2:
  676. return sungem_mii_read(s, phy_addr, reg_addr) | MIF_FRAME_TALSB;
  677. default:
  678. trace_sungem_mii_invalid_op(op);
  679. }
  680. return 0xffff | MIF_FRAME_TALSB;
  681. }
  682. static void sungem_mmio_greg_write(void *opaque, hwaddr addr, uint64_t val,
  683. unsigned size)
  684. {
  685. SunGEMState *s = opaque;
  686. if (!(addr < 0x20) && !(addr >= 0x1000 && addr <= 0x1010)) {
  687. qemu_log_mask(LOG_GUEST_ERROR,
  688. "Write to unknown GREG register 0x%"HWADDR_PRIx"\n",
  689. addr);
  690. return;
  691. }
  692. trace_sungem_mmio_greg_write(addr, val);
  693. /* Pre-write filter */
  694. switch (addr) {
  695. /* Read only registers */
  696. case GREG_SEBSTATE:
  697. case GREG_STAT:
  698. case GREG_STAT2:
  699. case GREG_PCIESTAT:
  700. return; /* No actual write */
  701. case GREG_IACK:
  702. val &= GREG_STAT_LATCH;
  703. s->gregs[GREG_STAT >> 2] &= ~val;
  704. sungem_eval_irq(s);
  705. return; /* No actual write */
  706. case GREG_PCIEMASK:
  707. val &= 0x7;
  708. break;
  709. }
  710. s->gregs[addr >> 2] = val;
  711. /* Post write action */
  712. switch (addr) {
  713. case GREG_IMASK:
  714. /* Re-evaluate interrupt */
  715. sungem_eval_irq(s);
  716. break;
  717. case GREG_SWRST:
  718. switch (val & (GREG_SWRST_TXRST | GREG_SWRST_RXRST)) {
  719. case GREG_SWRST_RXRST:
  720. sungem_reset_rx(s);
  721. break;
  722. case GREG_SWRST_TXRST:
  723. sungem_reset_tx(s);
  724. break;
  725. case GREG_SWRST_RXRST | GREG_SWRST_TXRST:
  726. sungem_reset_all(s, false);
  727. }
  728. break;
  729. }
  730. }
  731. static uint64_t sungem_mmio_greg_read(void *opaque, hwaddr addr, unsigned size)
  732. {
  733. SunGEMState *s = opaque;
  734. uint32_t val;
  735. if (!(addr < 0x20) && !(addr >= 0x1000 && addr <= 0x1010)) {
  736. qemu_log_mask(LOG_GUEST_ERROR,
  737. "Read from unknown GREG register 0x%"HWADDR_PRIx"\n",
  738. addr);
  739. return 0;
  740. }
  741. val = s->gregs[addr >> 2];
  742. trace_sungem_mmio_greg_read(addr, val);
  743. switch (addr) {
  744. case GREG_STAT:
  745. /* Side effect, clear bottom 7 bits */
  746. s->gregs[GREG_STAT >> 2] &= ~GREG_STAT_LATCH;
  747. sungem_eval_irq(s);
  748. /* Inject TX completion in returned value */
  749. val = (val & ~GREG_STAT_TXNR) |
  750. (s->txdmaregs[TXDMA_TXDONE >> 2] << GREG_STAT_TXNR_SHIFT);
  751. break;
  752. case GREG_STAT2:
  753. /* Return the status reg without side effect
  754. * (and inject TX completion in returned value)
  755. */
  756. val = (s->gregs[GREG_STAT >> 2] & ~GREG_STAT_TXNR) |
  757. (s->txdmaregs[TXDMA_TXDONE >> 2] << GREG_STAT_TXNR_SHIFT);
  758. break;
  759. }
  760. return val;
  761. }
  762. static const MemoryRegionOps sungem_mmio_greg_ops = {
  763. .read = sungem_mmio_greg_read,
  764. .write = sungem_mmio_greg_write,
  765. .endianness = DEVICE_LITTLE_ENDIAN,
  766. .impl = {
  767. .min_access_size = 4,
  768. .max_access_size = 4,
  769. },
  770. };
  771. static void sungem_mmio_txdma_write(void *opaque, hwaddr addr, uint64_t val,
  772. unsigned size)
  773. {
  774. SunGEMState *s = opaque;
  775. if (!(addr < 0x38) && !(addr >= 0x100 && addr <= 0x118)) {
  776. qemu_log_mask(LOG_GUEST_ERROR,
  777. "Write to unknown TXDMA register 0x%"HWADDR_PRIx"\n",
  778. addr);
  779. return;
  780. }
  781. trace_sungem_mmio_txdma_write(addr, val);
  782. /* Pre-write filter */
  783. switch (addr) {
  784. /* Read only registers */
  785. case TXDMA_TXDONE:
  786. case TXDMA_PCNT:
  787. case TXDMA_SMACHINE:
  788. case TXDMA_DPLOW:
  789. case TXDMA_DPHI:
  790. case TXDMA_FSZ:
  791. case TXDMA_FTAG:
  792. return; /* No actual write */
  793. }
  794. s->txdmaregs[addr >> 2] = val;
  795. /* Post write action */
  796. switch (addr) {
  797. case TXDMA_KICK:
  798. sungem_tx_kick(s);
  799. break;
  800. case TXDMA_CFG:
  801. sungem_update_masks(s);
  802. break;
  803. }
  804. }
  805. static uint64_t sungem_mmio_txdma_read(void *opaque, hwaddr addr, unsigned size)
  806. {
  807. SunGEMState *s = opaque;
  808. uint32_t val;
  809. if (!(addr < 0x38) && !(addr >= 0x100 && addr <= 0x118)) {
  810. qemu_log_mask(LOG_GUEST_ERROR,
  811. "Read from unknown TXDMA register 0x%"HWADDR_PRIx"\n",
  812. addr);
  813. return 0;
  814. }
  815. val = s->txdmaregs[addr >> 2];
  816. trace_sungem_mmio_txdma_read(addr, val);
  817. return val;
  818. }
  819. static const MemoryRegionOps sungem_mmio_txdma_ops = {
  820. .read = sungem_mmio_txdma_read,
  821. .write = sungem_mmio_txdma_write,
  822. .endianness = DEVICE_LITTLE_ENDIAN,
  823. .impl = {
  824. .min_access_size = 4,
  825. .max_access_size = 4,
  826. },
  827. };
  828. static void sungem_mmio_rxdma_write(void *opaque, hwaddr addr, uint64_t val,
  829. unsigned size)
  830. {
  831. SunGEMState *s = opaque;
  832. if (!(addr <= 0x28) && !(addr >= 0x100 && addr <= 0x120)) {
  833. qemu_log_mask(LOG_GUEST_ERROR,
  834. "Write to unknown RXDMA register 0x%"HWADDR_PRIx"\n",
  835. addr);
  836. return;
  837. }
  838. trace_sungem_mmio_rxdma_write(addr, val);
  839. /* Pre-write filter */
  840. switch (addr) {
  841. /* Read only registers */
  842. case RXDMA_DONE:
  843. case RXDMA_PCNT:
  844. case RXDMA_SMACHINE:
  845. case RXDMA_DPLOW:
  846. case RXDMA_DPHI:
  847. case RXDMA_FSZ:
  848. case RXDMA_FTAG:
  849. return; /* No actual write */
  850. }
  851. s->rxdmaregs[addr >> 2] = val;
  852. /* Post write action */
  853. switch (addr) {
  854. case RXDMA_KICK:
  855. trace_sungem_rx_kick(val);
  856. break;
  857. case RXDMA_CFG:
  858. sungem_update_masks(s);
  859. if ((s->macregs[MAC_RXCFG >> 2] & MAC_RXCFG_ENAB) != 0 &&
  860. (s->rxdmaregs[RXDMA_CFG >> 2] & RXDMA_CFG_ENABLE) != 0) {
  861. qemu_flush_queued_packets(qemu_get_queue(s->nic));
  862. }
  863. break;
  864. }
  865. }
  866. static uint64_t sungem_mmio_rxdma_read(void *opaque, hwaddr addr, unsigned size)
  867. {
  868. SunGEMState *s = opaque;
  869. uint32_t val;
  870. if (!(addr <= 0x28) && !(addr >= 0x100 && addr <= 0x120)) {
  871. qemu_log_mask(LOG_GUEST_ERROR,
  872. "Read from unknown RXDMA register 0x%"HWADDR_PRIx"\n",
  873. addr);
  874. return 0;
  875. }
  876. val = s->rxdmaregs[addr >> 2];
  877. trace_sungem_mmio_rxdma_read(addr, val);
  878. return val;
  879. }
  880. static const MemoryRegionOps sungem_mmio_rxdma_ops = {
  881. .read = sungem_mmio_rxdma_read,
  882. .write = sungem_mmio_rxdma_write,
  883. .endianness = DEVICE_LITTLE_ENDIAN,
  884. .impl = {
  885. .min_access_size = 4,
  886. .max_access_size = 4,
  887. },
  888. };
  889. static void sungem_mmio_mac_write(void *opaque, hwaddr addr, uint64_t val,
  890. unsigned size)
  891. {
  892. SunGEMState *s = opaque;
  893. if (!(addr <= 0x134)) {
  894. qemu_log_mask(LOG_GUEST_ERROR,
  895. "Write to unknown MAC register 0x%"HWADDR_PRIx"\n",
  896. addr);
  897. return;
  898. }
  899. trace_sungem_mmio_mac_write(addr, val);
  900. /* Pre-write filter */
  901. switch (addr) {
  902. /* Read only registers */
  903. case MAC_TXRST: /* Not technically read-only but will do for now */
  904. case MAC_RXRST: /* Not technically read-only but will do for now */
  905. case MAC_TXSTAT:
  906. case MAC_RXSTAT:
  907. case MAC_CSTAT:
  908. case MAC_PATMPS:
  909. case MAC_SMACHINE:
  910. return; /* No actual write */
  911. case MAC_MINFSZ:
  912. /* 10-bits implemented */
  913. val &= 0x3ff;
  914. break;
  915. }
  916. s->macregs[addr >> 2] = val;
  917. /* Post write action */
  918. switch (addr) {
  919. case MAC_TXMASK:
  920. case MAC_RXMASK:
  921. case MAC_MCMASK:
  922. sungem_eval_cascade_irq(s);
  923. break;
  924. case MAC_RXCFG:
  925. sungem_update_masks(s);
  926. if ((s->macregs[MAC_RXCFG >> 2] & MAC_RXCFG_ENAB) != 0 &&
  927. (s->rxdmaregs[RXDMA_CFG >> 2] & RXDMA_CFG_ENABLE) != 0) {
  928. qemu_flush_queued_packets(qemu_get_queue(s->nic));
  929. }
  930. break;
  931. }
  932. }
  933. static uint64_t sungem_mmio_mac_read(void *opaque, hwaddr addr, unsigned size)
  934. {
  935. SunGEMState *s = opaque;
  936. uint32_t val;
  937. if (!(addr <= 0x134)) {
  938. qemu_log_mask(LOG_GUEST_ERROR,
  939. "Read from unknown MAC register 0x%"HWADDR_PRIx"\n",
  940. addr);
  941. return 0;
  942. }
  943. val = s->macregs[addr >> 2];
  944. trace_sungem_mmio_mac_read(addr, val);
  945. switch (addr) {
  946. case MAC_TXSTAT:
  947. /* Side effect, clear all */
  948. s->macregs[addr >> 2] = 0;
  949. sungem_update_status(s, GREG_STAT_TXMAC, false);
  950. break;
  951. case MAC_RXSTAT:
  952. /* Side effect, clear all */
  953. s->macregs[addr >> 2] = 0;
  954. sungem_update_status(s, GREG_STAT_RXMAC, false);
  955. break;
  956. case MAC_CSTAT:
  957. /* Side effect, interrupt bits */
  958. s->macregs[addr >> 2] &= MAC_CSTAT_PTR;
  959. sungem_update_status(s, GREG_STAT_MAC, false);
  960. break;
  961. }
  962. return val;
  963. }
  964. static const MemoryRegionOps sungem_mmio_mac_ops = {
  965. .read = sungem_mmio_mac_read,
  966. .write = sungem_mmio_mac_write,
  967. .endianness = DEVICE_LITTLE_ENDIAN,
  968. .impl = {
  969. .min_access_size = 4,
  970. .max_access_size = 4,
  971. },
  972. };
  973. static void sungem_mmio_mif_write(void *opaque, hwaddr addr, uint64_t val,
  974. unsigned size)
  975. {
  976. SunGEMState *s = opaque;
  977. if (!(addr <= 0x1c)) {
  978. qemu_log_mask(LOG_GUEST_ERROR,
  979. "Write to unknown MIF register 0x%"HWADDR_PRIx"\n",
  980. addr);
  981. return;
  982. }
  983. trace_sungem_mmio_mif_write(addr, val);
  984. /* Pre-write filter */
  985. switch (addr) {
  986. /* Read only registers */
  987. case MIF_STATUS:
  988. case MIF_SMACHINE:
  989. return; /* No actual write */
  990. case MIF_CFG:
  991. /* Maintain the RO MDI bits to advertize an MDIO PHY on MDI0 */
  992. val &= ~MIF_CFG_MDI1;
  993. val |= MIF_CFG_MDI0;
  994. break;
  995. }
  996. s->mifregs[addr >> 2] = val;
  997. /* Post write action */
  998. switch (addr) {
  999. case MIF_FRAME:
  1000. s->mifregs[addr >> 2] = sungem_mii_op(s, val);
  1001. break;
  1002. }
  1003. }
  1004. static uint64_t sungem_mmio_mif_read(void *opaque, hwaddr addr, unsigned size)
  1005. {
  1006. SunGEMState *s = opaque;
  1007. uint32_t val;
  1008. if (!(addr <= 0x1c)) {
  1009. qemu_log_mask(LOG_GUEST_ERROR,
  1010. "Read from unknown MIF register 0x%"HWADDR_PRIx"\n",
  1011. addr);
  1012. return 0;
  1013. }
  1014. val = s->mifregs[addr >> 2];
  1015. trace_sungem_mmio_mif_read(addr, val);
  1016. return val;
  1017. }
  1018. static const MemoryRegionOps sungem_mmio_mif_ops = {
  1019. .read = sungem_mmio_mif_read,
  1020. .write = sungem_mmio_mif_write,
  1021. .endianness = DEVICE_LITTLE_ENDIAN,
  1022. .impl = {
  1023. .min_access_size = 4,
  1024. .max_access_size = 4,
  1025. },
  1026. };
  1027. static void sungem_mmio_pcs_write(void *opaque, hwaddr addr, uint64_t val,
  1028. unsigned size)
  1029. {
  1030. SunGEMState *s = opaque;
  1031. if (!(addr <= 0x18) && !(addr >= 0x50 && addr <= 0x5c)) {
  1032. qemu_log_mask(LOG_GUEST_ERROR,
  1033. "Write to unknown PCS register 0x%"HWADDR_PRIx"\n",
  1034. addr);
  1035. return;
  1036. }
  1037. trace_sungem_mmio_pcs_write(addr, val);
  1038. /* Pre-write filter */
  1039. switch (addr) {
  1040. /* Read only registers */
  1041. case PCS_MIISTAT:
  1042. case PCS_ISTAT:
  1043. case PCS_SSTATE:
  1044. return; /* No actual write */
  1045. }
  1046. s->pcsregs[addr >> 2] = val;
  1047. }
  1048. static uint64_t sungem_mmio_pcs_read(void *opaque, hwaddr addr, unsigned size)
  1049. {
  1050. SunGEMState *s = opaque;
  1051. uint32_t val;
  1052. if (!(addr <= 0x18) && !(addr >= 0x50 && addr <= 0x5c)) {
  1053. qemu_log_mask(LOG_GUEST_ERROR,
  1054. "Read from unknown PCS register 0x%"HWADDR_PRIx"\n",
  1055. addr);
  1056. return 0;
  1057. }
  1058. val = s->pcsregs[addr >> 2];
  1059. trace_sungem_mmio_pcs_read(addr, val);
  1060. return val;
  1061. }
  1062. static const MemoryRegionOps sungem_mmio_pcs_ops = {
  1063. .read = sungem_mmio_pcs_read,
  1064. .write = sungem_mmio_pcs_write,
  1065. .endianness = DEVICE_LITTLE_ENDIAN,
  1066. .impl = {
  1067. .min_access_size = 4,
  1068. .max_access_size = 4,
  1069. },
  1070. };
  1071. static void sungem_uninit(PCIDevice *dev)
  1072. {
  1073. SunGEMState *s = SUNGEM(dev);
  1074. qemu_del_nic(s->nic);
  1075. }
  1076. static NetClientInfo net_sungem_info = {
  1077. .type = NET_CLIENT_DRIVER_NIC,
  1078. .size = sizeof(NICState),
  1079. .can_receive = sungem_can_receive,
  1080. .receive = sungem_receive,
  1081. .link_status_changed = sungem_set_link_status,
  1082. };
  1083. static void sungem_realize(PCIDevice *pci_dev, Error **errp)
  1084. {
  1085. DeviceState *dev = DEVICE(pci_dev);
  1086. SunGEMState *s = SUNGEM(pci_dev);
  1087. uint8_t *pci_conf;
  1088. pci_conf = pci_dev->config;
  1089. pci_set_word(pci_conf + PCI_STATUS,
  1090. PCI_STATUS_FAST_BACK |
  1091. PCI_STATUS_DEVSEL_MEDIUM |
  1092. PCI_STATUS_66MHZ);
  1093. pci_set_word(pci_conf + PCI_SUBSYSTEM_VENDOR_ID, 0x0);
  1094. pci_set_word(pci_conf + PCI_SUBSYSTEM_ID, 0x0);
  1095. pci_conf[PCI_INTERRUPT_PIN] = 1; /* interrupt pin A */
  1096. pci_conf[PCI_MIN_GNT] = 0x40;
  1097. pci_conf[PCI_MAX_LAT] = 0x40;
  1098. sungem_reset_all(s, true);
  1099. memory_region_init(&s->sungem, OBJECT(s), "sungem", SUNGEM_MMIO_SIZE);
  1100. memory_region_init_io(&s->greg, OBJECT(s), &sungem_mmio_greg_ops, s,
  1101. "sungem.greg", SUNGEM_MMIO_GREG_SIZE);
  1102. memory_region_add_subregion(&s->sungem, 0, &s->greg);
  1103. memory_region_init_io(&s->txdma, OBJECT(s), &sungem_mmio_txdma_ops, s,
  1104. "sungem.txdma", SUNGEM_MMIO_TXDMA_SIZE);
  1105. memory_region_add_subregion(&s->sungem, 0x2000, &s->txdma);
  1106. memory_region_init_io(&s->rxdma, OBJECT(s), &sungem_mmio_rxdma_ops, s,
  1107. "sungem.rxdma", SUNGEM_MMIO_RXDMA_SIZE);
  1108. memory_region_add_subregion(&s->sungem, 0x4000, &s->rxdma);
  1109. memory_region_init_io(&s->mac, OBJECT(s), &sungem_mmio_mac_ops, s,
  1110. "sungem.mac", SUNGEM_MMIO_MAC_SIZE);
  1111. memory_region_add_subregion(&s->sungem, 0x6000, &s->mac);
  1112. memory_region_init_io(&s->mif, OBJECT(s), &sungem_mmio_mif_ops, s,
  1113. "sungem.mif", SUNGEM_MMIO_MIF_SIZE);
  1114. memory_region_add_subregion(&s->sungem, 0x6200, &s->mif);
  1115. memory_region_init_io(&s->pcs, OBJECT(s), &sungem_mmio_pcs_ops, s,
  1116. "sungem.pcs", SUNGEM_MMIO_PCS_SIZE);
  1117. memory_region_add_subregion(&s->sungem, 0x9000, &s->pcs);
  1118. pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY, &s->sungem);
  1119. qemu_macaddr_default_if_unset(&s->conf.macaddr);
  1120. s->nic = qemu_new_nic(&net_sungem_info, &s->conf,
  1121. object_get_typename(OBJECT(dev)),
  1122. dev->id, s);
  1123. qemu_format_nic_info_str(qemu_get_queue(s->nic),
  1124. s->conf.macaddr.a);
  1125. }
  1126. static void sungem_reset(DeviceState *dev)
  1127. {
  1128. SunGEMState *s = SUNGEM(dev);
  1129. sungem_reset_all(s, true);
  1130. }
  1131. static void sungem_instance_init(Object *obj)
  1132. {
  1133. SunGEMState *s = SUNGEM(obj);
  1134. device_add_bootindex_property(obj, &s->conf.bootindex,
  1135. "bootindex", "/ethernet-phy@0",
  1136. DEVICE(obj));
  1137. }
  1138. static Property sungem_properties[] = {
  1139. DEFINE_NIC_PROPERTIES(SunGEMState, conf),
  1140. /* Phy address should be 0 for most Apple machines except
  1141. * for K2 in which case it's 1. Will be set by a machine
  1142. * override.
  1143. */
  1144. DEFINE_PROP_UINT32("phy_addr", SunGEMState, phy_addr, 0),
  1145. DEFINE_PROP_END_OF_LIST(),
  1146. };
  1147. static const VMStateDescription vmstate_sungem = {
  1148. .name = "sungem",
  1149. .version_id = 0,
  1150. .minimum_version_id = 0,
  1151. .fields = (VMStateField[]) {
  1152. VMSTATE_PCI_DEVICE(pdev, SunGEMState),
  1153. VMSTATE_MACADDR(conf.macaddr, SunGEMState),
  1154. VMSTATE_UINT32(phy_addr, SunGEMState),
  1155. VMSTATE_UINT32_ARRAY(gregs, SunGEMState, (SUNGEM_MMIO_GREG_SIZE >> 2)),
  1156. VMSTATE_UINT32_ARRAY(txdmaregs, SunGEMState,
  1157. (SUNGEM_MMIO_TXDMA_SIZE >> 2)),
  1158. VMSTATE_UINT32_ARRAY(rxdmaregs, SunGEMState,
  1159. (SUNGEM_MMIO_RXDMA_SIZE >> 2)),
  1160. VMSTATE_UINT32_ARRAY(macregs, SunGEMState, (SUNGEM_MMIO_MAC_SIZE >> 2)),
  1161. VMSTATE_UINT32_ARRAY(mifregs, SunGEMState, (SUNGEM_MMIO_MIF_SIZE >> 2)),
  1162. VMSTATE_UINT32_ARRAY(pcsregs, SunGEMState, (SUNGEM_MMIO_PCS_SIZE >> 2)),
  1163. VMSTATE_UINT32(rx_mask, SunGEMState),
  1164. VMSTATE_UINT32(tx_mask, SunGEMState),
  1165. VMSTATE_UINT8_ARRAY(tx_data, SunGEMState, MAX_PACKET_SIZE),
  1166. VMSTATE_UINT32(tx_size, SunGEMState),
  1167. VMSTATE_UINT64(tx_first_ctl, SunGEMState),
  1168. VMSTATE_END_OF_LIST()
  1169. }
  1170. };
  1171. static void sungem_class_init(ObjectClass *klass, void *data)
  1172. {
  1173. DeviceClass *dc = DEVICE_CLASS(klass);
  1174. PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
  1175. k->realize = sungem_realize;
  1176. k->exit = sungem_uninit;
  1177. k->vendor_id = PCI_VENDOR_ID_APPLE;
  1178. k->device_id = PCI_DEVICE_ID_APPLE_UNI_N_GMAC;
  1179. k->revision = 0x01;
  1180. k->class_id = PCI_CLASS_NETWORK_ETHERNET;
  1181. dc->vmsd = &vmstate_sungem;
  1182. dc->reset = sungem_reset;
  1183. device_class_set_props(dc, sungem_properties);
  1184. set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
  1185. }
  1186. static const TypeInfo sungem_info = {
  1187. .name = TYPE_SUNGEM,
  1188. .parent = TYPE_PCI_DEVICE,
  1189. .instance_size = sizeof(SunGEMState),
  1190. .class_init = sungem_class_init,
  1191. .instance_init = sungem_instance_init,
  1192. .interfaces = (InterfaceInfo[]) {
  1193. { INTERFACE_CONVENTIONAL_PCI_DEVICE },
  1194. { }
  1195. }
  1196. };
  1197. static void sungem_register_types(void)
  1198. {
  1199. type_register_static(&sungem_info);
  1200. }
  1201. type_init(sungem_register_types)