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