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