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