xref: /qemu/hw/net/sunhme.c (revision 7271a819)
1 /*
2  * QEMU Sun Happy Meal Ethernet emulation
3  *
4  * Copyright (c) 2017 Mark Cave-Ayland
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a copy
7  * of this software and associated documentation files (the "Software"), to deal
8  * in the Software without restriction, including without limitation the rights
9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10  * copies of the Software, and to permit persons to whom the Software is
11  * furnished to do so, subject to the following conditions:
12  *
13  * The above copyright notice and this permission notice shall be included in
14  * all copies or substantial portions of the Software.
15  *
16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22  * THE SOFTWARE.
23  */
24 
25 #include "qemu/osdep.h"
26 #include "hw/hw.h"
27 #include "hw/pci/pci.h"
28 #include "hw/net/mii.h"
29 #include "net/net.h"
30 #include "net/checksum.h"
31 #include "net/eth.h"
32 #include "sysemu/sysemu.h"
33 #include "trace.h"
34 
35 #define HME_REG_SIZE                   0x8000
36 
37 #define HME_SEB_REG_SIZE               0x2000
38 
39 #define HME_SEBI_RESET                 0x0
40 #define HME_SEB_RESET_ETX              0x1
41 #define HME_SEB_RESET_ERX              0x2
42 
43 #define HME_SEBI_STAT                  0x100
44 #define HME_SEBI_STAT_LINUXBUG         0x108
45 #define HME_SEB_STAT_RXTOHOST          0x10000
46 #define HME_SEB_STAT_MIFIRQ            0x800000
47 #define HME_SEB_STAT_HOSTTOTX          0x1000000
48 #define HME_SEB_STAT_TXALL             0x2000000
49 
50 #define HME_SEBI_IMASK                 0x104
51 #define HME_SEBI_IMASK_LINUXBUG        0x10c
52 
53 #define HME_ETX_REG_SIZE               0x2000
54 
55 #define HME_ETXI_PENDING               0x0
56 
57 #define HME_ETXI_RING                  0x8
58 #define HME_ETXI_RING_ADDR             0xffffff00
59 #define HME_ETXI_RING_OFFSET           0xff
60 
61 #define HME_ETXI_RSIZE                 0x2c
62 
63 #define HME_ERX_REG_SIZE               0x2000
64 
65 #define HME_ERXI_CFG                   0x0
66 #define HME_ERX_CFG_RINGSIZE           0x600
67 #define HME_ERX_CFG_RINGSIZE_SHIFT     9
68 #define HME_ERX_CFG_BYTEOFFSET         0x38
69 #define HME_ERX_CFG_BYTEOFFSET_SHIFT   3
70 #define HME_ERX_CFG_CSUMSTART          0x7f0000
71 #define HME_ERX_CFG_CSUMSHIFT          16
72 
73 #define HME_ERXI_RING                  0x4
74 #define HME_ERXI_RING_ADDR             0xffffff00
75 #define HME_ERXI_RING_OFFSET           0xff
76 
77 #define HME_MAC_REG_SIZE               0x1000
78 
79 #define HME_MACI_TXCFG                 0x20c
80 #define HME_MAC_TXCFG_ENABLE           0x1
81 
82 #define HME_MACI_RXCFG                 0x30c
83 #define HME_MAC_RXCFG_ENABLE           0x1
84 #define HME_MAC_RXCFG_PMISC            0x40
85 #define HME_MAC_RXCFG_HENABLE          0x800
86 
87 #define HME_MACI_MACADDR2              0x318
88 #define HME_MACI_MACADDR1              0x31c
89 #define HME_MACI_MACADDR0              0x320
90 
91 #define HME_MACI_HASHTAB3              0x340
92 #define HME_MACI_HASHTAB2              0x344
93 #define HME_MACI_HASHTAB1              0x348
94 #define HME_MACI_HASHTAB0              0x34c
95 
96 #define HME_MIF_REG_SIZE               0x20
97 
98 #define HME_MIFI_FO                    0xc
99 #define HME_MIF_FO_ST                  0xc0000000
100 #define HME_MIF_FO_ST_SHIFT            30
101 #define HME_MIF_FO_OPC                 0x30000000
102 #define HME_MIF_FO_OPC_SHIFT           28
103 #define HME_MIF_FO_PHYAD               0x0f800000
104 #define HME_MIF_FO_PHYAD_SHIFT         23
105 #define HME_MIF_FO_REGAD               0x007c0000
106 #define HME_MIF_FO_REGAD_SHIFT         18
107 #define HME_MIF_FO_TAMSB               0x20000
108 #define HME_MIF_FO_TALSB               0x10000
109 #define HME_MIF_FO_DATA                0xffff
110 
111 #define HME_MIFI_CFG                   0x10
112 #define HME_MIF_CFG_MDI0               0x100
113 #define HME_MIF_CFG_MDI1               0x200
114 
115 #define HME_MIFI_IMASK                 0x14
116 
117 #define HME_MIFI_STAT                  0x18
118 
119 
120 /* Wired HME PHY addresses */
121 #define HME_PHYAD_INTERNAL     1
122 #define HME_PHYAD_EXTERNAL     0
123 
124 #define MII_COMMAND_START      0x1
125 #define MII_COMMAND_READ       0x2
126 #define MII_COMMAND_WRITE      0x1
127 
128 #define TYPE_SUNHME "sunhme"
129 #define SUNHME(obj) OBJECT_CHECK(SunHMEState, (obj), TYPE_SUNHME)
130 
131 /* Maximum size of buffer */
132 #define HME_FIFO_SIZE          0x800
133 
134 /* Size of TX/RX descriptor */
135 #define HME_DESC_SIZE          0x8
136 
137 #define HME_XD_OWN             0x80000000
138 #define HME_XD_OFL             0x40000000
139 #define HME_XD_SOP             0x40000000
140 #define HME_XD_EOP             0x20000000
141 #define HME_XD_RXLENMSK        0x3fff0000
142 #define HME_XD_RXLENSHIFT      16
143 #define HME_XD_RXCKSUM         0xffff
144 #define HME_XD_TXLENMSK        0x00001fff
145 #define HME_XD_TXCKSUM         0x10000000
146 #define HME_XD_TXCSSTUFF       0xff00000
147 #define HME_XD_TXCSSTUFFSHIFT  20
148 #define HME_XD_TXCSSTART       0xfc000
149 #define HME_XD_TXCSSTARTSHIFT  14
150 
151 #define HME_MII_REGS_SIZE      0x20
152 
153 typedef struct SunHMEState {
154     /*< private >*/
155     PCIDevice parent_obj;
156 
157     NICState *nic;
158     NICConf conf;
159 
160     MemoryRegion hme;
161     MemoryRegion sebreg;
162     MemoryRegion etxreg;
163     MemoryRegion erxreg;
164     MemoryRegion macreg;
165     MemoryRegion mifreg;
166 
167     uint32_t sebregs[HME_SEB_REG_SIZE >> 2];
168     uint32_t etxregs[HME_ETX_REG_SIZE >> 2];
169     uint32_t erxregs[HME_ERX_REG_SIZE >> 2];
170     uint32_t macregs[HME_MAC_REG_SIZE >> 2];
171     uint32_t mifregs[HME_MIF_REG_SIZE >> 2];
172 
173     uint16_t miiregs[HME_MII_REGS_SIZE];
174 } SunHMEState;
175 
176 static Property sunhme_properties[] = {
177     DEFINE_NIC_PROPERTIES(SunHMEState, conf),
178     DEFINE_PROP_END_OF_LIST(),
179 };
180 
181 static void sunhme_reset_tx(SunHMEState *s)
182 {
183     /* Indicate TX reset complete */
184     s->sebregs[HME_SEBI_RESET] &= ~HME_SEB_RESET_ETX;
185 }
186 
187 static void sunhme_reset_rx(SunHMEState *s)
188 {
189     /* Indicate RX reset complete */
190     s->sebregs[HME_SEBI_RESET] &= ~HME_SEB_RESET_ERX;
191 }
192 
193 static void sunhme_update_irq(SunHMEState *s)
194 {
195     PCIDevice *d = PCI_DEVICE(s);
196     int level;
197 
198     /* MIF interrupt mask (16-bit) */
199     uint32_t mifmask = ~(s->mifregs[HME_MIFI_IMASK >> 2]) & 0xffff;
200     uint32_t mif = s->mifregs[HME_MIFI_STAT >> 2] & mifmask;
201 
202     /* Main SEB interrupt mask (include MIF status from above) */
203     uint32_t sebmask = ~(s->sebregs[HME_SEBI_IMASK >> 2]) &
204                        ~HME_SEB_STAT_MIFIRQ;
205     uint32_t seb = s->sebregs[HME_SEBI_STAT >> 2] & sebmask;
206     if (mif) {
207         seb |= HME_SEB_STAT_MIFIRQ;
208     }
209 
210     level = (seb ? 1 : 0);
211     pci_set_irq(d, level);
212 }
213 
214 static void sunhme_seb_write(void *opaque, hwaddr addr,
215                           uint64_t val, unsigned size)
216 {
217     SunHMEState *s = SUNHME(opaque);
218 
219     trace_sunhme_seb_write(addr, val);
220 
221     /* Handly buggy Linux drivers before 4.13 which have
222        the wrong offsets for HME_SEBI_STAT and HME_SEBI_IMASK */
223     switch (addr) {
224     case HME_SEBI_STAT_LINUXBUG:
225         addr = HME_SEBI_STAT;
226         break;
227     case HME_SEBI_IMASK_LINUXBUG:
228         addr = HME_SEBI_IMASK;
229         break;
230     default:
231         break;
232     }
233 
234     switch (addr) {
235     case HME_SEBI_RESET:
236         if (val & HME_SEB_RESET_ETX) {
237             sunhme_reset_tx(s);
238         }
239         if (val & HME_SEB_RESET_ERX) {
240             sunhme_reset_rx(s);
241         }
242         val = s->sebregs[HME_SEBI_RESET >> 2];
243         break;
244     }
245 
246     s->sebregs[addr >> 2] = val;
247 }
248 
249 static uint64_t sunhme_seb_read(void *opaque, hwaddr addr,
250                              unsigned size)
251 {
252     SunHMEState *s = SUNHME(opaque);
253     uint64_t val;
254 
255     /* Handly buggy Linux drivers before 4.13 which have
256        the wrong offsets for HME_SEBI_STAT and HME_SEBI_IMASK */
257     switch (addr) {
258     case HME_SEBI_STAT_LINUXBUG:
259         addr = HME_SEBI_STAT;
260         break;
261     case HME_SEBI_IMASK_LINUXBUG:
262         addr = HME_SEBI_IMASK;
263         break;
264     default:
265         break;
266     }
267 
268     val = s->sebregs[addr >> 2];
269 
270     switch (addr) {
271     case HME_SEBI_STAT:
272         /* Autoclear status (except MIF) */
273         s->sebregs[HME_SEBI_STAT >> 2] &= HME_SEB_STAT_MIFIRQ;
274         sunhme_update_irq(s);
275         break;
276     }
277 
278     trace_sunhme_seb_read(addr, val);
279 
280     return val;
281 }
282 
283 static const MemoryRegionOps sunhme_seb_ops = {
284     .read = sunhme_seb_read,
285     .write = sunhme_seb_write,
286     .endianness = DEVICE_LITTLE_ENDIAN,
287     .valid = {
288         .min_access_size = 4,
289         .max_access_size = 4,
290     },
291 };
292 
293 static void sunhme_transmit(SunHMEState *s);
294 
295 static void sunhme_etx_write(void *opaque, hwaddr addr,
296                           uint64_t val, unsigned size)
297 {
298     SunHMEState *s = SUNHME(opaque);
299 
300     trace_sunhme_etx_write(addr, val);
301 
302     switch (addr) {
303     case HME_ETXI_PENDING:
304         if (val) {
305             sunhme_transmit(s);
306         }
307         break;
308     }
309 
310     s->etxregs[addr >> 2] = val;
311 }
312 
313 static uint64_t sunhme_etx_read(void *opaque, hwaddr addr,
314                              unsigned size)
315 {
316     SunHMEState *s = SUNHME(opaque);
317     uint64_t val;
318 
319     val = s->etxregs[addr >> 2];
320 
321     trace_sunhme_etx_read(addr, val);
322 
323     return val;
324 }
325 
326 static const MemoryRegionOps sunhme_etx_ops = {
327     .read = sunhme_etx_read,
328     .write = sunhme_etx_write,
329     .endianness = DEVICE_LITTLE_ENDIAN,
330     .valid = {
331         .min_access_size = 4,
332         .max_access_size = 4,
333     },
334 };
335 
336 static void sunhme_erx_write(void *opaque, hwaddr addr,
337                           uint64_t val, unsigned size)
338 {
339     SunHMEState *s = SUNHME(opaque);
340 
341     trace_sunhme_erx_write(addr, val);
342 
343     s->erxregs[addr >> 2] = val;
344 }
345 
346 static uint64_t sunhme_erx_read(void *opaque, hwaddr addr,
347                              unsigned size)
348 {
349     SunHMEState *s = SUNHME(opaque);
350     uint64_t val;
351 
352     val = s->erxregs[addr >> 2];
353 
354     trace_sunhme_erx_read(addr, val);
355 
356     return val;
357 }
358 
359 static const MemoryRegionOps sunhme_erx_ops = {
360     .read = sunhme_erx_read,
361     .write = sunhme_erx_write,
362     .endianness = DEVICE_LITTLE_ENDIAN,
363     .valid = {
364         .min_access_size = 4,
365         .max_access_size = 4,
366     },
367 };
368 
369 static void sunhme_mac_write(void *opaque, hwaddr addr,
370                           uint64_t val, unsigned size)
371 {
372     SunHMEState *s = SUNHME(opaque);
373 
374     trace_sunhme_mac_write(addr, val);
375 
376     s->macregs[addr >> 2] = val;
377 }
378 
379 static uint64_t sunhme_mac_read(void *opaque, hwaddr addr,
380                              unsigned size)
381 {
382     SunHMEState *s = SUNHME(opaque);
383     uint64_t val;
384 
385     val = s->macregs[addr >> 2];
386 
387     trace_sunhme_mac_read(addr, val);
388 
389     return val;
390 }
391 
392 static const MemoryRegionOps sunhme_mac_ops = {
393     .read = sunhme_mac_read,
394     .write = sunhme_mac_write,
395     .endianness = DEVICE_LITTLE_ENDIAN,
396     .valid = {
397         .min_access_size = 4,
398         .max_access_size = 4,
399     },
400 };
401 
402 static void sunhme_mii_write(SunHMEState *s, uint8_t reg, uint16_t data)
403 {
404     trace_sunhme_mii_write(reg, data);
405 
406     switch (reg) {
407     case MII_BMCR:
408         if (data & MII_BMCR_RESET) {
409             /* Autoclear reset bit, enable auto negotiation */
410             data &= ~MII_BMCR_RESET;
411             data |= MII_BMCR_AUTOEN;
412         }
413         if (data & MII_BMCR_ANRESTART) {
414             /* Autoclear auto negotiation restart */
415             data &= ~MII_BMCR_ANRESTART;
416 
417             /* Indicate negotiation complete */
418             s->miiregs[MII_BMSR] |= MII_BMSR_AN_COMP;
419 
420             if (!qemu_get_queue(s->nic)->link_down) {
421                 s->miiregs[MII_ANLPAR] |= MII_ANLPAR_TXFD;
422                 s->miiregs[MII_BMSR] |= MII_BMSR_LINK_ST;
423             }
424         }
425         break;
426     }
427 
428     s->miiregs[reg] = data;
429 }
430 
431 static uint16_t sunhme_mii_read(SunHMEState *s, uint8_t reg)
432 {
433     uint16_t data = s->miiregs[reg];
434 
435     trace_sunhme_mii_read(reg, data);
436 
437     return data;
438 }
439 
440 static void sunhme_mif_write(void *opaque, hwaddr addr,
441                           uint64_t val, unsigned size)
442 {
443     SunHMEState *s = SUNHME(opaque);
444     uint8_t cmd, reg;
445     uint16_t data;
446 
447     trace_sunhme_mif_write(addr, val);
448 
449     switch (addr) {
450     case HME_MIFI_CFG:
451         /* Mask the read-only bits */
452         val &= ~(HME_MIF_CFG_MDI0 | HME_MIF_CFG_MDI1);
453         val |= s->mifregs[HME_MIFI_CFG >> 2] &
454                (HME_MIF_CFG_MDI0 | HME_MIF_CFG_MDI1);
455         break;
456     case HME_MIFI_FO:
457         /* Detect start of MII command */
458         if ((val & HME_MIF_FO_ST) >> HME_MIF_FO_ST_SHIFT
459                 != MII_COMMAND_START) {
460             val |= HME_MIF_FO_TALSB;
461             break;
462         }
463 
464         /* Internal phy only */
465         if ((val & HME_MIF_FO_PHYAD) >> HME_MIF_FO_PHYAD_SHIFT
466                 != HME_PHYAD_INTERNAL) {
467             val |= HME_MIF_FO_TALSB;
468             break;
469         }
470 
471         cmd = (val & HME_MIF_FO_OPC) >> HME_MIF_FO_OPC_SHIFT;
472         reg = (val & HME_MIF_FO_REGAD) >> HME_MIF_FO_REGAD_SHIFT;
473         data = (val & HME_MIF_FO_DATA);
474 
475         switch (cmd) {
476         case MII_COMMAND_WRITE:
477             sunhme_mii_write(s, reg, data);
478             break;
479 
480         case MII_COMMAND_READ:
481             val &= ~HME_MIF_FO_DATA;
482             val |= sunhme_mii_read(s, reg);
483             break;
484         }
485 
486         val |= HME_MIF_FO_TALSB;
487         break;
488     }
489 
490     s->mifregs[addr >> 2] = val;
491 }
492 
493 static uint64_t sunhme_mif_read(void *opaque, hwaddr addr,
494                              unsigned size)
495 {
496     SunHMEState *s = SUNHME(opaque);
497     uint64_t val;
498 
499     val = s->mifregs[addr >> 2];
500 
501     switch (addr) {
502     case HME_MIFI_STAT:
503         /* Autoclear MIF interrupt status */
504         s->mifregs[HME_MIFI_STAT >> 2] = 0;
505         sunhme_update_irq(s);
506         break;
507     }
508 
509     trace_sunhme_mif_read(addr, val);
510 
511     return val;
512 }
513 
514 static const MemoryRegionOps sunhme_mif_ops = {
515     .read = sunhme_mif_read,
516     .write = sunhme_mif_write,
517     .endianness = DEVICE_LITTLE_ENDIAN,
518     .valid = {
519         .min_access_size = 4,
520         .max_access_size = 4,
521     },
522 };
523 
524 static void sunhme_transmit_frame(SunHMEState *s, uint8_t *buf, int size)
525 {
526     qemu_send_packet(qemu_get_queue(s->nic), buf, size);
527 }
528 
529 static inline int sunhme_get_tx_ring_count(SunHMEState *s)
530 {
531     return (s->etxregs[HME_ETXI_RSIZE >> 2] + 1) << 4;
532 }
533 
534 static inline int sunhme_get_tx_ring_nr(SunHMEState *s)
535 {
536     return s->etxregs[HME_ETXI_RING >> 2] & HME_ETXI_RING_OFFSET;
537 }
538 
539 static inline void sunhme_set_tx_ring_nr(SunHMEState *s, int i)
540 {
541     uint32_t ring = s->etxregs[HME_ETXI_RING >> 2] & ~HME_ETXI_RING_OFFSET;
542     ring |= i & HME_ETXI_RING_OFFSET;
543 
544     s->etxregs[HME_ETXI_RING >> 2] = ring;
545 }
546 
547 static void sunhme_transmit(SunHMEState *s)
548 {
549     PCIDevice *d = PCI_DEVICE(s);
550     dma_addr_t tb, addr;
551     uint32_t intstatus, status, buffer, sum = 0;
552     int cr, nr, len, xmit_pos, csum_offset = 0, csum_stuff_offset = 0;
553     uint16_t csum = 0;
554     uint8_t xmit_buffer[HME_FIFO_SIZE];
555 
556     tb = s->etxregs[HME_ETXI_RING >> 2] & HME_ETXI_RING_ADDR;
557     nr = sunhme_get_tx_ring_count(s);
558     cr = sunhme_get_tx_ring_nr(s);
559 
560     pci_dma_read(d, tb + cr * HME_DESC_SIZE, &status, 4);
561     pci_dma_read(d, tb + cr * HME_DESC_SIZE + 4, &buffer, 4);
562 
563     xmit_pos = 0;
564     while (status & HME_XD_OWN) {
565         trace_sunhme_tx_desc(buffer, status, cr, nr);
566 
567         /* Copy data into transmit buffer */
568         addr = buffer;
569         len = status & HME_XD_TXLENMSK;
570 
571         if (xmit_pos + len > HME_FIFO_SIZE) {
572             len = HME_FIFO_SIZE - xmit_pos;
573         }
574 
575         pci_dma_read(d, addr, &xmit_buffer[xmit_pos], len);
576         xmit_pos += len;
577 
578         /* Detect start of packet for TX checksum */
579         if (status & HME_XD_SOP) {
580             sum = 0;
581             csum_offset = (status & HME_XD_TXCSSTART) >> HME_XD_TXCSSTARTSHIFT;
582             csum_stuff_offset = (status & HME_XD_TXCSSTUFF) >>
583                                 HME_XD_TXCSSTUFFSHIFT;
584         }
585 
586         if (status & HME_XD_TXCKSUM) {
587             /* Only start calculation from csum_offset */
588             if (xmit_pos - len <= csum_offset && xmit_pos > csum_offset) {
589                 sum += net_checksum_add(xmit_pos - csum_offset,
590                                         xmit_buffer + csum_offset);
591                 trace_sunhme_tx_xsum_add(csum_offset, xmit_pos - csum_offset);
592             } else {
593                 sum += net_checksum_add(len, xmit_buffer + xmit_pos - len);
594                 trace_sunhme_tx_xsum_add(xmit_pos - len, len);
595             }
596         }
597 
598         /* Detect end of packet for TX checksum */
599         if (status & HME_XD_EOP) {
600             /* Stuff the checksum if required */
601             if (status & HME_XD_TXCKSUM) {
602                 csum = net_checksum_finish(sum);
603                 stw_be_p(xmit_buffer + csum_stuff_offset, csum);
604                 trace_sunhme_tx_xsum_stuff(csum, csum_stuff_offset);
605             }
606 
607             if (s->macregs[HME_MACI_TXCFG >> 2] & HME_MAC_TXCFG_ENABLE) {
608                 sunhme_transmit_frame(s, xmit_buffer, xmit_pos);
609                 trace_sunhme_tx_done(xmit_pos);
610             }
611         }
612 
613         /* Update status */
614         status &= ~HME_XD_OWN;
615         pci_dma_write(d, tb + cr * HME_DESC_SIZE, &status, 4);
616 
617         /* Move onto next descriptor */
618         cr++;
619         if (cr >= nr) {
620             cr = 0;
621         }
622         sunhme_set_tx_ring_nr(s, cr);
623 
624         pci_dma_read(d, tb + cr * HME_DESC_SIZE, &status, 4);
625         pci_dma_read(d, tb + cr * HME_DESC_SIZE + 4, &buffer, 4);
626 
627         /* Indicate TX complete */
628         intstatus = s->sebregs[HME_SEBI_STAT >> 2];
629         intstatus |= HME_SEB_STAT_HOSTTOTX;
630         s->sebregs[HME_SEBI_STAT >> 2] = intstatus;
631 
632         /* Autoclear TX pending */
633         s->etxregs[HME_ETXI_PENDING >> 2] = 0;
634 
635         sunhme_update_irq(s);
636     }
637 
638     /* TX FIFO now clear */
639     intstatus = s->sebregs[HME_SEBI_STAT >> 2];
640     intstatus |= HME_SEB_STAT_TXALL;
641     s->sebregs[HME_SEBI_STAT >> 2] = intstatus;
642     sunhme_update_irq(s);
643 }
644 
645 static int sunhme_can_receive(NetClientState *nc)
646 {
647     SunHMEState *s = qemu_get_nic_opaque(nc);
648 
649     return s->macregs[HME_MAC_RXCFG_ENABLE >> 2] & HME_MAC_RXCFG_ENABLE;
650 }
651 
652 static void sunhme_link_status_changed(NetClientState *nc)
653 {
654     SunHMEState *s = qemu_get_nic_opaque(nc);
655 
656     if (nc->link_down) {
657         s->miiregs[MII_ANLPAR] &= ~MII_ANLPAR_TXFD;
658         s->miiregs[MII_BMSR] &= ~MII_BMSR_LINK_ST;
659     } else {
660         s->miiregs[MII_ANLPAR] |= MII_ANLPAR_TXFD;
661         s->miiregs[MII_BMSR] |= MII_BMSR_LINK_ST;
662     }
663 
664     /* Exact bits unknown */
665     s->mifregs[HME_MIFI_STAT >> 2] = 0xffff;
666     sunhme_update_irq(s);
667 }
668 
669 static inline int sunhme_get_rx_ring_count(SunHMEState *s)
670 {
671     uint32_t rings = (s->erxregs[HME_ERXI_CFG >> 2] & HME_ERX_CFG_RINGSIZE)
672                       >> HME_ERX_CFG_RINGSIZE_SHIFT;
673 
674     switch (rings) {
675     case 0:
676         return 32;
677     case 1:
678         return 64;
679     case 2:
680         return 128;
681     case 3:
682         return 256;
683     }
684 
685     return 0;
686 }
687 
688 static inline int sunhme_get_rx_ring_nr(SunHMEState *s)
689 {
690     return s->erxregs[HME_ERXI_RING >> 2] & HME_ERXI_RING_OFFSET;
691 }
692 
693 static inline void sunhme_set_rx_ring_nr(SunHMEState *s, int i)
694 {
695     uint32_t ring = s->erxregs[HME_ERXI_RING >> 2] & ~HME_ERXI_RING_OFFSET;
696     ring |= i & HME_ERXI_RING_OFFSET;
697 
698     s->erxregs[HME_ERXI_RING >> 2] = ring;
699 }
700 
701 #define POLYNOMIAL_LE 0xedb88320
702 static uint32_t sunhme_crc32_le(const uint8_t *p, int len)
703 {
704     uint32_t crc;
705     int carry, i, j;
706     uint8_t b;
707 
708     crc = 0xffffffff;
709     for (i = 0; i < len; i++) {
710         b = *p++;
711         for (j = 0; j < 8; j++) {
712             carry = (crc & 0x1) ^ (b & 0x01);
713             crc >>= 1;
714             b >>= 1;
715             if (carry) {
716                 crc = crc ^ POLYNOMIAL_LE;
717             }
718         }
719     }
720 
721     return crc;
722 }
723 
724 #define MIN_BUF_SIZE 60
725 
726 static ssize_t sunhme_receive(NetClientState *nc, const uint8_t *buf,
727                               size_t size)
728 {
729     SunHMEState *s = qemu_get_nic_opaque(nc);
730     PCIDevice *d = PCI_DEVICE(s);
731     dma_addr_t rb, addr;
732     uint32_t intstatus, status, buffer, buffersize, sum;
733     uint16_t csum;
734     uint8_t buf1[60];
735     int nr, cr, len, rxoffset, csum_offset;
736 
737     trace_sunhme_rx_incoming(size);
738 
739     /* Do nothing if MAC RX disabled */
740     if (!(s->macregs[HME_MACI_RXCFG >> 2] & HME_MAC_RXCFG_ENABLE)) {
741         return -1;
742     }
743 
744     trace_sunhme_rx_filter_destmac(buf[0], buf[1], buf[2],
745                                    buf[3], buf[4], buf[5]);
746 
747     /* Check destination MAC address */
748     if (!(s->macregs[HME_MACI_RXCFG >> 2] & HME_MAC_RXCFG_PMISC)) {
749         /* Try and match local MAC address */
750         if (((s->macregs[HME_MACI_MACADDR0 >> 2] & 0xff00) >> 8) == buf[0] &&
751              (s->macregs[HME_MACI_MACADDR0 >> 2] & 0xff) == buf[1] &&
752             ((s->macregs[HME_MACI_MACADDR1 >> 2] & 0xff00) >> 8) == buf[2] &&
753              (s->macregs[HME_MACI_MACADDR1 >> 2] & 0xff) == buf[3] &&
754             ((s->macregs[HME_MACI_MACADDR2 >> 2] & 0xff00) >> 8) == buf[4] &&
755              (s->macregs[HME_MACI_MACADDR2 >> 2] & 0xff) == buf[5]) {
756             /* Matched local MAC address */
757             trace_sunhme_rx_filter_local_match();
758         } else if (buf[0] == 0xff && buf[1] == 0xff && buf[2] == 0xff &&
759                    buf[3] == 0xff && buf[4] == 0xff && buf[5] == 0xff) {
760             /* Matched broadcast address */
761             trace_sunhme_rx_filter_bcast_match();
762         } else if (s->macregs[HME_MACI_RXCFG >> 2] & HME_MAC_RXCFG_HENABLE) {
763             /* Didn't match local address, check hash filter */
764             int mcast_idx = sunhme_crc32_le(buf, 6) >> 26;
765             if (!(s->macregs[(HME_MACI_HASHTAB0 >> 2) - (mcast_idx >> 4)] &
766                     (1 << (mcast_idx & 0xf)))) {
767                 /* Didn't match hash filter */
768                 trace_sunhme_rx_filter_hash_nomatch();
769                 trace_sunhme_rx_filter_reject();
770                 return 0;
771             } else {
772                 trace_sunhme_rx_filter_hash_match();
773             }
774         } else {
775             /* Not for us */
776             trace_sunhme_rx_filter_reject();
777             return 0;
778         }
779     } else {
780         trace_sunhme_rx_filter_promisc_match();
781     }
782 
783     trace_sunhme_rx_filter_accept();
784 
785     /* If too small buffer, then expand it */
786     if (size < MIN_BUF_SIZE) {
787         memcpy(buf1, buf, size);
788         memset(buf1 + size, 0, MIN_BUF_SIZE - size);
789         buf = buf1;
790         size = MIN_BUF_SIZE;
791     }
792 
793     rb = s->erxregs[HME_ERXI_RING >> 2] & HME_ERXI_RING_ADDR;
794     nr = sunhme_get_rx_ring_count(s);
795     cr = sunhme_get_rx_ring_nr(s);
796 
797     pci_dma_read(d, rb + cr * HME_DESC_SIZE, &status, 4);
798     pci_dma_read(d, rb + cr * HME_DESC_SIZE + 4, &buffer, 4);
799 
800     rxoffset = (s->erxregs[HME_ERXI_CFG >> 2] & HME_ERX_CFG_BYTEOFFSET) >>
801                 HME_ERX_CFG_BYTEOFFSET_SHIFT;
802 
803     addr = buffer + rxoffset;
804     buffersize = (status & HME_XD_RXLENMSK) >> HME_XD_RXLENSHIFT;
805 
806     /* Detect receive overflow */
807     len = size;
808     if (size > buffersize) {
809         status |= HME_XD_OFL;
810         len = buffersize;
811     }
812 
813     pci_dma_write(d, addr, buf, len);
814 
815     trace_sunhme_rx_desc(buffer, rxoffset, status, len, cr, nr);
816 
817     /* Calculate the receive checksum */
818     csum_offset = (s->erxregs[HME_ERXI_CFG >> 2] & HME_ERX_CFG_CSUMSTART) >>
819                   HME_ERX_CFG_CSUMSHIFT << 1;
820     sum = 0;
821     sum += net_checksum_add(len - csum_offset, (uint8_t *)buf + csum_offset);
822     csum = net_checksum_finish(sum);
823 
824     trace_sunhme_rx_xsum_calc(csum);
825 
826     /* Update status */
827     status &= ~HME_XD_OWN;
828     status &= ~HME_XD_RXLENMSK;
829     status |= len << HME_XD_RXLENSHIFT;
830     status &= ~HME_XD_RXCKSUM;
831     status |= csum;
832 
833     pci_dma_write(d, rb + cr * HME_DESC_SIZE, &status, 4);
834 
835     cr++;
836     if (cr >= nr) {
837         cr = 0;
838     }
839 
840     sunhme_set_rx_ring_nr(s, cr);
841 
842     /* Indicate RX complete */
843     intstatus = s->sebregs[HME_SEBI_STAT >> 2];
844     intstatus |= HME_SEB_STAT_RXTOHOST;
845     s->sebregs[HME_SEBI_STAT >> 2] = intstatus;
846 
847     sunhme_update_irq(s);
848 
849     return len;
850 }
851 
852 static NetClientInfo net_sunhme_info = {
853     .type = NET_CLIENT_DRIVER_NIC,
854     .size = sizeof(NICState),
855     .can_receive = sunhme_can_receive,
856     .receive = sunhme_receive,
857     .link_status_changed = sunhme_link_status_changed,
858 };
859 
860 static void sunhme_realize(PCIDevice *pci_dev, Error **errp)
861 {
862     SunHMEState *s = SUNHME(pci_dev);
863     DeviceState *d = DEVICE(pci_dev);
864     uint8_t *pci_conf;
865 
866     pci_conf = pci_dev->config;
867     pci_conf[PCI_INTERRUPT_PIN] = 1;    /* interrupt pin A */
868 
869     memory_region_init(&s->hme, OBJECT(pci_dev), "sunhme", HME_REG_SIZE);
870     pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY, &s->hme);
871 
872     memory_region_init_io(&s->sebreg, OBJECT(pci_dev), &sunhme_seb_ops, s,
873                           "sunhme.seb", HME_SEB_REG_SIZE);
874     memory_region_add_subregion(&s->hme, 0, &s->sebreg);
875 
876     memory_region_init_io(&s->etxreg, OBJECT(pci_dev), &sunhme_etx_ops, s,
877                           "sunhme.etx", HME_ETX_REG_SIZE);
878     memory_region_add_subregion(&s->hme, 0x2000, &s->etxreg);
879 
880     memory_region_init_io(&s->erxreg, OBJECT(pci_dev), &sunhme_erx_ops, s,
881                           "sunhme.erx", HME_ERX_REG_SIZE);
882     memory_region_add_subregion(&s->hme, 0x4000, &s->erxreg);
883 
884     memory_region_init_io(&s->macreg, OBJECT(pci_dev), &sunhme_mac_ops, s,
885                           "sunhme.mac", HME_MAC_REG_SIZE);
886     memory_region_add_subregion(&s->hme, 0x6000, &s->macreg);
887 
888     memory_region_init_io(&s->mifreg, OBJECT(pci_dev), &sunhme_mif_ops, s,
889                           "sunhme.mif", HME_MIF_REG_SIZE);
890     memory_region_add_subregion(&s->hme, 0x7000, &s->mifreg);
891 
892     qemu_macaddr_default_if_unset(&s->conf.macaddr);
893     s->nic = qemu_new_nic(&net_sunhme_info, &s->conf,
894                           object_get_typename(OBJECT(d)), d->id, s);
895     qemu_format_nic_info_str(qemu_get_queue(s->nic), s->conf.macaddr.a);
896 }
897 
898 static void sunhme_instance_init(Object *obj)
899 {
900     SunHMEState *s = SUNHME(obj);
901 
902     device_add_bootindex_property(obj, &s->conf.bootindex,
903                                   "bootindex", "/ethernet-phy@0",
904                                   DEVICE(obj), NULL);
905 }
906 
907 static void sunhme_reset(DeviceState *ds)
908 {
909     SunHMEState *s = SUNHME(ds);
910 
911     /* Configure internal transceiver */
912     s->mifregs[HME_MIFI_CFG >> 2] |= HME_MIF_CFG_MDI0;
913 
914     /* Advetise auto, 100Mbps FD */
915     s->miiregs[MII_ANAR] = MII_ANAR_TXFD;
916     s->miiregs[MII_BMSR] = MII_BMSR_AUTONEG | MII_BMSR_100TX_FD |
917                            MII_BMSR_AN_COMP;
918 
919     if (!qemu_get_queue(s->nic)->link_down) {
920         s->miiregs[MII_ANLPAR] |= MII_ANLPAR_TXFD;
921         s->miiregs[MII_BMSR] |= MII_BMSR_LINK_ST;
922     }
923 
924     /* Set manufacturer */
925     s->miiregs[MII_PHYID1] = DP83840_PHYID1;
926     s->miiregs[MII_PHYID2] = DP83840_PHYID2;
927 
928     /* Configure default interrupt mask */
929     s->mifregs[HME_MIFI_IMASK >> 2] = 0xffff;
930     s->sebregs[HME_SEBI_IMASK >> 2] = 0xff7fffff;
931 }
932 
933 static const VMStateDescription vmstate_hme = {
934     .name = "sunhme",
935     .version_id = 0,
936     .minimum_version_id = 0,
937     .fields = (VMStateField[]) {
938         VMSTATE_PCI_DEVICE(parent_obj, SunHMEState),
939         VMSTATE_MACADDR(conf.macaddr, SunHMEState),
940         VMSTATE_UINT32_ARRAY(sebregs, SunHMEState, (HME_SEB_REG_SIZE >> 2)),
941         VMSTATE_UINT32_ARRAY(etxregs, SunHMEState, (HME_ETX_REG_SIZE >> 2)),
942         VMSTATE_UINT32_ARRAY(erxregs, SunHMEState, (HME_ERX_REG_SIZE >> 2)),
943         VMSTATE_UINT32_ARRAY(macregs, SunHMEState, (HME_MAC_REG_SIZE >> 2)),
944         VMSTATE_UINT32_ARRAY(mifregs, SunHMEState, (HME_MIF_REG_SIZE >> 2)),
945         VMSTATE_UINT16_ARRAY(miiregs, SunHMEState, HME_MII_REGS_SIZE),
946         VMSTATE_END_OF_LIST()
947     }
948 };
949 
950 static void sunhme_class_init(ObjectClass *klass, void *data)
951 {
952     DeviceClass *dc = DEVICE_CLASS(klass);
953     PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
954 
955     k->realize = sunhme_realize;
956     k->vendor_id = PCI_VENDOR_ID_SUN;
957     k->device_id = PCI_DEVICE_ID_SUN_HME;
958     k->class_id = PCI_CLASS_NETWORK_ETHERNET;
959     dc->vmsd = &vmstate_hme;
960     dc->reset = sunhme_reset;
961     dc->props = sunhme_properties;
962     set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
963 }
964 
965 static const TypeInfo sunhme_info = {
966     .name          = TYPE_SUNHME,
967     .parent        = TYPE_PCI_DEVICE,
968     .class_init    = sunhme_class_init,
969     .instance_size = sizeof(SunHMEState),
970     .instance_init = sunhme_instance_init,
971 };
972 
973 static void sunhme_register_types(void)
974 {
975     type_register_static(&sunhme_info);
976 }
977 
978 type_init(sunhme_register_types)
979