xref: /qemu/hw/net/spapr_llan.c (revision d6454270575da1f16a8923c7cb240e46ef243f72)
18d90ad90SDavid Gibson /*
28d90ad90SDavid Gibson  * QEMU PowerPC pSeries Logical Partition (aka sPAPR) hardware System Emulator
38d90ad90SDavid Gibson  *
48d90ad90SDavid Gibson  * PAPR Inter-VM Logical Lan, aka ibmveth
58d90ad90SDavid Gibson  *
68d90ad90SDavid Gibson  * Copyright (c) 2010,2011 David Gibson, IBM Corporation.
78d90ad90SDavid Gibson  *
88d90ad90SDavid Gibson  * Permission is hereby granted, free of charge, to any person obtaining a copy
98d90ad90SDavid Gibson  * of this software and associated documentation files (the "Software"), to deal
108d90ad90SDavid Gibson  * in the Software without restriction, including without limitation the rights
118d90ad90SDavid Gibson  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
128d90ad90SDavid Gibson  * copies of the Software, and to permit persons to whom the Software is
138d90ad90SDavid Gibson  * furnished to do so, subject to the following conditions:
148d90ad90SDavid Gibson  *
158d90ad90SDavid Gibson  * The above copyright notice and this permission notice shall be included in
168d90ad90SDavid Gibson  * all copies or substantial portions of the Software.
178d90ad90SDavid Gibson  *
188d90ad90SDavid Gibson  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
198d90ad90SDavid Gibson  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
208d90ad90SDavid Gibson  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
218d90ad90SDavid Gibson  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
228d90ad90SDavid Gibson  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
238d90ad90SDavid Gibson  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
248d90ad90SDavid Gibson  * THE SOFTWARE.
258d90ad90SDavid Gibson  *
268d90ad90SDavid Gibson  */
270b8fa32fSMarkus Armbruster 
280d75590dSPeter Maydell #include "qemu/osdep.h"
294771d756SPaolo Bonzini #include "cpu.h"
3083c9f4caSPaolo Bonzini #include "hw/hw.h"
3164552b6bSMarkus Armbruster #include "hw/irq.h"
3203dd024fSPaolo Bonzini #include "qemu/log.h"
330b8fa32fSMarkus Armbruster #include "qemu/module.h"
341422e32dSPaolo Bonzini #include "net/net.h"
358d90ad90SDavid Gibson #include "hw/qdev.h"
36*d6454270SMarkus Armbruster #include "migration/vmstate.h"
370d09e41aSPaolo Bonzini #include "hw/ppc/spapr.h"
380d09e41aSPaolo Bonzini #include "hw/ppc/spapr_vio.h"
39ad4f62d0SAlexey Kardashevskiy #include "sysemu/sysemu.h"
40e8bb33deSLaurent Vivier #include "trace.h"
418d90ad90SDavid Gibson 
428d90ad90SDavid Gibson #include <libfdt.h>
438d90ad90SDavid Gibson 
448d90ad90SDavid Gibson #define ETH_ALEN        6
458d90ad90SDavid Gibson #define MAX_PACKET_SIZE 65536
468d90ad90SDavid Gibson 
47831e8822SThomas Huth /* Compatibility flags for migration */
48831e8822SThomas Huth #define SPAPRVLAN_FLAG_RX_BUF_POOLS_BIT  0
49831e8822SThomas Huth #define SPAPRVLAN_FLAG_RX_BUF_POOLS      (1 << SPAPRVLAN_FLAG_RX_BUF_POOLS_BIT)
50831e8822SThomas Huth 
518d90ad90SDavid Gibson /*
528d90ad90SDavid Gibson  * Virtual LAN device
538d90ad90SDavid Gibson  */
548d90ad90SDavid Gibson 
558d90ad90SDavid Gibson typedef uint64_t vlan_bd_t;
568d90ad90SDavid Gibson 
578d90ad90SDavid Gibson #define VLAN_BD_VALID        0x8000000000000000ULL
588d90ad90SDavid Gibson #define VLAN_BD_TOGGLE       0x4000000000000000ULL
598d90ad90SDavid Gibson #define VLAN_BD_NO_CSUM      0x0200000000000000ULL
608d90ad90SDavid Gibson #define VLAN_BD_CSUM_GOOD    0x0100000000000000ULL
618d90ad90SDavid Gibson #define VLAN_BD_LEN_MASK     0x00ffffff00000000ULL
628d90ad90SDavid Gibson #define VLAN_BD_LEN(bd)      (((bd) & VLAN_BD_LEN_MASK) >> 32)
638d90ad90SDavid Gibson #define VLAN_BD_ADDR_MASK    0x00000000ffffffffULL
648d90ad90SDavid Gibson #define VLAN_BD_ADDR(bd)     ((bd) & VLAN_BD_ADDR_MASK)
658d90ad90SDavid Gibson 
668d90ad90SDavid Gibson #define VLAN_VALID_BD(addr, len) (VLAN_BD_VALID | \
678d90ad90SDavid Gibson                                   (((len) << 32) & VLAN_BD_LEN_MASK) |  \
688d90ad90SDavid Gibson                                   (addr & VLAN_BD_ADDR_MASK))
698d90ad90SDavid Gibson 
708d90ad90SDavid Gibson #define VLAN_RXQC_TOGGLE     0x80
718d90ad90SDavid Gibson #define VLAN_RXQC_VALID      0x40
728d90ad90SDavid Gibson #define VLAN_RXQC_NO_CSUM    0x02
738d90ad90SDavid Gibson #define VLAN_RXQC_CSUM_GOOD  0x01
748d90ad90SDavid Gibson 
758d90ad90SDavid Gibson #define VLAN_RQ_ALIGNMENT    16
768d90ad90SDavid Gibson #define VLAN_RXQ_BD_OFF      0
778d90ad90SDavid Gibson #define VLAN_FILTER_BD_OFF   8
788d90ad90SDavid Gibson #define VLAN_RX_BDS_OFF      16
79439ce140SAnton Blanchard /*
80439ce140SAnton Blanchard  * The final 8 bytes of the buffer list is a counter of frames dropped
81439ce140SAnton Blanchard  * because there was not a buffer in the buffer list capable of holding
82439ce140SAnton Blanchard  * the frame. We must avoid it, or the operating system will report garbage
83439ce140SAnton Blanchard  * for this statistic.
84439ce140SAnton Blanchard  */
85439ce140SAnton Blanchard #define VLAN_RX_BDS_LEN      (SPAPR_TCE_PAGE_SIZE - VLAN_RX_BDS_OFF - 8)
86439ce140SAnton Blanchard #define VLAN_MAX_BUFS        (VLAN_RX_BDS_LEN / 8)
878d90ad90SDavid Gibson 
88fd506b4fSDavid Gibson #define TYPE_VIO_SPAPR_VLAN_DEVICE "spapr-vlan"
89fd506b4fSDavid Gibson #define VIO_SPAPR_VLAN_DEVICE(obj) \
90ce2918cbSDavid Gibson      OBJECT_CHECK(SpaprVioVlan, (obj), TYPE_VIO_SPAPR_VLAN_DEVICE)
91fd506b4fSDavid Gibson 
92831e8822SThomas Huth #define RX_POOL_MAX_BDS 4096
93831e8822SThomas Huth #define RX_MAX_POOLS 5
94831e8822SThomas Huth 
95831e8822SThomas Huth typedef struct {
96831e8822SThomas Huth     int32_t bufsize;
97831e8822SThomas Huth     int32_t count;
98831e8822SThomas Huth     vlan_bd_t bds[RX_POOL_MAX_BDS];
99831e8822SThomas Huth } RxBufPool;
100831e8822SThomas Huth 
101ce2918cbSDavid Gibson typedef struct SpaprVioVlan {
102ce2918cbSDavid Gibson     SpaprVioDevice sdev;
1038d90ad90SDavid Gibson     NICConf nicconf;
1048d90ad90SDavid Gibson     NICState *nic;
10532f5f50dSLaurent Vivier     MACAddr perm_mac;
106686fefe4SDavid Gibson     bool isopen;
107cbd62f86SPaolo Bonzini     hwaddr buf_list;
108686fefe4SDavid Gibson     uint32_t add_buf_ptr, use_buf_ptr, rx_bufs;
109cbd62f86SPaolo Bonzini     hwaddr rxq_ptr;
1108836630fSThomas Huth     QEMUTimer *rxp_timer;
111b12227afSStefan Weil     uint32_t compat_flags;             /* Compatibility flags for migration */
112831e8822SThomas Huth     RxBufPool *rx_pool[RX_MAX_POOLS];  /* Receive buffer descriptor pools */
113ce2918cbSDavid Gibson } SpaprVioVlan;
1148d90ad90SDavid Gibson 
1154e68f7a0SStefan Hajnoczi static int spapr_vlan_can_receive(NetClientState *nc)
1168d90ad90SDavid Gibson {
117ce2918cbSDavid Gibson     SpaprVioVlan *dev = qemu_get_nic_opaque(nc);
1188d90ad90SDavid Gibson 
1198d90ad90SDavid Gibson     return (dev->isopen && dev->rx_bufs > 0);
1208d90ad90SDavid Gibson }
1218d90ad90SDavid Gibson 
122d6f39fdfSThomas Huth /**
1235c29dd8cSThomas Huth  * The last 8 bytes of the receive buffer list page (that has been
1245c29dd8cSThomas Huth  * supplied by the guest with the H_REGISTER_LOGICAL_LAN call) contain
1255c29dd8cSThomas Huth  * a counter for frames that have been dropped because there was no
1265c29dd8cSThomas Huth  * suitable receive buffer available. This function is used to increase
1275c29dd8cSThomas Huth  * this counter by one.
1285c29dd8cSThomas Huth  */
129ce2918cbSDavid Gibson static void spapr_vlan_record_dropped_rx_frame(SpaprVioVlan *dev)
1305c29dd8cSThomas Huth {
1315c29dd8cSThomas Huth     uint64_t cnt;
1325c29dd8cSThomas Huth 
1335c29dd8cSThomas Huth     cnt = vio_ldq(&dev->sdev, dev->buf_list + 4096 - 8);
1345c29dd8cSThomas Huth     vio_stq(&dev->sdev, dev->buf_list + 4096 - 8, cnt + 1);
1355c29dd8cSThomas Huth }
1365c29dd8cSThomas Huth 
1375c29dd8cSThomas Huth /**
138831e8822SThomas Huth  * Get buffer descriptor from one of our receive buffer pools
139831e8822SThomas Huth  */
140ce2918cbSDavid Gibson static vlan_bd_t spapr_vlan_get_rx_bd_from_pool(SpaprVioVlan *dev,
141831e8822SThomas Huth                                                 size_t size)
142831e8822SThomas Huth {
143831e8822SThomas Huth     vlan_bd_t bd;
144831e8822SThomas Huth     int pool;
145831e8822SThomas Huth 
146831e8822SThomas Huth     for (pool = 0; pool < RX_MAX_POOLS; pool++) {
147831e8822SThomas Huth         if (dev->rx_pool[pool]->count > 0 &&
148831e8822SThomas Huth             dev->rx_pool[pool]->bufsize >= size + 8) {
149831e8822SThomas Huth             break;
150831e8822SThomas Huth         }
151831e8822SThomas Huth     }
152831e8822SThomas Huth     if (pool == RX_MAX_POOLS) {
153831e8822SThomas Huth         /* Failed to find a suitable buffer */
154831e8822SThomas Huth         return 0;
155831e8822SThomas Huth     }
156831e8822SThomas Huth 
157e8bb33deSLaurent Vivier 
158e8bb33deSLaurent Vivier     trace_spapr_vlan_get_rx_bd_from_pool_found(pool,
159e8bb33deSLaurent Vivier                                                dev->rx_pool[pool]->count,
160e8bb33deSLaurent Vivier                                                dev->rx_bufs);
161831e8822SThomas Huth 
162831e8822SThomas Huth     /* Remove the buffer from the pool */
163831e8822SThomas Huth     dev->rx_pool[pool]->count--;
164831e8822SThomas Huth     bd = dev->rx_pool[pool]->bds[dev->rx_pool[pool]->count];
165831e8822SThomas Huth     dev->rx_pool[pool]->bds[dev->rx_pool[pool]->count] = 0;
166831e8822SThomas Huth 
167831e8822SThomas Huth     return bd;
168831e8822SThomas Huth }
169831e8822SThomas Huth 
170831e8822SThomas Huth /**
171d6f39fdfSThomas Huth  * Get buffer descriptor from the receive buffer list page that has been
172d6f39fdfSThomas Huth  * supplied by the guest with the H_REGISTER_LOGICAL_LAN call
173d6f39fdfSThomas Huth  */
174ce2918cbSDavid Gibson static vlan_bd_t spapr_vlan_get_rx_bd_from_page(SpaprVioVlan *dev,
175d6f39fdfSThomas Huth                                                 size_t size)
176d6f39fdfSThomas Huth {
177d6f39fdfSThomas Huth     int buf_ptr = dev->use_buf_ptr;
178d6f39fdfSThomas Huth     vlan_bd_t bd;
179d6f39fdfSThomas Huth 
180d6f39fdfSThomas Huth     do {
181d6f39fdfSThomas Huth         buf_ptr += 8;
182d6f39fdfSThomas Huth         if (buf_ptr >= VLAN_RX_BDS_LEN + VLAN_RX_BDS_OFF) {
183d6f39fdfSThomas Huth             buf_ptr = VLAN_RX_BDS_OFF;
184d6f39fdfSThomas Huth         }
185d6f39fdfSThomas Huth 
186d6f39fdfSThomas Huth         bd = vio_ldq(&dev->sdev, dev->buf_list + buf_ptr);
187e8bb33deSLaurent Vivier 
188e8bb33deSLaurent Vivier         trace_spapr_vlan_get_rx_bd_from_page(buf_ptr, (uint64_t)bd);
189d6f39fdfSThomas Huth     } while ((!(bd & VLAN_BD_VALID) || VLAN_BD_LEN(bd) < size + 8)
190d6f39fdfSThomas Huth              && buf_ptr != dev->use_buf_ptr);
191d6f39fdfSThomas Huth 
192d6f39fdfSThomas Huth     if (!(bd & VLAN_BD_VALID) || VLAN_BD_LEN(bd) < size + 8) {
193d6f39fdfSThomas Huth         /* Failed to find a suitable buffer */
194d6f39fdfSThomas Huth         return 0;
195d6f39fdfSThomas Huth     }
196d6f39fdfSThomas Huth 
197d6f39fdfSThomas Huth     /* Remove the buffer from the pool */
198d6f39fdfSThomas Huth     dev->use_buf_ptr = buf_ptr;
199d6f39fdfSThomas Huth     vio_stq(&dev->sdev, dev->buf_list + dev->use_buf_ptr, 0);
200d6f39fdfSThomas Huth 
201e8bb33deSLaurent Vivier     trace_spapr_vlan_get_rx_bd_from_page_found(dev->use_buf_ptr, dev->rx_bufs);
202d6f39fdfSThomas Huth 
203d6f39fdfSThomas Huth     return bd;
204d6f39fdfSThomas Huth }
205d6f39fdfSThomas Huth 
2064e68f7a0SStefan Hajnoczi static ssize_t spapr_vlan_receive(NetClientState *nc, const uint8_t *buf,
2078d90ad90SDavid Gibson                                   size_t size)
2088d90ad90SDavid Gibson {
209ce2918cbSDavid Gibson     SpaprVioVlan *dev = qemu_get_nic_opaque(nc);
210ce2918cbSDavid Gibson     SpaprVioDevice *sdev = VIO_SPAPR_DEVICE(dev);
211ad0ebb91SDavid Gibson     vlan_bd_t rxq_bd = vio_ldq(sdev, dev->buf_list + VLAN_RXQ_BD_OFF);
2128d90ad90SDavid Gibson     vlan_bd_t bd;
2138d90ad90SDavid Gibson     uint64_t handle;
2148d90ad90SDavid Gibson     uint8_t control;
2158d90ad90SDavid Gibson 
216e8bb33deSLaurent Vivier     trace_spapr_vlan_receive(sdev->qdev.id, dev->rx_bufs);
2178d90ad90SDavid Gibson 
2188d90ad90SDavid Gibson     if (!dev->isopen) {
2198d90ad90SDavid Gibson         return -1;
2208d90ad90SDavid Gibson     }
2218d90ad90SDavid Gibson 
2228d90ad90SDavid Gibson     if (!dev->rx_bufs) {
2235c29dd8cSThomas Huth         spapr_vlan_record_dropped_rx_frame(dev);
2248836630fSThomas Huth         return 0;
2258d90ad90SDavid Gibson     }
2268d90ad90SDavid Gibson 
227831e8822SThomas Huth     if (dev->compat_flags & SPAPRVLAN_FLAG_RX_BUF_POOLS) {
228831e8822SThomas Huth         bd = spapr_vlan_get_rx_bd_from_pool(dev, size);
229831e8822SThomas Huth     } else {
230d6f39fdfSThomas Huth         bd = spapr_vlan_get_rx_bd_from_page(dev, size);
231831e8822SThomas Huth     }
232d6f39fdfSThomas Huth     if (!bd) {
2335c29dd8cSThomas Huth         spapr_vlan_record_dropped_rx_frame(dev);
2348836630fSThomas Huth         return 0;
2358d90ad90SDavid Gibson     }
2368d90ad90SDavid Gibson 
2378d90ad90SDavid Gibson     dev->rx_bufs--;
2388d90ad90SDavid Gibson 
2398d90ad90SDavid Gibson     /* Transfer the packet data */
240ad0ebb91SDavid Gibson     if (spapr_vio_dma_write(sdev, VLAN_BD_ADDR(bd) + 8, buf, size) < 0) {
2418d90ad90SDavid Gibson         return -1;
2428d90ad90SDavid Gibson     }
2438d90ad90SDavid Gibson 
244e8bb33deSLaurent Vivier     trace_spapr_vlan_receive_dma_completed();
2458d90ad90SDavid Gibson 
2468d90ad90SDavid Gibson     /* Update the receive queue */
2478d90ad90SDavid Gibson     control = VLAN_RXQC_TOGGLE | VLAN_RXQC_VALID;
2488d90ad90SDavid Gibson     if (rxq_bd & VLAN_BD_TOGGLE) {
2498d90ad90SDavid Gibson         control ^= VLAN_RXQC_TOGGLE;
2508d90ad90SDavid Gibson     }
2518d90ad90SDavid Gibson 
252ad0ebb91SDavid Gibson     handle = vio_ldq(sdev, VLAN_BD_ADDR(bd));
253ad0ebb91SDavid Gibson     vio_stq(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 8, handle);
254ad0ebb91SDavid Gibson     vio_stl(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 4, size);
255ad0ebb91SDavid Gibson     vio_sth(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 2, 8);
256ad0ebb91SDavid Gibson     vio_stb(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr, control);
2578d90ad90SDavid Gibson 
258e8bb33deSLaurent Vivier     trace_spapr_vlan_receive_wrote(dev->rxq_ptr,
259e8bb33deSLaurent Vivier                                    vio_ldq(sdev, VLAN_BD_ADDR(rxq_bd) +
2608d90ad90SDavid Gibson                                                  dev->rxq_ptr),
261e8bb33deSLaurent Vivier                                    vio_ldq(sdev, VLAN_BD_ADDR(rxq_bd) +
2628d90ad90SDavid Gibson                                                  dev->rxq_ptr + 8));
2638d90ad90SDavid Gibson 
2648d90ad90SDavid Gibson     dev->rxq_ptr += 16;
2658d90ad90SDavid Gibson     if (dev->rxq_ptr >= VLAN_BD_LEN(rxq_bd)) {
2668d90ad90SDavid Gibson         dev->rxq_ptr = 0;
267ad0ebb91SDavid Gibson         vio_stq(sdev, dev->buf_list + VLAN_RXQ_BD_OFF, rxq_bd ^ VLAN_BD_TOGGLE);
2688d90ad90SDavid Gibson     }
2698d90ad90SDavid Gibson 
2708d90ad90SDavid Gibson     if (sdev->signal_state & 1) {
271a307d594SAlexey Kardashevskiy         qemu_irq_pulse(spapr_vio_qirq(sdev));
2728d90ad90SDavid Gibson     }
2738d90ad90SDavid Gibson 
2748d90ad90SDavid Gibson     return size;
2758d90ad90SDavid Gibson }
2768d90ad90SDavid Gibson 
2778d90ad90SDavid Gibson static NetClientInfo net_spapr_vlan_info = {
278f394b2e2SEric Blake     .type = NET_CLIENT_DRIVER_NIC,
2798d90ad90SDavid Gibson     .size = sizeof(NICState),
2808d90ad90SDavid Gibson     .can_receive = spapr_vlan_can_receive,
2818d90ad90SDavid Gibson     .receive = spapr_vlan_receive,
2828d90ad90SDavid Gibson };
2838d90ad90SDavid Gibson 
2848836630fSThomas Huth static void spapr_vlan_flush_rx_queue(void *opaque)
2858836630fSThomas Huth {
286ce2918cbSDavid Gibson     SpaprVioVlan *dev = opaque;
2878836630fSThomas Huth 
2888836630fSThomas Huth     qemu_flush_queued_packets(qemu_get_queue(dev->nic));
2898836630fSThomas Huth }
2908836630fSThomas Huth 
291831e8822SThomas Huth static void spapr_vlan_reset_rx_pool(RxBufPool *rxp)
292831e8822SThomas Huth {
293831e8822SThomas Huth     /*
294831e8822SThomas Huth      * Use INT_MAX as bufsize so that unused buffers are moved to the end
295831e8822SThomas Huth      * of the list during the qsort in spapr_vlan_add_rxbuf_to_pool() later.
296831e8822SThomas Huth      */
297831e8822SThomas Huth     rxp->bufsize = INT_MAX;
298831e8822SThomas Huth     rxp->count = 0;
299831e8822SThomas Huth     memset(rxp->bds, 0, sizeof(rxp->bds));
300831e8822SThomas Huth }
301831e8822SThomas Huth 
302ce2918cbSDavid Gibson static void spapr_vlan_reset(SpaprVioDevice *sdev)
303c17491b6SDavid Gibson {
304ce2918cbSDavid Gibson     SpaprVioVlan *dev = VIO_SPAPR_VLAN_DEVICE(sdev);
305831e8822SThomas Huth     int i;
306c17491b6SDavid Gibson 
307c17491b6SDavid Gibson     dev->buf_list = 0;
308c17491b6SDavid Gibson     dev->rx_bufs = 0;
309c17491b6SDavid Gibson     dev->isopen = 0;
310831e8822SThomas Huth 
311831e8822SThomas Huth     if (dev->compat_flags & SPAPRVLAN_FLAG_RX_BUF_POOLS) {
312831e8822SThomas Huth         for (i = 0; i < RX_MAX_POOLS; i++) {
313831e8822SThomas Huth             spapr_vlan_reset_rx_pool(dev->rx_pool[i]);
314831e8822SThomas Huth         }
315831e8822SThomas Huth     }
31632f5f50dSLaurent Vivier 
31732f5f50dSLaurent Vivier     memcpy(&dev->nicconf.macaddr.a, &dev->perm_mac.a,
31832f5f50dSLaurent Vivier            sizeof(dev->nicconf.macaddr.a));
31932f5f50dSLaurent Vivier     qemu_format_nic_info_str(qemu_get_queue(dev->nic), dev->nicconf.macaddr.a);
320c17491b6SDavid Gibson }
321c17491b6SDavid Gibson 
322ce2918cbSDavid Gibson static void spapr_vlan_realize(SpaprVioDevice *sdev, Error **errp)
3238d90ad90SDavid Gibson {
324ce2918cbSDavid Gibson     SpaprVioVlan *dev = VIO_SPAPR_VLAN_DEVICE(sdev);
3258d90ad90SDavid Gibson 
3268d90ad90SDavid Gibson     qemu_macaddr_default_if_unset(&dev->nicconf.macaddr);
3278d90ad90SDavid Gibson 
32832f5f50dSLaurent Vivier     memcpy(&dev->perm_mac.a, &dev->nicconf.macaddr.a, sizeof(dev->perm_mac.a));
32932f5f50dSLaurent Vivier 
3308d90ad90SDavid Gibson     dev->nic = qemu_new_nic(&net_spapr_vlan_info, &dev->nicconf,
331f79f2bfcSAnthony Liguori                             object_get_typename(OBJECT(sdev)), sdev->qdev.id, dev);
332b356f76dSJason Wang     qemu_format_nic_info_str(qemu_get_queue(dev->nic), dev->nicconf.macaddr.a);
3338836630fSThomas Huth 
3348836630fSThomas Huth     dev->rxp_timer = timer_new_us(QEMU_CLOCK_VIRTUAL, spapr_vlan_flush_rx_queue,
3358836630fSThomas Huth                                   dev);
3368d90ad90SDavid Gibson }
3378d90ad90SDavid Gibson 
338dfe79cf2SGonglei static void spapr_vlan_instance_init(Object *obj)
339dfe79cf2SGonglei {
340ce2918cbSDavid Gibson     SpaprVioVlan *dev = VIO_SPAPR_VLAN_DEVICE(obj);
341831e8822SThomas Huth     int i;
342dfe79cf2SGonglei 
343dfe79cf2SGonglei     device_add_bootindex_property(obj, &dev->nicconf.bootindex,
344dfe79cf2SGonglei                                   "bootindex", "",
345dfe79cf2SGonglei                                   DEVICE(dev), NULL);
346831e8822SThomas Huth 
347831e8822SThomas Huth     if (dev->compat_flags & SPAPRVLAN_FLAG_RX_BUF_POOLS) {
348831e8822SThomas Huth         for (i = 0; i < RX_MAX_POOLS; i++) {
349831e8822SThomas Huth             dev->rx_pool[i] = g_new(RxBufPool, 1);
350831e8822SThomas Huth             spapr_vlan_reset_rx_pool(dev->rx_pool[i]);
351831e8822SThomas Huth         }
352831e8822SThomas Huth     }
353831e8822SThomas Huth }
354831e8822SThomas Huth 
355831e8822SThomas Huth static void spapr_vlan_instance_finalize(Object *obj)
356831e8822SThomas Huth {
357ce2918cbSDavid Gibson     SpaprVioVlan *dev = VIO_SPAPR_VLAN_DEVICE(obj);
358831e8822SThomas Huth     int i;
359831e8822SThomas Huth 
360831e8822SThomas Huth     if (dev->compat_flags & SPAPRVLAN_FLAG_RX_BUF_POOLS) {
361831e8822SThomas Huth         for (i = 0; i < RX_MAX_POOLS; i++) {
362831e8822SThomas Huth             g_free(dev->rx_pool[i]);
363831e8822SThomas Huth             dev->rx_pool[i] = NULL;
364831e8822SThomas Huth         }
365831e8822SThomas Huth     }
3668836630fSThomas Huth 
3678836630fSThomas Huth     if (dev->rxp_timer) {
3688836630fSThomas Huth         timer_del(dev->rxp_timer);
3698836630fSThomas Huth         timer_free(dev->rxp_timer);
3708836630fSThomas Huth     }
371dfe79cf2SGonglei }
372dfe79cf2SGonglei 
373ce2918cbSDavid Gibson void spapr_vlan_create(SpaprVioBus *bus, NICInfo *nd)
3748d90ad90SDavid Gibson {
3758d90ad90SDavid Gibson     DeviceState *dev;
3768d90ad90SDavid Gibson 
3778d90ad90SDavid Gibson     dev = qdev_create(&bus->bus, "spapr-vlan");
3788d90ad90SDavid Gibson 
3798d90ad90SDavid Gibson     qdev_set_nic_properties(dev, nd);
3808d90ad90SDavid Gibson 
3818d90ad90SDavid Gibson     qdev_init_nofail(dev);
3828d90ad90SDavid Gibson }
3838d90ad90SDavid Gibson 
384ce2918cbSDavid Gibson static int spapr_vlan_devnode(SpaprVioDevice *dev, void *fdt, int node_off)
3858d90ad90SDavid Gibson {
386ce2918cbSDavid Gibson     SpaprVioVlan *vdev = VIO_SPAPR_VLAN_DEVICE(dev);
3878d90ad90SDavid Gibson     uint8_t padded_mac[8] = {0, 0};
3888d90ad90SDavid Gibson     int ret;
3898d90ad90SDavid Gibson 
3908d90ad90SDavid Gibson     /* Some old phyp versions give the mac address in an 8-byte
39187684b4cSSam Bobroff      * property.  The kernel driver (before 3.10) has an insane workaround;
3928d90ad90SDavid Gibson      * rather than doing the obvious thing and checking the property
3938d90ad90SDavid Gibson      * length, it checks whether the first byte has 0b10 in the low
3948d90ad90SDavid Gibson      * bits.  If a correct 6-byte property has a different first byte
3958d90ad90SDavid Gibson      * the kernel will get the wrong mac address, overrunning its
3968d90ad90SDavid Gibson      * buffer in the process (read only, thank goodness).
3978d90ad90SDavid Gibson      *
39887684b4cSSam Bobroff      * Here we return a 6-byte address unless that would break a pre-3.10
39987684b4cSSam Bobroff      * driver.  In that case we return a padded 8-byte address to allow the old
40087684b4cSSam Bobroff      * workaround to succeed. */
40187684b4cSSam Bobroff     if ((vdev->nicconf.macaddr.a[0] & 0x3) == 0x2) {
40287684b4cSSam Bobroff         ret = fdt_setprop(fdt, node_off, "local-mac-address",
40387684b4cSSam Bobroff                           &vdev->nicconf.macaddr, ETH_ALEN);
40487684b4cSSam Bobroff     } else {
4058d90ad90SDavid Gibson         memcpy(&padded_mac[2], &vdev->nicconf.macaddr, ETH_ALEN);
4068d90ad90SDavid Gibson         ret = fdt_setprop(fdt, node_off, "local-mac-address",
4078d90ad90SDavid Gibson                           padded_mac, sizeof(padded_mac));
40887684b4cSSam Bobroff     }
4098d90ad90SDavid Gibson     if (ret < 0) {
4108d90ad90SDavid Gibson         return ret;
4118d90ad90SDavid Gibson     }
4128d90ad90SDavid Gibson 
4138d90ad90SDavid Gibson     ret = fdt_setprop_cell(fdt, node_off, "ibm,mac-address-filters", 0);
4148d90ad90SDavid Gibson     if (ret < 0) {
4158d90ad90SDavid Gibson         return ret;
4168d90ad90SDavid Gibson     }
4178d90ad90SDavid Gibson 
4188d90ad90SDavid Gibson     return 0;
4198d90ad90SDavid Gibson }
4208d90ad90SDavid Gibson 
421ce2918cbSDavid Gibson static int check_bd(SpaprVioVlan *dev, vlan_bd_t bd,
4228d90ad90SDavid Gibson                     target_ulong alignment)
4238d90ad90SDavid Gibson {
4248d90ad90SDavid Gibson     if ((VLAN_BD_ADDR(bd) % alignment)
4258d90ad90SDavid Gibson         || (VLAN_BD_LEN(bd) % alignment)) {
4268d90ad90SDavid Gibson         return -1;
4278d90ad90SDavid Gibson     }
4288d90ad90SDavid Gibson 
429ad0ebb91SDavid Gibson     if (!spapr_vio_dma_valid(&dev->sdev, VLAN_BD_ADDR(bd),
430ad0ebb91SDavid Gibson                              VLAN_BD_LEN(bd), DMA_DIRECTION_FROM_DEVICE)
431ad0ebb91SDavid Gibson         || !spapr_vio_dma_valid(&dev->sdev, VLAN_BD_ADDR(bd),
432ad0ebb91SDavid Gibson                                 VLAN_BD_LEN(bd), DMA_DIRECTION_TO_DEVICE)) {
4338d90ad90SDavid Gibson         return -1;
4348d90ad90SDavid Gibson     }
4358d90ad90SDavid Gibson 
4368d90ad90SDavid Gibson     return 0;
4378d90ad90SDavid Gibson }
4388d90ad90SDavid Gibson 
439b13ce26dSAndreas Färber static target_ulong h_register_logical_lan(PowerPCCPU *cpu,
440ce2918cbSDavid Gibson                                            SpaprMachineState *spapr,
4418d90ad90SDavid Gibson                                            target_ulong opcode,
4428d90ad90SDavid Gibson                                            target_ulong *args)
4438d90ad90SDavid Gibson {
4448d90ad90SDavid Gibson     target_ulong reg = args[0];
4458d90ad90SDavid Gibson     target_ulong buf_list = args[1];
4468d90ad90SDavid Gibson     target_ulong rec_queue = args[2];
4478d90ad90SDavid Gibson     target_ulong filter_list = args[3];
448ce2918cbSDavid Gibson     SpaprVioDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
449ce2918cbSDavid Gibson     SpaprVioVlan *dev = VIO_SPAPR_VLAN_DEVICE(sdev);
4508d90ad90SDavid Gibson     vlan_bd_t filter_list_bd;
4518d90ad90SDavid Gibson 
4528d90ad90SDavid Gibson     if (!dev) {
4538d90ad90SDavid Gibson         return H_PARAMETER;
4548d90ad90SDavid Gibson     }
4558d90ad90SDavid Gibson 
4568d90ad90SDavid Gibson     if (dev->isopen) {
4578d90ad90SDavid Gibson         hcall_dprintf("H_REGISTER_LOGICAL_LAN called twice without "
4588d90ad90SDavid Gibson                       "H_FREE_LOGICAL_LAN\n");
4598d90ad90SDavid Gibson         return H_RESOURCE;
4608d90ad90SDavid Gibson     }
4618d90ad90SDavid Gibson 
462ad0ebb91SDavid Gibson     if (check_bd(dev, VLAN_VALID_BD(buf_list, SPAPR_TCE_PAGE_SIZE),
463ad0ebb91SDavid Gibson                  SPAPR_TCE_PAGE_SIZE) < 0) {
464d9599c92SDavid Gibson         hcall_dprintf("Bad buf_list 0x" TARGET_FMT_lx "\n", buf_list);
4658d90ad90SDavid Gibson         return H_PARAMETER;
4668d90ad90SDavid Gibson     }
4678d90ad90SDavid Gibson 
468ad0ebb91SDavid Gibson     filter_list_bd = VLAN_VALID_BD(filter_list, SPAPR_TCE_PAGE_SIZE);
469ad0ebb91SDavid Gibson     if (check_bd(dev, filter_list_bd, SPAPR_TCE_PAGE_SIZE) < 0) {
470d9599c92SDavid Gibson         hcall_dprintf("Bad filter_list 0x" TARGET_FMT_lx "\n", filter_list);
4718d90ad90SDavid Gibson         return H_PARAMETER;
4728d90ad90SDavid Gibson     }
4738d90ad90SDavid Gibson 
4748d90ad90SDavid Gibson     if (!(rec_queue & VLAN_BD_VALID)
4758d90ad90SDavid Gibson         || (check_bd(dev, rec_queue, VLAN_RQ_ALIGNMENT) < 0)) {
476d9599c92SDavid Gibson         hcall_dprintf("Bad receive queue\n");
4778d90ad90SDavid Gibson         return H_PARAMETER;
4788d90ad90SDavid Gibson     }
4798d90ad90SDavid Gibson 
4808d90ad90SDavid Gibson     dev->buf_list = buf_list;
4818d90ad90SDavid Gibson     sdev->signal_state = 0;
4828d90ad90SDavid Gibson 
4838d90ad90SDavid Gibson     rec_queue &= ~VLAN_BD_TOGGLE;
4848d90ad90SDavid Gibson 
4858d90ad90SDavid Gibson     /* Initialize the buffer list */
486ad0ebb91SDavid Gibson     vio_stq(sdev, buf_list, rec_queue);
487ad0ebb91SDavid Gibson     vio_stq(sdev, buf_list + 8, filter_list_bd);
488ad0ebb91SDavid Gibson     spapr_vio_dma_set(sdev, buf_list + VLAN_RX_BDS_OFF, 0,
489ad0ebb91SDavid Gibson                       SPAPR_TCE_PAGE_SIZE - VLAN_RX_BDS_OFF);
4908d90ad90SDavid Gibson     dev->add_buf_ptr = VLAN_RX_BDS_OFF - 8;
4918d90ad90SDavid Gibson     dev->use_buf_ptr = VLAN_RX_BDS_OFF - 8;
4928d90ad90SDavid Gibson     dev->rx_bufs = 0;
4938d90ad90SDavid Gibson     dev->rxq_ptr = 0;
4948d90ad90SDavid Gibson 
4958d90ad90SDavid Gibson     /* Initialize the receive queue */
496ad0ebb91SDavid Gibson     spapr_vio_dma_set(sdev, VLAN_BD_ADDR(rec_queue), 0, VLAN_BD_LEN(rec_queue));
4978d90ad90SDavid Gibson 
4988d90ad90SDavid Gibson     dev->isopen = 1;
499e0ff466cSAlexey Kardashevskiy     qemu_flush_queued_packets(qemu_get_queue(dev->nic));
500e0ff466cSAlexey Kardashevskiy 
5018d90ad90SDavid Gibson     return H_SUCCESS;
5028d90ad90SDavid Gibson }
5038d90ad90SDavid Gibson 
5048d90ad90SDavid Gibson 
50528e02042SDavid Gibson static target_ulong h_free_logical_lan(PowerPCCPU *cpu,
506ce2918cbSDavid Gibson                                        SpaprMachineState *spapr,
5078d90ad90SDavid Gibson                                        target_ulong opcode, target_ulong *args)
5088d90ad90SDavid Gibson {
5098d90ad90SDavid Gibson     target_ulong reg = args[0];
510ce2918cbSDavid Gibson     SpaprVioDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
511ce2918cbSDavid Gibson     SpaprVioVlan *dev = VIO_SPAPR_VLAN_DEVICE(sdev);
5128d90ad90SDavid Gibson 
5138d90ad90SDavid Gibson     if (!dev) {
5148d90ad90SDavid Gibson         return H_PARAMETER;
5158d90ad90SDavid Gibson     }
5168d90ad90SDavid Gibson 
5178d90ad90SDavid Gibson     if (!dev->isopen) {
5188d90ad90SDavid Gibson         hcall_dprintf("H_FREE_LOGICAL_LAN called without "
5198d90ad90SDavid Gibson                       "H_REGISTER_LOGICAL_LAN\n");
5208d90ad90SDavid Gibson         return H_RESOURCE;
5218d90ad90SDavid Gibson     }
5228d90ad90SDavid Gibson 
523c17491b6SDavid Gibson     spapr_vlan_reset(sdev);
5248d90ad90SDavid Gibson     return H_SUCCESS;
5258d90ad90SDavid Gibson }
5268d90ad90SDavid Gibson 
527831e8822SThomas Huth /**
528831e8822SThomas Huth  * Used for qsort, this function compares two RxBufPools by size.
529831e8822SThomas Huth  */
530831e8822SThomas Huth static int rx_pool_size_compare(const void *p1, const void *p2)
531831e8822SThomas Huth {
532831e8822SThomas Huth     const RxBufPool *pool1 = *(RxBufPool **)p1;
533831e8822SThomas Huth     const RxBufPool *pool2 = *(RxBufPool **)p2;
534831e8822SThomas Huth 
535831e8822SThomas Huth     if (pool1->bufsize < pool2->bufsize) {
536831e8822SThomas Huth         return -1;
537831e8822SThomas Huth     }
538831e8822SThomas Huth     return pool1->bufsize > pool2->bufsize;
539831e8822SThomas Huth }
540831e8822SThomas Huth 
541831e8822SThomas Huth /**
542831e8822SThomas Huth  * Search for a matching buffer pool with exact matching size,
543831e8822SThomas Huth  * or return -1 if no matching pool has been found.
544831e8822SThomas Huth  */
545ce2918cbSDavid Gibson static int spapr_vlan_get_rx_pool_id(SpaprVioVlan *dev, int size)
546831e8822SThomas Huth {
547831e8822SThomas Huth     int pool;
548831e8822SThomas Huth 
549831e8822SThomas Huth     for (pool = 0; pool < RX_MAX_POOLS; pool++) {
550831e8822SThomas Huth         if (dev->rx_pool[pool]->bufsize == size) {
551831e8822SThomas Huth             return pool;
552831e8822SThomas Huth         }
553831e8822SThomas Huth     }
554831e8822SThomas Huth 
555831e8822SThomas Huth     return -1;
556831e8822SThomas Huth }
557831e8822SThomas Huth 
558831e8822SThomas Huth /**
559831e8822SThomas Huth  * Enqueuing receive buffer by adding it to one of our receive buffer pools
560831e8822SThomas Huth  */
561ce2918cbSDavid Gibson static target_long spapr_vlan_add_rxbuf_to_pool(SpaprVioVlan *dev,
562831e8822SThomas Huth                                                 target_ulong buf)
563831e8822SThomas Huth {
564831e8822SThomas Huth     int size = VLAN_BD_LEN(buf);
565831e8822SThomas Huth     int pool;
566831e8822SThomas Huth 
567831e8822SThomas Huth     pool = spapr_vlan_get_rx_pool_id(dev, size);
568831e8822SThomas Huth     if (pool < 0) {
569831e8822SThomas Huth         /*
570831e8822SThomas Huth          * No matching pool found? Try to use a new one. If the guest used all
571b12227afSStefan Weil          * pools before, but changed the size of one pool in the meantime, we might
572831e8822SThomas Huth          * need to recycle that pool here (if it's empty already). Thus scan
573831e8822SThomas Huth          * all buffer pools now, starting with the last (likely empty) one.
574831e8822SThomas Huth          */
575831e8822SThomas Huth         for (pool = RX_MAX_POOLS - 1; pool >= 0 ; pool--) {
576831e8822SThomas Huth             if (dev->rx_pool[pool]->count == 0) {
577831e8822SThomas Huth                 dev->rx_pool[pool]->bufsize = size;
578831e8822SThomas Huth                 /*
579831e8822SThomas Huth                  * Sort pools by size so that spapr_vlan_receive()
580831e8822SThomas Huth                  * can later find the smallest buffer pool easily.
581831e8822SThomas Huth                  */
582831e8822SThomas Huth                 qsort(dev->rx_pool, RX_MAX_POOLS, sizeof(dev->rx_pool[0]),
583831e8822SThomas Huth                       rx_pool_size_compare);
584831e8822SThomas Huth                 pool = spapr_vlan_get_rx_pool_id(dev, size);
585e8bb33deSLaurent Vivier                 trace_spapr_vlan_add_rxbuf_to_pool_create(pool,
586831e8822SThomas Huth                                                           VLAN_BD_LEN(buf));
587831e8822SThomas Huth                 break;
588831e8822SThomas Huth             }
589831e8822SThomas Huth         }
590831e8822SThomas Huth     }
591831e8822SThomas Huth     /* Still no usable pool? Give up */
592831e8822SThomas Huth     if (pool < 0 || dev->rx_pool[pool]->count >= RX_POOL_MAX_BDS) {
593831e8822SThomas Huth         return H_RESOURCE;
594831e8822SThomas Huth     }
595831e8822SThomas Huth 
596e8bb33deSLaurent Vivier     trace_spapr_vlan_add_rxbuf_to_pool(pool, VLAN_BD_LEN(buf),
597e8bb33deSLaurent Vivier                                        dev->rx_pool[pool]->count);
598831e8822SThomas Huth 
599831e8822SThomas Huth     dev->rx_pool[pool]->bds[dev->rx_pool[pool]->count++] = buf;
600831e8822SThomas Huth 
601831e8822SThomas Huth     return 0;
602831e8822SThomas Huth }
603831e8822SThomas Huth 
604831e8822SThomas Huth /**
605831e8822SThomas Huth  * This is the old way of enqueuing receive buffers: Add it to the rx queue
606831e8822SThomas Huth  * page that has been supplied by the guest (which is quite limited in size).
607831e8822SThomas Huth  */
608ce2918cbSDavid Gibson static target_long spapr_vlan_add_rxbuf_to_page(SpaprVioVlan *dev,
609d6f39fdfSThomas Huth                                                 target_ulong buf)
610d6f39fdfSThomas Huth {
611d6f39fdfSThomas Huth     vlan_bd_t bd;
612d6f39fdfSThomas Huth 
613d6f39fdfSThomas Huth     if (dev->rx_bufs >= VLAN_MAX_BUFS) {
614d6f39fdfSThomas Huth         return H_RESOURCE;
615d6f39fdfSThomas Huth     }
616d6f39fdfSThomas Huth 
617d6f39fdfSThomas Huth     do {
618d6f39fdfSThomas Huth         dev->add_buf_ptr += 8;
619d6f39fdfSThomas Huth         if (dev->add_buf_ptr >= VLAN_RX_BDS_LEN + VLAN_RX_BDS_OFF) {
620d6f39fdfSThomas Huth             dev->add_buf_ptr = VLAN_RX_BDS_OFF;
621d6f39fdfSThomas Huth         }
622d6f39fdfSThomas Huth 
623d6f39fdfSThomas Huth         bd = vio_ldq(&dev->sdev, dev->buf_list + dev->add_buf_ptr);
624d6f39fdfSThomas Huth     } while (bd & VLAN_BD_VALID);
625d6f39fdfSThomas Huth 
626d6f39fdfSThomas Huth     vio_stq(&dev->sdev, dev->buf_list + dev->add_buf_ptr, buf);
627d6f39fdfSThomas Huth 
628e8bb33deSLaurent Vivier     trace_spapr_vlan_add_rxbuf_to_page(dev->add_buf_ptr, dev->rx_bufs, buf);
629d6f39fdfSThomas Huth 
630d6f39fdfSThomas Huth     return 0;
631d6f39fdfSThomas Huth }
632d6f39fdfSThomas Huth 
633b13ce26dSAndreas Färber static target_ulong h_add_logical_lan_buffer(PowerPCCPU *cpu,
634ce2918cbSDavid Gibson                                              SpaprMachineState *spapr,
6358d90ad90SDavid Gibson                                              target_ulong opcode,
6368d90ad90SDavid Gibson                                              target_ulong *args)
6378d90ad90SDavid Gibson {
6388d90ad90SDavid Gibson     target_ulong reg = args[0];
6398d90ad90SDavid Gibson     target_ulong buf = args[1];
640ce2918cbSDavid Gibson     SpaprVioDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
641ce2918cbSDavid Gibson     SpaprVioVlan *dev = VIO_SPAPR_VLAN_DEVICE(sdev);
642d6f39fdfSThomas Huth     target_long ret;
6438d90ad90SDavid Gibson 
644e8bb33deSLaurent Vivier     trace_spapr_vlan_h_add_logical_lan_buffer(reg, buf);
6458d90ad90SDavid Gibson 
6468d90ad90SDavid Gibson     if (!sdev) {
647d9599c92SDavid Gibson         hcall_dprintf("Bad device\n");
6488d90ad90SDavid Gibson         return H_PARAMETER;
6498d90ad90SDavid Gibson     }
6508d90ad90SDavid Gibson 
6518d90ad90SDavid Gibson     if ((check_bd(dev, buf, 4) < 0)
6528d90ad90SDavid Gibson         || (VLAN_BD_LEN(buf) < 16)) {
653d9599c92SDavid Gibson         hcall_dprintf("Bad buffer enqueued\n");
6548d90ad90SDavid Gibson         return H_PARAMETER;
6558d90ad90SDavid Gibson     }
6568d90ad90SDavid Gibson 
657d6f39fdfSThomas Huth     if (!dev->isopen) {
6588d90ad90SDavid Gibson         return H_RESOURCE;
6598d90ad90SDavid Gibson     }
6608d90ad90SDavid Gibson 
661831e8822SThomas Huth     if (dev->compat_flags & SPAPRVLAN_FLAG_RX_BUF_POOLS) {
662831e8822SThomas Huth         ret = spapr_vlan_add_rxbuf_to_pool(dev, buf);
663831e8822SThomas Huth     } else {
664d6f39fdfSThomas Huth         ret = spapr_vlan_add_rxbuf_to_page(dev, buf);
665831e8822SThomas Huth     }
666d6f39fdfSThomas Huth     if (ret) {
667d6f39fdfSThomas Huth         return ret;
6688d90ad90SDavid Gibson     }
6698d90ad90SDavid Gibson 
6708d90ad90SDavid Gibson     dev->rx_bufs++;
6718d90ad90SDavid Gibson 
6728836630fSThomas Huth     /*
6738836630fSThomas Huth      * Give guest some more time to add additional RX buffers before we
6748836630fSThomas Huth      * flush the receive queue, so that e.g. fragmented IP packets can
6758836630fSThomas Huth      * be passed to the guest in one go later (instead of passing single
6768836630fSThomas Huth      * fragments if there is only one receive buffer available).
6778836630fSThomas Huth      */
6788836630fSThomas Huth     timer_mod(dev->rxp_timer, qemu_clock_get_us(QEMU_CLOCK_VIRTUAL) + 500);
6790a61f3b4SAlexey Kardashevskiy 
6808d90ad90SDavid Gibson     return H_SUCCESS;
6818d90ad90SDavid Gibson }
6828d90ad90SDavid Gibson 
68328e02042SDavid Gibson static target_ulong h_send_logical_lan(PowerPCCPU *cpu,
684ce2918cbSDavid Gibson                                        SpaprMachineState *spapr,
6858d90ad90SDavid Gibson                                        target_ulong opcode, target_ulong *args)
6868d90ad90SDavid Gibson {
6878d90ad90SDavid Gibson     target_ulong reg = args[0];
6888d90ad90SDavid Gibson     target_ulong *bufs = args + 1;
6898d90ad90SDavid Gibson     target_ulong continue_token = args[7];
690ce2918cbSDavid Gibson     SpaprVioDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
691ce2918cbSDavid Gibson     SpaprVioVlan *dev = VIO_SPAPR_VLAN_DEVICE(sdev);
6928d90ad90SDavid Gibson     unsigned total_len;
6938d90ad90SDavid Gibson     uint8_t *lbuf, *p;
6948d90ad90SDavid Gibson     int i, nbufs;
6958d90ad90SDavid Gibson     int ret;
6968d90ad90SDavid Gibson 
697e8bb33deSLaurent Vivier     trace_spapr_vlan_h_send_logical_lan(reg, continue_token);
6988d90ad90SDavid Gibson 
6998d90ad90SDavid Gibson     if (!sdev) {
7008d90ad90SDavid Gibson         return H_PARAMETER;
7018d90ad90SDavid Gibson     }
7028d90ad90SDavid Gibson 
703e8bb33deSLaurent Vivier     trace_spapr_vlan_h_send_logical_lan_rxbufs(dev->rx_bufs);
7048d90ad90SDavid Gibson 
7058d90ad90SDavid Gibson     if (!dev->isopen) {
7068d90ad90SDavid Gibson         return H_DROPPED;
7078d90ad90SDavid Gibson     }
7088d90ad90SDavid Gibson 
7098d90ad90SDavid Gibson     if (continue_token) {
7108d90ad90SDavid Gibson         return H_HARDWARE; /* FIXME actually handle this */
7118d90ad90SDavid Gibson     }
7128d90ad90SDavid Gibson 
7138d90ad90SDavid Gibson     total_len = 0;
7148d90ad90SDavid Gibson     for (i = 0; i < 6; i++) {
715e8bb33deSLaurent Vivier         trace_spapr_vlan_h_send_logical_lan_buf_desc(bufs[i]);
7168d90ad90SDavid Gibson         if (!(bufs[i] & VLAN_BD_VALID)) {
7178d90ad90SDavid Gibson             break;
7188d90ad90SDavid Gibson         }
7198d90ad90SDavid Gibson         total_len += VLAN_BD_LEN(bufs[i]);
7208d90ad90SDavid Gibson     }
7218d90ad90SDavid Gibson 
7228d90ad90SDavid Gibson     nbufs = i;
723e8bb33deSLaurent Vivier     trace_spapr_vlan_h_send_logical_lan_total(nbufs, total_len);
7248d90ad90SDavid Gibson 
7258d90ad90SDavid Gibson     if (total_len == 0) {
7268d90ad90SDavid Gibson         return H_SUCCESS;
7278d90ad90SDavid Gibson     }
7288d90ad90SDavid Gibson 
7298d90ad90SDavid Gibson     if (total_len > MAX_PACKET_SIZE) {
7308d90ad90SDavid Gibson         /* Don't let the guest force too large an allocation */
7318d90ad90SDavid Gibson         return H_RESOURCE;
7328d90ad90SDavid Gibson     }
7338d90ad90SDavid Gibson 
7348d90ad90SDavid Gibson     lbuf = alloca(total_len);
7358d90ad90SDavid Gibson     p = lbuf;
7368d90ad90SDavid Gibson     for (i = 0; i < nbufs; i++) {
737ad0ebb91SDavid Gibson         ret = spapr_vio_dma_read(sdev, VLAN_BD_ADDR(bufs[i]),
7388d90ad90SDavid Gibson                                  p, VLAN_BD_LEN(bufs[i]));
7398d90ad90SDavid Gibson         if (ret < 0) {
7408d90ad90SDavid Gibson             return ret;
7418d90ad90SDavid Gibson         }
7428d90ad90SDavid Gibson 
7438d90ad90SDavid Gibson         p += VLAN_BD_LEN(bufs[i]);
7448d90ad90SDavid Gibson     }
7458d90ad90SDavid Gibson 
746b356f76dSJason Wang     qemu_send_packet(qemu_get_queue(dev->nic), lbuf, total_len);
7478d90ad90SDavid Gibson 
7488d90ad90SDavid Gibson     return H_SUCCESS;
7498d90ad90SDavid Gibson }
7508d90ad90SDavid Gibson 
751ce2918cbSDavid Gibson static target_ulong h_multicast_ctrl(PowerPCCPU *cpu, SpaprMachineState *spapr,
7528d90ad90SDavid Gibson                                      target_ulong opcode, target_ulong *args)
7538d90ad90SDavid Gibson {
7548d90ad90SDavid Gibson     target_ulong reg = args[0];
755ce2918cbSDavid Gibson     SpaprVioDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
7568d90ad90SDavid Gibson 
7578d90ad90SDavid Gibson     if (!dev) {
7588d90ad90SDavid Gibson         return H_PARAMETER;
7598d90ad90SDavid Gibson     }
7608d90ad90SDavid Gibson 
7618d90ad90SDavid Gibson     return H_SUCCESS;
7628d90ad90SDavid Gibson }
7638d90ad90SDavid Gibson 
76432f5f50dSLaurent Vivier static target_ulong h_change_logical_lan_mac(PowerPCCPU *cpu,
765ce2918cbSDavid Gibson                                              SpaprMachineState *spapr,
76632f5f50dSLaurent Vivier                                              target_ulong opcode,
76732f5f50dSLaurent Vivier                                              target_ulong *args)
76832f5f50dSLaurent Vivier {
76932f5f50dSLaurent Vivier     target_ulong reg = args[0];
77032f5f50dSLaurent Vivier     target_ulong macaddr = args[1];
771ce2918cbSDavid Gibson     SpaprVioDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
772ce2918cbSDavid Gibson     SpaprVioVlan *dev = VIO_SPAPR_VLAN_DEVICE(sdev);
77332f5f50dSLaurent Vivier     int i;
77432f5f50dSLaurent Vivier 
77532f5f50dSLaurent Vivier     for (i = 0; i < ETH_ALEN; i++) {
77632f5f50dSLaurent Vivier         dev->nicconf.macaddr.a[ETH_ALEN - i - 1] = macaddr & 0xff;
77732f5f50dSLaurent Vivier         macaddr >>= 8;
77832f5f50dSLaurent Vivier     }
77932f5f50dSLaurent Vivier 
78032f5f50dSLaurent Vivier     qemu_format_nic_info_str(qemu_get_queue(dev->nic), dev->nicconf.macaddr.a);
78132f5f50dSLaurent Vivier 
78232f5f50dSLaurent Vivier     return H_SUCCESS;
78332f5f50dSLaurent Vivier }
78432f5f50dSLaurent Vivier 
7853954d33aSAnthony Liguori static Property spapr_vlan_properties[] = {
786ce2918cbSDavid Gibson     DEFINE_SPAPR_PROPERTIES(SpaprVioVlan, sdev),
787ce2918cbSDavid Gibson     DEFINE_NIC_PROPERTIES(SpaprVioVlan, nicconf),
788ce2918cbSDavid Gibson     DEFINE_PROP_BIT("use-rx-buffer-pools", SpaprVioVlan,
78957c522f4SThomas Huth                     compat_flags, SPAPRVLAN_FLAG_RX_BUF_POOLS_BIT, true),
7908d90ad90SDavid Gibson     DEFINE_PROP_END_OF_LIST(),
7913954d33aSAnthony Liguori };
7923954d33aSAnthony Liguori 
793831e8822SThomas Huth static bool spapr_vlan_rx_buffer_pools_needed(void *opaque)
794831e8822SThomas Huth {
795ce2918cbSDavid Gibson     SpaprVioVlan *dev = opaque;
796831e8822SThomas Huth 
797831e8822SThomas Huth     return (dev->compat_flags & SPAPRVLAN_FLAG_RX_BUF_POOLS) != 0;
798831e8822SThomas Huth }
799831e8822SThomas Huth 
800831e8822SThomas Huth static const VMStateDescription vmstate_rx_buffer_pool = {
801831e8822SThomas Huth     .name = "spapr_llan/rx_buffer_pool",
802831e8822SThomas Huth     .version_id = 1,
803831e8822SThomas Huth     .minimum_version_id = 1,
804831e8822SThomas Huth     .needed = spapr_vlan_rx_buffer_pools_needed,
805831e8822SThomas Huth     .fields = (VMStateField[]) {
806831e8822SThomas Huth         VMSTATE_INT32(bufsize, RxBufPool),
807831e8822SThomas Huth         VMSTATE_INT32(count, RxBufPool),
808831e8822SThomas Huth         VMSTATE_UINT64_ARRAY(bds, RxBufPool, RX_POOL_MAX_BDS),
809831e8822SThomas Huth         VMSTATE_END_OF_LIST()
810831e8822SThomas Huth     }
811831e8822SThomas Huth };
812831e8822SThomas Huth 
813831e8822SThomas Huth static const VMStateDescription vmstate_rx_pools = {
814831e8822SThomas Huth     .name = "spapr_llan/rx_pools",
815831e8822SThomas Huth     .version_id = 1,
816831e8822SThomas Huth     .minimum_version_id = 1,
817831e8822SThomas Huth     .needed = spapr_vlan_rx_buffer_pools_needed,
818831e8822SThomas Huth     .fields = (VMStateField[]) {
819ce2918cbSDavid Gibson         VMSTATE_ARRAY_OF_POINTER_TO_STRUCT(rx_pool, SpaprVioVlan,
820831e8822SThomas Huth                                            RX_MAX_POOLS, 1,
821831e8822SThomas Huth                                            vmstate_rx_buffer_pool, RxBufPool),
822831e8822SThomas Huth         VMSTATE_END_OF_LIST()
823831e8822SThomas Huth     }
824831e8822SThomas Huth };
825831e8822SThomas Huth 
826686fefe4SDavid Gibson static const VMStateDescription vmstate_spapr_llan = {
827686fefe4SDavid Gibson     .name = "spapr_llan",
828686fefe4SDavid Gibson     .version_id = 1,
829686fefe4SDavid Gibson     .minimum_version_id = 1,
830686fefe4SDavid Gibson     .fields = (VMStateField[]) {
831ce2918cbSDavid Gibson         VMSTATE_SPAPR_VIO(sdev, SpaprVioVlan),
832686fefe4SDavid Gibson         /* LLAN state */
833ce2918cbSDavid Gibson         VMSTATE_BOOL(isopen, SpaprVioVlan),
834ce2918cbSDavid Gibson         VMSTATE_UINT64(buf_list, SpaprVioVlan),
835ce2918cbSDavid Gibson         VMSTATE_UINT32(add_buf_ptr, SpaprVioVlan),
836ce2918cbSDavid Gibson         VMSTATE_UINT32(use_buf_ptr, SpaprVioVlan),
837ce2918cbSDavid Gibson         VMSTATE_UINT32(rx_bufs, SpaprVioVlan),
838ce2918cbSDavid Gibson         VMSTATE_UINT64(rxq_ptr, SpaprVioVlan),
839686fefe4SDavid Gibson 
840686fefe4SDavid Gibson         VMSTATE_END_OF_LIST()
841686fefe4SDavid Gibson     },
842831e8822SThomas Huth     .subsections = (const VMStateDescription * []) {
843831e8822SThomas Huth         &vmstate_rx_pools,
844831e8822SThomas Huth         NULL
845831e8822SThomas Huth     }
846686fefe4SDavid Gibson };
847686fefe4SDavid Gibson 
8483954d33aSAnthony Liguori static void spapr_vlan_class_init(ObjectClass *klass, void *data)
8493954d33aSAnthony Liguori {
85039bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
851ce2918cbSDavid Gibson     SpaprVioDeviceClass *k = VIO_SPAPR_DEVICE_CLASS(klass);
8523954d33aSAnthony Liguori 
85328b07e73SMarkus Armbruster     k->realize = spapr_vlan_realize;
854c17491b6SDavid Gibson     k->reset = spapr_vlan_reset;
8553954d33aSAnthony Liguori     k->devnode = spapr_vlan_devnode;
8563954d33aSAnthony Liguori     k->dt_name = "l-lan";
8573954d33aSAnthony Liguori     k->dt_type = "network";
8583954d33aSAnthony Liguori     k->dt_compatible = "IBM,l-lan";
8593954d33aSAnthony Liguori     k->signal_mask = 0x1;
86029fdedfeSAlexey Kardashevskiy     set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
86139bffca2SAnthony Liguori     dc->props = spapr_vlan_properties;
862ad0ebb91SDavid Gibson     k->rtce_window_size = 0x10000000;
863686fefe4SDavid Gibson     dc->vmsd = &vmstate_spapr_llan;
8643954d33aSAnthony Liguori }
8653954d33aSAnthony Liguori 
8668c43a6f0SAndreas Färber static const TypeInfo spapr_vlan_info = {
867fd506b4fSDavid Gibson     .name          = TYPE_VIO_SPAPR_VLAN_DEVICE,
86839bffca2SAnthony Liguori     .parent        = TYPE_VIO_SPAPR_DEVICE,
869ce2918cbSDavid Gibson     .instance_size = sizeof(SpaprVioVlan),
8703954d33aSAnthony Liguori     .class_init    = spapr_vlan_class_init,
871dfe79cf2SGonglei     .instance_init = spapr_vlan_instance_init,
872831e8822SThomas Huth     .instance_finalize = spapr_vlan_instance_finalize,
8738d90ad90SDavid Gibson };
8748d90ad90SDavid Gibson 
87583f7d43aSAndreas Färber static void spapr_vlan_register_types(void)
8768d90ad90SDavid Gibson {
8771fc02533SDavid Gibson     spapr_register_hypercall(H_REGISTER_LOGICAL_LAN, h_register_logical_lan);
8781fc02533SDavid Gibson     spapr_register_hypercall(H_FREE_LOGICAL_LAN, h_free_logical_lan);
8791fc02533SDavid Gibson     spapr_register_hypercall(H_SEND_LOGICAL_LAN, h_send_logical_lan);
8801fc02533SDavid Gibson     spapr_register_hypercall(H_ADD_LOGICAL_LAN_BUFFER,
8811fc02533SDavid Gibson                              h_add_logical_lan_buffer);
8821fc02533SDavid Gibson     spapr_register_hypercall(H_MULTICAST_CTRL, h_multicast_ctrl);
88332f5f50dSLaurent Vivier     spapr_register_hypercall(H_CHANGE_LOGICAL_LAN_MAC,
88432f5f50dSLaurent Vivier                              h_change_logical_lan_mac);
88539bffca2SAnthony Liguori     type_register_static(&spapr_vlan_info);
8868d90ad90SDavid Gibson }
88783f7d43aSAndreas Färber 
88883f7d43aSAndreas Färber type_init(spapr_vlan_register_types)
889