1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include "hw.h"
26#include "sysbus.h"
27#include "trace.h"
28#include "net.h"
29#include "qemu-error.h"
30#include "qdev-addr.h"
31
32#include <zlib.h>
33
34enum {
35 R_SETUP = 0,
36 R_MDIO,
37 R_STATE0,
38 R_COUNT0,
39 R_STATE1,
40 R_COUNT1,
41 R_TXCOUNT,
42 R_MAX
43};
44
45enum {
46 SETUP_PHY_RST = (1<<0),
47};
48
49enum {
50 MDIO_DO = (1<<0),
51 MDIO_DI = (1<<1),
52 MDIO_OE = (1<<2),
53 MDIO_CLK = (1<<3),
54};
55
56enum {
57 STATE_EMPTY = 0,
58 STATE_LOADED = 1,
59 STATE_PENDING = 2,
60};
61
62enum {
63 MDIO_OP_WRITE = 1,
64 MDIO_OP_READ = 2,
65};
66
67enum mdio_state {
68 MDIO_STATE_IDLE,
69 MDIO_STATE_READING,
70 MDIO_STATE_WRITING,
71};
72
73enum {
74 R_PHY_ID1 = 2,
75 R_PHY_ID2 = 3,
76 R_PHY_MAX = 32
77};
78
79#define MINIMAC2_MTU 1530
80#define MINIMAC2_BUFFER_SIZE 2048
81
82struct MilkymistMinimac2MdioState {
83 int last_clk;
84 int count;
85 uint32_t data;
86 uint16_t data_out;
87 int state;
88
89 uint8_t phy_addr;
90 uint8_t reg_addr;
91};
92typedef struct MilkymistMinimac2MdioState MilkymistMinimac2MdioState;
93
94struct MilkymistMinimac2State {
95 SysBusDevice busdev;
96 NICState *nic;
97 NICConf conf;
98 char *phy_model;
99 hwaddr buffers_base;
100 MemoryRegion buffers;
101 MemoryRegion regs_region;
102
103 qemu_irq rx_irq;
104 qemu_irq tx_irq;
105
106 uint32_t regs[R_MAX];
107
108 MilkymistMinimac2MdioState mdio;
109
110 uint16_t phy_regs[R_PHY_MAX];
111
112 uint8_t *rx0_buf;
113 uint8_t *rx1_buf;
114 uint8_t *tx_buf;
115};
116typedef struct MilkymistMinimac2State MilkymistMinimac2State;
117
118static const uint8_t preamble_sfd[] = {
119 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0xd5
120};
121
122static void minimac2_mdio_write_reg(MilkymistMinimac2State *s,
123 uint8_t phy_addr, uint8_t reg_addr, uint16_t value)
124{
125 trace_milkymist_minimac2_mdio_write(phy_addr, reg_addr, value);
126
127
128}
129
130static uint16_t minimac2_mdio_read_reg(MilkymistMinimac2State *s,
131 uint8_t phy_addr, uint8_t reg_addr)
132{
133 uint16_t r = s->phy_regs[reg_addr];
134
135 trace_milkymist_minimac2_mdio_read(phy_addr, reg_addr, r);
136
137 return r;
138}
139
140static void minimac2_update_mdio(MilkymistMinimac2State *s)
141{
142 MilkymistMinimac2MdioState *m = &s->mdio;
143
144
145 if (m->last_clk == 0 && (s->regs[R_MDIO] & MDIO_CLK)) {
146
147 int bit = ((s->regs[R_MDIO] & MDIO_DO)
148 && (s->regs[R_MDIO] & MDIO_OE)) ? 1 : 0;
149 m->data = (m->data << 1) | bit;
150
151
152 if (m->data == 0xffffffff) {
153 m->count = 32;
154 }
155
156 if (m->count == 16) {
157 uint8_t start = (m->data >> 14) & 0x3;
158 uint8_t op = (m->data >> 12) & 0x3;
159 uint8_t ta = (m->data) & 0x3;
160
161 if (start == 1 && op == MDIO_OP_WRITE && ta == 2) {
162 m->state = MDIO_STATE_WRITING;
163 } else if (start == 1 && op == MDIO_OP_READ && (ta & 1) == 0) {
164 m->state = MDIO_STATE_READING;
165 } else {
166 m->state = MDIO_STATE_IDLE;
167 }
168
169 if (m->state != MDIO_STATE_IDLE) {
170 m->phy_addr = (m->data >> 7) & 0x1f;
171 m->reg_addr = (m->data >> 2) & 0x1f;
172 }
173
174 if (m->state == MDIO_STATE_READING) {
175 m->data_out = minimac2_mdio_read_reg(s, m->phy_addr,
176 m->reg_addr);
177 }
178 }
179
180 if (m->count < 16 && m->state == MDIO_STATE_READING) {
181 int bit = (m->data_out & 0x8000) ? 1 : 0;
182 m->data_out <<= 1;
183
184 if (bit) {
185 s->regs[R_MDIO] |= MDIO_DI;
186 } else {
187 s->regs[R_MDIO] &= ~MDIO_DI;
188 }
189 }
190
191 if (m->count == 0 && m->state) {
192 if (m->state == MDIO_STATE_WRITING) {
193 uint16_t data = m->data & 0xffff;
194 minimac2_mdio_write_reg(s, m->phy_addr, m->reg_addr, data);
195 }
196 m->state = MDIO_STATE_IDLE;
197 }
198 m->count--;
199 }
200
201 m->last_clk = (s->regs[R_MDIO] & MDIO_CLK) ? 1 : 0;
202}
203
204static size_t assemble_frame(uint8_t *buf, size_t size,
205 const uint8_t *payload, size_t payload_size)
206{
207 uint32_t crc;
208
209 if (size < payload_size + 12) {
210 error_report("milkymist_minimac2: received too big ethernet frame");
211 return 0;
212 }
213
214
215 memcpy(buf, preamble_sfd, 8);
216
217
218 memcpy(buf + 8, payload, payload_size);
219
220
221 if (payload_size < 60) {
222 memset(buf + payload_size + 8, 0, 60 - payload_size);
223 payload_size = 60;
224 }
225
226
227 crc = cpu_to_le32(crc32(0, buf + 8, payload_size));
228 memcpy(buf + payload_size + 8, &crc, 4);
229
230 return payload_size + 12;
231}
232
233static void minimac2_tx(MilkymistMinimac2State *s)
234{
235 uint32_t txcount = s->regs[R_TXCOUNT];
236 uint8_t *buf = s->tx_buf;
237
238 if (txcount < 64) {
239 error_report("milkymist_minimac2: ethernet frame too small (%u < %u)",
240 txcount, 64);
241 goto err;
242 }
243
244 if (txcount > MINIMAC2_MTU) {
245 error_report("milkymist_minimac2: MTU exceeded (%u > %u)",
246 txcount, MINIMAC2_MTU);
247 goto err;
248 }
249
250 if (memcmp(buf, preamble_sfd, 8) != 0) {
251 error_report("milkymist_minimac2: frame doesn't contain the preamble "
252 "and/or the SFD (%02x %02x %02x %02x %02x %02x %02x %02x)",
253 buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6], buf[7]);
254 goto err;
255 }
256
257 trace_milkymist_minimac2_tx_frame(txcount - 12);
258
259
260 qemu_send_packet_raw(&s->nic->nc, buf + 8, txcount - 12);
261
262 s->regs[R_TXCOUNT] = 0;
263
264err:
265 trace_milkymist_minimac2_pulse_irq_tx();
266 qemu_irq_pulse(s->tx_irq);
267}
268
269static void update_rx_interrupt(MilkymistMinimac2State *s)
270{
271 if (s->regs[R_STATE0] == STATE_PENDING
272 || s->regs[R_STATE1] == STATE_PENDING) {
273 trace_milkymist_minimac2_raise_irq_rx();
274 qemu_irq_raise(s->rx_irq);
275 } else {
276 trace_milkymist_minimac2_lower_irq_rx();
277 qemu_irq_lower(s->rx_irq);
278 }
279}
280
281static ssize_t minimac2_rx(NetClientState *nc, const uint8_t *buf, size_t size)
282{
283 MilkymistMinimac2State *s = DO_UPCAST(NICState, nc, nc)->opaque;
284
285 uint32_t r_count;
286 uint32_t r_state;
287 uint8_t *rx_buf;
288
289 size_t frame_size;
290
291 trace_milkymist_minimac2_rx_frame(buf, size);
292
293
294 if (s->regs[R_STATE0] == STATE_LOADED) {
295 r_count = R_COUNT0;
296 r_state = R_STATE0;
297 rx_buf = s->rx0_buf;
298 } else if (s->regs[R_STATE1] == STATE_LOADED) {
299 r_count = R_COUNT1;
300 r_state = R_STATE1;
301 rx_buf = s->rx1_buf;
302 } else {
303 trace_milkymist_minimac2_drop_rx_frame(buf);
304 return size;
305 }
306
307
308 frame_size = assemble_frame(rx_buf, MINIMAC2_BUFFER_SIZE, buf, size);
309
310 if (frame_size == 0) {
311 return size;
312 }
313
314 trace_milkymist_minimac2_rx_transfer(rx_buf, frame_size);
315
316
317 s->regs[r_count] = frame_size;
318 s->regs[r_state] = STATE_PENDING;
319
320 update_rx_interrupt(s);
321
322 return size;
323}
324
325static uint64_t
326minimac2_read(void *opaque, hwaddr addr, unsigned size)
327{
328 MilkymistMinimac2State *s = opaque;
329 uint32_t r = 0;
330
331 addr >>= 2;
332 switch (addr) {
333 case R_SETUP:
334 case R_MDIO:
335 case R_STATE0:
336 case R_COUNT0:
337 case R_STATE1:
338 case R_COUNT1:
339 case R_TXCOUNT:
340 r = s->regs[addr];
341 break;
342
343 default:
344 error_report("milkymist_minimac2: read access to unknown register 0x"
345 TARGET_FMT_plx, addr << 2);
346 break;
347 }
348
349 trace_milkymist_minimac2_memory_read(addr << 2, r);
350
351 return r;
352}
353
354static void
355minimac2_write(void *opaque, hwaddr addr, uint64_t value,
356 unsigned size)
357{
358 MilkymistMinimac2State *s = opaque;
359
360 trace_milkymist_minimac2_memory_read(addr, value);
361
362 addr >>= 2;
363 switch (addr) {
364 case R_MDIO:
365 {
366
367 int mdio_di = (s->regs[R_MDIO] & MDIO_DI);
368 s->regs[R_MDIO] = value;
369 if (mdio_di) {
370 s->regs[R_MDIO] |= mdio_di;
371 } else {
372 s->regs[R_MDIO] &= ~mdio_di;
373 }
374
375 minimac2_update_mdio(s);
376 } break;
377 case R_TXCOUNT:
378 s->regs[addr] = value;
379 if (value > 0) {
380 minimac2_tx(s);
381 }
382 break;
383 case R_STATE0:
384 case R_STATE1:
385 s->regs[addr] = value;
386 update_rx_interrupt(s);
387 break;
388 case R_SETUP:
389 case R_COUNT0:
390 case R_COUNT1:
391 s->regs[addr] = value;
392 break;
393
394 default:
395 error_report("milkymist_minimac2: write access to unknown register 0x"
396 TARGET_FMT_plx, addr << 2);
397 break;
398 }
399}
400
401static const MemoryRegionOps minimac2_ops = {
402 .read = minimac2_read,
403 .write = minimac2_write,
404 .valid = {
405 .min_access_size = 4,
406 .max_access_size = 4,
407 },
408 .endianness = DEVICE_NATIVE_ENDIAN,
409};
410
411static int minimac2_can_rx(NetClientState *nc)
412{
413 MilkymistMinimac2State *s = DO_UPCAST(NICState, nc, nc)->opaque;
414
415 if (s->regs[R_STATE0] == STATE_LOADED) {
416 return 1;
417 }
418 if (s->regs[R_STATE1] == STATE_LOADED) {
419 return 1;
420 }
421
422 return 0;
423}
424
425static void minimac2_cleanup(NetClientState *nc)
426{
427 MilkymistMinimac2State *s = DO_UPCAST(NICState, nc, nc)->opaque;
428
429 s->nic = NULL;
430}
431
432static void milkymist_minimac2_reset(DeviceState *d)
433{
434 MilkymistMinimac2State *s =
435 container_of(d, MilkymistMinimac2State, busdev.qdev);
436 int i;
437
438 for (i = 0; i < R_MAX; i++) {
439 s->regs[i] = 0;
440 }
441 for (i = 0; i < R_PHY_MAX; i++) {
442 s->phy_regs[i] = 0;
443 }
444
445
446 s->phy_regs[R_PHY_ID1] = 0x0022;
447 s->phy_regs[R_PHY_ID2] = 0x161a;
448}
449
450static NetClientInfo net_milkymist_minimac2_info = {
451 .type = NET_CLIENT_OPTIONS_KIND_NIC,
452 .size = sizeof(NICState),
453 .can_receive = minimac2_can_rx,
454 .receive = minimac2_rx,
455 .cleanup = minimac2_cleanup,
456};
457
458static int milkymist_minimac2_init(SysBusDevice *dev)
459{
460 MilkymistMinimac2State *s = FROM_SYSBUS(typeof(*s), dev);
461 size_t buffers_size = TARGET_PAGE_ALIGN(3 * MINIMAC2_BUFFER_SIZE);
462
463 sysbus_init_irq(dev, &s->rx_irq);
464 sysbus_init_irq(dev, &s->tx_irq);
465
466 memory_region_init_io(&s->regs_region, &minimac2_ops, s,
467 "milkymist-minimac2", R_MAX * 4);
468 sysbus_init_mmio(dev, &s->regs_region);
469
470
471 memory_region_init_ram(&s->buffers, "milkymist-minimac2.buffers",
472 buffers_size);
473 vmstate_register_ram_global(&s->buffers);
474 s->rx0_buf = memory_region_get_ram_ptr(&s->buffers);
475 s->rx1_buf = s->rx0_buf + MINIMAC2_BUFFER_SIZE;
476 s->tx_buf = s->rx1_buf + MINIMAC2_BUFFER_SIZE;
477
478 sysbus_add_memory(dev, s->buffers_base, &s->buffers);
479
480 qemu_macaddr_default_if_unset(&s->conf.macaddr);
481 s->nic = qemu_new_nic(&net_milkymist_minimac2_info, &s->conf,
482 object_get_typename(OBJECT(dev)), dev->qdev.id, s);
483 qemu_format_nic_info_str(&s->nic->nc, s->conf.macaddr.a);
484
485 return 0;
486}
487
488static const VMStateDescription vmstate_milkymist_minimac2_mdio = {
489 .name = "milkymist-minimac2-mdio",
490 .version_id = 1,
491 .minimum_version_id = 1,
492 .minimum_version_id_old = 1,
493 .fields = (VMStateField[]) {
494 VMSTATE_INT32(last_clk, MilkymistMinimac2MdioState),
495 VMSTATE_INT32(count, MilkymistMinimac2MdioState),
496 VMSTATE_UINT32(data, MilkymistMinimac2MdioState),
497 VMSTATE_UINT16(data_out, MilkymistMinimac2MdioState),
498 VMSTATE_INT32(state, MilkymistMinimac2MdioState),
499 VMSTATE_UINT8(phy_addr, MilkymistMinimac2MdioState),
500 VMSTATE_UINT8(reg_addr, MilkymistMinimac2MdioState),
501 VMSTATE_END_OF_LIST()
502 }
503};
504
505static const VMStateDescription vmstate_milkymist_minimac2 = {
506 .name = "milkymist-minimac2",
507 .version_id = 1,
508 .minimum_version_id = 1,
509 .minimum_version_id_old = 1,
510 .fields = (VMStateField[]) {
511 VMSTATE_UINT32_ARRAY(regs, MilkymistMinimac2State, R_MAX),
512 VMSTATE_UINT16_ARRAY(phy_regs, MilkymistMinimac2State, R_PHY_MAX),
513 VMSTATE_STRUCT(mdio, MilkymistMinimac2State, 0,
514 vmstate_milkymist_minimac2_mdio, MilkymistMinimac2MdioState),
515 VMSTATE_END_OF_LIST()
516 }
517};
518
519static Property milkymist_minimac2_properties[] = {
520 DEFINE_PROP_TADDR("buffers_base", MilkymistMinimac2State,
521 buffers_base, 0),
522 DEFINE_NIC_PROPERTIES(MilkymistMinimac2State, conf),
523 DEFINE_PROP_STRING("phy_model", MilkymistMinimac2State, phy_model),
524 DEFINE_PROP_END_OF_LIST(),
525};
526
527static void milkymist_minimac2_class_init(ObjectClass *klass, void *data)
528{
529 DeviceClass *dc = DEVICE_CLASS(klass);
530 SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
531
532 k->init = milkymist_minimac2_init;
533 dc->reset = milkymist_minimac2_reset;
534 dc->vmsd = &vmstate_milkymist_minimac2;
535 dc->props = milkymist_minimac2_properties;
536}
537
538static TypeInfo milkymist_minimac2_info = {
539 .name = "milkymist-minimac2",
540 .parent = TYPE_SYS_BUS_DEVICE,
541 .instance_size = sizeof(MilkymistMinimac2State),
542 .class_init = milkymist_minimac2_class_init,
543};
544
545static void milkymist_minimac2_register_types(void)
546{
547 type_register_static(&milkymist_minimac2_info);
548}
549
550type_init(milkymist_minimac2_register_types)
551
