|
|
1.1 root 1: /*
2: * QEMU model of the Xilinx Ethernet Lite MAC.
3: *
4: * Copyright (c) 2009 Edgar E. Iglesias.
5: *
6: * Permission is hereby granted, free of charge, to any person obtaining a copy
7: * of this software and associated documentation files (the "Software"), to deal
8: * in the Software without restriction, including without limitation the rights
9: * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10: * copies of the Software, and to permit persons to whom the Software is
11: * furnished to do so, subject to the following conditions:
12: *
13: * The above copyright notice and this permission notice shall be included in
14: * all copies or substantial portions of the Software.
15: *
16: * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17: * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18: * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19: * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20: * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21: * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22: * THE SOFTWARE.
23: */
24:
25: #include "sysbus.h"
26: #include "hw.h"
27: #include "net.h"
28:
29: #define D(x)
30: #define R_TX_BUF0 0
31: #define R_TX_LEN0 (0x07f4 / 4)
32: #define R_TX_GIE0 (0x07f8 / 4)
33: #define R_TX_CTRL0 (0x07fc / 4)
34: #define R_TX_BUF1 (0x0800 / 4)
35: #define R_TX_LEN1 (0x0ff4 / 4)
36: #define R_TX_CTRL1 (0x0ffc / 4)
37:
38: #define R_RX_BUF0 (0x1000 / 4)
39: #define R_RX_CTRL0 (0x17fc / 4)
40: #define R_RX_BUF1 (0x1800 / 4)
41: #define R_RX_CTRL1 (0x1ffc / 4)
42: #define R_MAX (0x2000 / 4)
43:
44: #define GIE_GIE 0x80000000
45:
46: #define CTRL_I 0x8
47: #define CTRL_P 0x2
48: #define CTRL_S 0x1
49:
50: struct xlx_ethlite
51: {
52: SysBusDevice busdev;
53: qemu_irq irq;
1.1.1.2 root 54: NICState *nic;
55: NICConf conf;
1.1 root 56:
57: uint32_t c_tx_pingpong;
58: uint32_t c_rx_pingpong;
59: unsigned int txbuf;
60: unsigned int rxbuf;
61:
62: uint32_t regs[R_MAX];
63: };
64:
65: static inline void eth_pulse_irq(struct xlx_ethlite *s)
66: {
67: /* Only the first gie reg is active. */
68: if (s->regs[R_TX_GIE0] & GIE_GIE) {
69: qemu_irq_pulse(s->irq);
70: }
71: }
72:
73: static uint32_t eth_readl (void *opaque, target_phys_addr_t addr)
74: {
75: struct xlx_ethlite *s = opaque;
76: uint32_t r = 0;
77:
78: addr >>= 2;
79:
80: switch (addr)
81: {
82: case R_TX_GIE0:
83: case R_TX_LEN0:
84: case R_TX_LEN1:
85: case R_TX_CTRL1:
86: case R_TX_CTRL0:
87: case R_RX_CTRL1:
88: case R_RX_CTRL0:
89: r = s->regs[addr];
90: D(qemu_log("%s %x=%x\n", __func__, addr * 4, r));
91: break;
92:
93: default:
1.1.1.4 ! root 94: r = tswap32(s->regs[addr]);
1.1 root 95: break;
96: }
97: return r;
98: }
99:
100: static void
101: eth_writel (void *opaque, target_phys_addr_t addr, uint32_t value)
102: {
103: struct xlx_ethlite *s = opaque;
104: unsigned int base = 0;
105:
106: addr >>= 2;
107: switch (addr)
108: {
109: case R_TX_CTRL0:
110: case R_TX_CTRL1:
111: if (addr == R_TX_CTRL1)
112: base = 0x800 / 4;
113:
114: D(qemu_log("%s addr=%x val=%x\n", __func__, addr * 4, value));
115: if ((value & (CTRL_P | CTRL_S)) == CTRL_S) {
1.1.1.2 root 116: qemu_send_packet(&s->nic->nc,
1.1 root 117: (void *) &s->regs[base],
118: s->regs[base + R_TX_LEN0]);
119: D(qemu_log("eth_tx %d\n", s->regs[base + R_TX_LEN0]));
120: if (s->regs[base + R_TX_CTRL0] & CTRL_I)
121: eth_pulse_irq(s);
122: } else if ((value & (CTRL_P | CTRL_S)) == (CTRL_P | CTRL_S)) {
1.1.1.2 root 123: memcpy(&s->conf.macaddr.a[0], &s->regs[base], 6);
1.1 root 124: if (s->regs[base + R_TX_CTRL0] & CTRL_I)
125: eth_pulse_irq(s);
126: }
127:
128: /* We are fast and get ready pretty much immediately so
129: we actually never flip the S nor P bits to one. */
130: s->regs[addr] = value & ~(CTRL_P | CTRL_S);
131: break;
132:
133: /* Keep these native. */
134: case R_TX_LEN0:
135: case R_TX_LEN1:
136: case R_TX_GIE0:
137: case R_RX_CTRL0:
138: case R_RX_CTRL1:
139: D(qemu_log("%s addr=%x val=%x\n", __func__, addr * 4, value));
140: s->regs[addr] = value;
141: break;
142:
143: default:
1.1.1.4 ! root 144: s->regs[addr] = tswap32(value);
1.1 root 145: break;
146: }
147: }
148:
1.1.1.2 root 149: static CPUReadMemoryFunc * const eth_read[] = {
1.1 root 150: NULL, NULL, ð_readl,
151: };
152:
1.1.1.2 root 153: static CPUWriteMemoryFunc * const eth_write[] = {
1.1 root 154: NULL, NULL, ð_writel,
155: };
156:
1.1.1.2 root 157: static int eth_can_rx(VLANClientState *nc)
1.1 root 158: {
1.1.1.2 root 159: struct xlx_ethlite *s = DO_UPCAST(NICState, nc, nc)->opaque;
1.1 root 160: int r;
161: r = !(s->regs[R_RX_CTRL0] & CTRL_S);
162: return r;
163: }
164:
1.1.1.2 root 165: static ssize_t eth_rx(VLANClientState *nc, const uint8_t *buf, size_t size)
1.1 root 166: {
1.1.1.2 root 167: struct xlx_ethlite *s = DO_UPCAST(NICState, nc, nc)->opaque;
1.1 root 168: unsigned int rxbase = s->rxbuf * (0x800 / 4);
169:
170: /* DA filter. */
1.1.1.2 root 171: if (!(buf[0] & 0x80) && memcmp(&s->conf.macaddr.a[0], buf, 6))
1.1 root 172: return size;
173:
174: if (s->regs[rxbase + R_RX_CTRL0] & CTRL_S) {
175: D(qemu_log("ethlite lost packet %x\n", s->regs[R_RX_CTRL0]));
176: return -1;
177: }
178:
179: D(qemu_log("%s %d rxbase=%x\n", __func__, size, rxbase));
180: memcpy(&s->regs[rxbase + R_RX_BUF0], buf, size);
181:
182: s->regs[rxbase + R_RX_CTRL0] |= CTRL_S;
183: if (s->regs[rxbase + R_RX_CTRL0] & CTRL_I)
184: eth_pulse_irq(s);
185:
186: /* If c_rx_pingpong was set flip buffers. */
187: s->rxbuf ^= s->c_rx_pingpong;
188: return size;
189: }
190:
1.1.1.2 root 191: static void eth_cleanup(VLANClientState *nc)
1.1 root 192: {
1.1.1.2 root 193: struct xlx_ethlite *s = DO_UPCAST(NICState, nc, nc)->opaque;
194:
195: s->nic = NULL;
1.1 root 196: }
197:
1.1.1.2 root 198: static NetClientInfo net_xilinx_ethlite_info = {
199: .type = NET_CLIENT_TYPE_NIC,
200: .size = sizeof(NICState),
201: .can_receive = eth_can_rx,
202: .receive = eth_rx,
203: .cleanup = eth_cleanup,
204: };
205:
206: static int xilinx_ethlite_init(SysBusDevice *dev)
1.1 root 207: {
208: struct xlx_ethlite *s = FROM_SYSBUS(typeof (*s), dev);
209: int regs;
210:
211: sysbus_init_irq(dev, &s->irq);
212: s->rxbuf = 0;
213:
1.1.1.3 root 214: regs = cpu_register_io_memory(eth_read, eth_write, s, DEVICE_NATIVE_ENDIAN);
1.1 root 215: sysbus_init_mmio(dev, R_MAX * 4, regs);
216:
1.1.1.2 root 217: qemu_macaddr_default_if_unset(&s->conf.macaddr);
218: s->nic = qemu_new_nic(&net_xilinx_ethlite_info, &s->conf,
219: dev->qdev.info->name, dev->qdev.id, s);
220: qemu_format_nic_info_str(&s->nic->nc, s->conf.macaddr.a);
221: return 0;
1.1 root 222: }
223:
224: static SysBusDeviceInfo xilinx_ethlite_info = {
225: .init = xilinx_ethlite_init,
226: .qdev.name = "xilinx,ethlite",
227: .qdev.size = sizeof(struct xlx_ethlite),
228: .qdev.props = (Property[]) {
1.1.1.2 root 229: DEFINE_PROP_UINT32("txpingpong", struct xlx_ethlite, c_tx_pingpong, 1),
230: DEFINE_PROP_UINT32("rxpingpong", struct xlx_ethlite, c_rx_pingpong, 1),
231: DEFINE_NIC_PROPERTIES(struct xlx_ethlite, conf),
232: DEFINE_PROP_END_OF_LIST(),
1.1 root 233: }
234: };
235:
236: static void xilinx_ethlite_register(void)
237: {
238: sysbus_register_withprop(&xilinx_ethlite_info);
239: }
240:
241: device_init(xilinx_ethlite_register)
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.