1d7e35d4aSPaolo Bonzini /* 2d7e35d4aSPaolo Bonzini * QEMU PowerPC pSeries Logical Partition (aka sPAPR) hardware System Emulator 3d7e35d4aSPaolo Bonzini * 4d7e35d4aSPaolo Bonzini * PAPR Inter-VM Logical Lan, aka ibmveth 5d7e35d4aSPaolo Bonzini * 6d7e35d4aSPaolo Bonzini * Copyright (c) 2010,2011 David Gibson, IBM Corporation. 7d7e35d4aSPaolo Bonzini * 8d7e35d4aSPaolo Bonzini * Permission is hereby granted, free of charge, to any person obtaining a copy 9d7e35d4aSPaolo Bonzini * of this software and associated documentation files (the "Software"), to deal 10d7e35d4aSPaolo Bonzini * in the Software without restriction, including without limitation the rights 11d7e35d4aSPaolo Bonzini * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 12d7e35d4aSPaolo Bonzini * copies of the Software, and to permit persons to whom the Software is 13d7e35d4aSPaolo Bonzini * furnished to do so, subject to the following conditions: 14d7e35d4aSPaolo Bonzini * 15d7e35d4aSPaolo Bonzini * The above copyright notice and this permission notice shall be included in 16d7e35d4aSPaolo Bonzini * all copies or substantial portions of the Software. 17d7e35d4aSPaolo Bonzini * 18d7e35d4aSPaolo Bonzini * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 19d7e35d4aSPaolo Bonzini * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 20d7e35d4aSPaolo Bonzini * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 21d7e35d4aSPaolo Bonzini * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 22d7e35d4aSPaolo Bonzini * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 23d7e35d4aSPaolo Bonzini * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 24d7e35d4aSPaolo Bonzini * THE SOFTWARE. 25d7e35d4aSPaolo Bonzini * 26d7e35d4aSPaolo Bonzini */ 27d7e35d4aSPaolo Bonzini #include "hw/hw.h" 28d7e35d4aSPaolo Bonzini #include "net/net.h" 29d7e35d4aSPaolo Bonzini #include "hw/qdev.h" 30d7e35d4aSPaolo Bonzini #include "hw/ppc/spapr.h" 31d7e35d4aSPaolo Bonzini #include "hw/ppc/spapr_vio.h" 32ad4f62d0SAlexey Kardashevskiy #include "sysemu/sysemu.h" 33d7e35d4aSPaolo Bonzini 34d7e35d4aSPaolo Bonzini #include <libfdt.h> 35d7e35d4aSPaolo Bonzini 36d7e35d4aSPaolo Bonzini #define ETH_ALEN 6 37d7e35d4aSPaolo Bonzini #define MAX_PACKET_SIZE 65536 38d7e35d4aSPaolo Bonzini 39d7e35d4aSPaolo Bonzini /*#define DEBUG*/ 40d7e35d4aSPaolo Bonzini 41d7e35d4aSPaolo Bonzini #ifdef DEBUG 42f6bda9cbSPeter Maydell #define DPRINTF(fmt...) do { fprintf(stderr, fmt); } while (0) 43d7e35d4aSPaolo Bonzini #else 44f6bda9cbSPeter Maydell #define DPRINTF(fmt...) 45d7e35d4aSPaolo Bonzini #endif 46d7e35d4aSPaolo Bonzini 47d7e35d4aSPaolo Bonzini /* 48d7e35d4aSPaolo Bonzini * Virtual LAN device 49d7e35d4aSPaolo Bonzini */ 50d7e35d4aSPaolo Bonzini 51d7e35d4aSPaolo Bonzini typedef uint64_t vlan_bd_t; 52d7e35d4aSPaolo Bonzini 53d7e35d4aSPaolo Bonzini #define VLAN_BD_VALID 0x8000000000000000ULL 54d7e35d4aSPaolo Bonzini #define VLAN_BD_TOGGLE 0x4000000000000000ULL 55d7e35d4aSPaolo Bonzini #define VLAN_BD_NO_CSUM 0x0200000000000000ULL 56d7e35d4aSPaolo Bonzini #define VLAN_BD_CSUM_GOOD 0x0100000000000000ULL 57d7e35d4aSPaolo Bonzini #define VLAN_BD_LEN_MASK 0x00ffffff00000000ULL 58d7e35d4aSPaolo Bonzini #define VLAN_BD_LEN(bd) (((bd) & VLAN_BD_LEN_MASK) >> 32) 59d7e35d4aSPaolo Bonzini #define VLAN_BD_ADDR_MASK 0x00000000ffffffffULL 60d7e35d4aSPaolo Bonzini #define VLAN_BD_ADDR(bd) ((bd) & VLAN_BD_ADDR_MASK) 61d7e35d4aSPaolo Bonzini 62d7e35d4aSPaolo Bonzini #define VLAN_VALID_BD(addr, len) (VLAN_BD_VALID | \ 63d7e35d4aSPaolo Bonzini (((len) << 32) & VLAN_BD_LEN_MASK) | \ 64d7e35d4aSPaolo Bonzini (addr & VLAN_BD_ADDR_MASK)) 65d7e35d4aSPaolo Bonzini 66d7e35d4aSPaolo Bonzini #define VLAN_RXQC_TOGGLE 0x80 67d7e35d4aSPaolo Bonzini #define VLAN_RXQC_VALID 0x40 68d7e35d4aSPaolo Bonzini #define VLAN_RXQC_NO_CSUM 0x02 69d7e35d4aSPaolo Bonzini #define VLAN_RXQC_CSUM_GOOD 0x01 70d7e35d4aSPaolo Bonzini 71d7e35d4aSPaolo Bonzini #define VLAN_RQ_ALIGNMENT 16 72d7e35d4aSPaolo Bonzini #define VLAN_RXQ_BD_OFF 0 73d7e35d4aSPaolo Bonzini #define VLAN_FILTER_BD_OFF 8 74d7e35d4aSPaolo Bonzini #define VLAN_RX_BDS_OFF 16 75439ce140SAnton Blanchard /* 76439ce140SAnton Blanchard * The final 8 bytes of the buffer list is a counter of frames dropped 77439ce140SAnton Blanchard * because there was not a buffer in the buffer list capable of holding 78439ce140SAnton Blanchard * the frame. We must avoid it, or the operating system will report garbage 79439ce140SAnton Blanchard * for this statistic. 80439ce140SAnton Blanchard */ 81439ce140SAnton Blanchard #define VLAN_RX_BDS_LEN (SPAPR_TCE_PAGE_SIZE - VLAN_RX_BDS_OFF - 8) 82439ce140SAnton Blanchard #define VLAN_MAX_BUFS (VLAN_RX_BDS_LEN / 8) 83d7e35d4aSPaolo Bonzini 84fd506b4fSDavid Gibson #define TYPE_VIO_SPAPR_VLAN_DEVICE "spapr-vlan" 85fd506b4fSDavid Gibson #define VIO_SPAPR_VLAN_DEVICE(obj) \ 86fd506b4fSDavid Gibson OBJECT_CHECK(VIOsPAPRVLANDevice, (obj), TYPE_VIO_SPAPR_VLAN_DEVICE) 87fd506b4fSDavid Gibson 88d7e35d4aSPaolo Bonzini typedef struct VIOsPAPRVLANDevice { 89d7e35d4aSPaolo Bonzini VIOsPAPRDevice sdev; 90d7e35d4aSPaolo Bonzini NICConf nicconf; 91d7e35d4aSPaolo Bonzini NICState *nic; 92686fefe4SDavid Gibson bool isopen; 93d7e35d4aSPaolo Bonzini target_ulong buf_list; 94686fefe4SDavid Gibson uint32_t add_buf_ptr, use_buf_ptr, rx_bufs; 95d7e35d4aSPaolo Bonzini target_ulong rxq_ptr; 96d7e35d4aSPaolo Bonzini } VIOsPAPRVLANDevice; 97d7e35d4aSPaolo Bonzini 98d7e35d4aSPaolo Bonzini static int spapr_vlan_can_receive(NetClientState *nc) 99d7e35d4aSPaolo Bonzini { 100d7e35d4aSPaolo Bonzini VIOsPAPRVLANDevice *dev = qemu_get_nic_opaque(nc); 101d7e35d4aSPaolo Bonzini 102d7e35d4aSPaolo Bonzini return (dev->isopen && dev->rx_bufs > 0); 103d7e35d4aSPaolo Bonzini } 104d7e35d4aSPaolo Bonzini 105d7e35d4aSPaolo Bonzini static ssize_t spapr_vlan_receive(NetClientState *nc, const uint8_t *buf, 106d7e35d4aSPaolo Bonzini size_t size) 107d7e35d4aSPaolo Bonzini { 108fd506b4fSDavid Gibson VIOsPAPRVLANDevice *dev = qemu_get_nic_opaque(nc); 109fd506b4fSDavid Gibson VIOsPAPRDevice *sdev = VIO_SPAPR_DEVICE(dev); 110d7e35d4aSPaolo Bonzini vlan_bd_t rxq_bd = vio_ldq(sdev, dev->buf_list + VLAN_RXQ_BD_OFF); 111d7e35d4aSPaolo Bonzini vlan_bd_t bd; 112d7e35d4aSPaolo Bonzini int buf_ptr = dev->use_buf_ptr; 113d7e35d4aSPaolo Bonzini uint64_t handle; 114d7e35d4aSPaolo Bonzini uint8_t control; 115d7e35d4aSPaolo Bonzini 116f6bda9cbSPeter Maydell DPRINTF("spapr_vlan_receive() [%s] rx_bufs=%d\n", sdev->qdev.id, 117d7e35d4aSPaolo Bonzini dev->rx_bufs); 118d7e35d4aSPaolo Bonzini 119d7e35d4aSPaolo Bonzini if (!dev->isopen) { 120d7e35d4aSPaolo Bonzini return -1; 121d7e35d4aSPaolo Bonzini } 122d7e35d4aSPaolo Bonzini 123d7e35d4aSPaolo Bonzini if (!dev->rx_bufs) { 124d7e35d4aSPaolo Bonzini return -1; 125d7e35d4aSPaolo Bonzini } 126d7e35d4aSPaolo Bonzini 127d7e35d4aSPaolo Bonzini do { 128d7e35d4aSPaolo Bonzini buf_ptr += 8; 129439ce140SAnton Blanchard if (buf_ptr >= (VLAN_RX_BDS_LEN + VLAN_RX_BDS_OFF)) { 130d7e35d4aSPaolo Bonzini buf_ptr = VLAN_RX_BDS_OFF; 131d7e35d4aSPaolo Bonzini } 132d7e35d4aSPaolo Bonzini 133d7e35d4aSPaolo Bonzini bd = vio_ldq(sdev, dev->buf_list + buf_ptr); 134f6bda9cbSPeter Maydell DPRINTF("use_buf_ptr=%d bd=0x%016llx\n", 135d7e35d4aSPaolo Bonzini buf_ptr, (unsigned long long)bd); 136d7e35d4aSPaolo Bonzini } while ((!(bd & VLAN_BD_VALID) || (VLAN_BD_LEN(bd) < (size + 8))) 137d7e35d4aSPaolo Bonzini && (buf_ptr != dev->use_buf_ptr)); 138d7e35d4aSPaolo Bonzini 139d7e35d4aSPaolo Bonzini if (!(bd & VLAN_BD_VALID) || (VLAN_BD_LEN(bd) < (size + 8))) { 140d7e35d4aSPaolo Bonzini /* Failed to find a suitable buffer */ 141d7e35d4aSPaolo Bonzini return -1; 142d7e35d4aSPaolo Bonzini } 143d7e35d4aSPaolo Bonzini 144d7e35d4aSPaolo Bonzini /* Remove the buffer from the pool */ 145d7e35d4aSPaolo Bonzini dev->rx_bufs--; 146d7e35d4aSPaolo Bonzini dev->use_buf_ptr = buf_ptr; 147d7e35d4aSPaolo Bonzini vio_stq(sdev, dev->buf_list + dev->use_buf_ptr, 0); 148d7e35d4aSPaolo Bonzini 149f6bda9cbSPeter Maydell DPRINTF("Found buffer: ptr=%d num=%d\n", dev->use_buf_ptr, dev->rx_bufs); 150d7e35d4aSPaolo Bonzini 151d7e35d4aSPaolo Bonzini /* Transfer the packet data */ 152d7e35d4aSPaolo Bonzini if (spapr_vio_dma_write(sdev, VLAN_BD_ADDR(bd) + 8, buf, size) < 0) { 153d7e35d4aSPaolo Bonzini return -1; 154d7e35d4aSPaolo Bonzini } 155d7e35d4aSPaolo Bonzini 156f6bda9cbSPeter Maydell DPRINTF("spapr_vlan_receive: DMA write completed\n"); 157d7e35d4aSPaolo Bonzini 158d7e35d4aSPaolo Bonzini /* Update the receive queue */ 159d7e35d4aSPaolo Bonzini control = VLAN_RXQC_TOGGLE | VLAN_RXQC_VALID; 160d7e35d4aSPaolo Bonzini if (rxq_bd & VLAN_BD_TOGGLE) { 161d7e35d4aSPaolo Bonzini control ^= VLAN_RXQC_TOGGLE; 162d7e35d4aSPaolo Bonzini } 163d7e35d4aSPaolo Bonzini 164d7e35d4aSPaolo Bonzini handle = vio_ldq(sdev, VLAN_BD_ADDR(bd)); 165d7e35d4aSPaolo Bonzini vio_stq(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 8, handle); 166d7e35d4aSPaolo Bonzini vio_stl(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 4, size); 167d7e35d4aSPaolo Bonzini vio_sth(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 2, 8); 168d7e35d4aSPaolo Bonzini vio_stb(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr, control); 169d7e35d4aSPaolo Bonzini 170f6bda9cbSPeter Maydell DPRINTF("wrote rxq entry (ptr=0x%llx): 0x%016llx 0x%016llx\n", 171d7e35d4aSPaolo Bonzini (unsigned long long)dev->rxq_ptr, 172d7e35d4aSPaolo Bonzini (unsigned long long)vio_ldq(sdev, VLAN_BD_ADDR(rxq_bd) + 173d7e35d4aSPaolo Bonzini dev->rxq_ptr), 174d7e35d4aSPaolo Bonzini (unsigned long long)vio_ldq(sdev, VLAN_BD_ADDR(rxq_bd) + 175d7e35d4aSPaolo Bonzini dev->rxq_ptr + 8)); 176d7e35d4aSPaolo Bonzini 177d7e35d4aSPaolo Bonzini dev->rxq_ptr += 16; 178d7e35d4aSPaolo Bonzini if (dev->rxq_ptr >= VLAN_BD_LEN(rxq_bd)) { 179d7e35d4aSPaolo Bonzini dev->rxq_ptr = 0; 180d7e35d4aSPaolo Bonzini vio_stq(sdev, dev->buf_list + VLAN_RXQ_BD_OFF, rxq_bd ^ VLAN_BD_TOGGLE); 181d7e35d4aSPaolo Bonzini } 182d7e35d4aSPaolo Bonzini 183d7e35d4aSPaolo Bonzini if (sdev->signal_state & 1) { 184d7e35d4aSPaolo Bonzini qemu_irq_pulse(spapr_vio_qirq(sdev)); 185d7e35d4aSPaolo Bonzini } 186d7e35d4aSPaolo Bonzini 187d7e35d4aSPaolo Bonzini return size; 188d7e35d4aSPaolo Bonzini } 189d7e35d4aSPaolo Bonzini 190d7e35d4aSPaolo Bonzini static void spapr_vlan_cleanup(NetClientState *nc) 191d7e35d4aSPaolo Bonzini { 192d7e35d4aSPaolo Bonzini VIOsPAPRVLANDevice *dev = qemu_get_nic_opaque(nc); 193d7e35d4aSPaolo Bonzini 194d7e35d4aSPaolo Bonzini dev->nic = NULL; 195d7e35d4aSPaolo Bonzini } 196d7e35d4aSPaolo Bonzini 197d7e35d4aSPaolo Bonzini static NetClientInfo net_spapr_vlan_info = { 198d7e35d4aSPaolo Bonzini .type = NET_CLIENT_OPTIONS_KIND_NIC, 199d7e35d4aSPaolo Bonzini .size = sizeof(NICState), 200d7e35d4aSPaolo Bonzini .can_receive = spapr_vlan_can_receive, 201d7e35d4aSPaolo Bonzini .receive = spapr_vlan_receive, 202d7e35d4aSPaolo Bonzini .cleanup = spapr_vlan_cleanup, 203d7e35d4aSPaolo Bonzini }; 204d7e35d4aSPaolo Bonzini 205d7e35d4aSPaolo Bonzini static void spapr_vlan_reset(VIOsPAPRDevice *sdev) 206d7e35d4aSPaolo Bonzini { 207fd506b4fSDavid Gibson VIOsPAPRVLANDevice *dev = VIO_SPAPR_VLAN_DEVICE(sdev); 208d7e35d4aSPaolo Bonzini 209d7e35d4aSPaolo Bonzini dev->buf_list = 0; 210d7e35d4aSPaolo Bonzini dev->rx_bufs = 0; 211d7e35d4aSPaolo Bonzini dev->isopen = 0; 212d7e35d4aSPaolo Bonzini } 213d7e35d4aSPaolo Bonzini 214d7e35d4aSPaolo Bonzini static int spapr_vlan_init(VIOsPAPRDevice *sdev) 215d7e35d4aSPaolo Bonzini { 216fd506b4fSDavid Gibson VIOsPAPRVLANDevice *dev = VIO_SPAPR_VLAN_DEVICE(sdev); 217d7e35d4aSPaolo Bonzini 218d7e35d4aSPaolo Bonzini qemu_macaddr_default_if_unset(&dev->nicconf.macaddr); 219d7e35d4aSPaolo Bonzini 220d7e35d4aSPaolo Bonzini dev->nic = qemu_new_nic(&net_spapr_vlan_info, &dev->nicconf, 221d7e35d4aSPaolo Bonzini object_get_typename(OBJECT(sdev)), sdev->qdev.id, dev); 222d7e35d4aSPaolo Bonzini qemu_format_nic_info_str(qemu_get_queue(dev->nic), dev->nicconf.macaddr.a); 223d7e35d4aSPaolo Bonzini 224ad4f62d0SAlexey Kardashevskiy add_boot_device_path(dev->nicconf.bootindex, DEVICE(dev), ""); 225ad4f62d0SAlexey Kardashevskiy 226d7e35d4aSPaolo Bonzini return 0; 227d7e35d4aSPaolo Bonzini } 228d7e35d4aSPaolo Bonzini 229*dfe79cf2SGonglei static void spapr_vlan_instance_init(Object *obj) 230*dfe79cf2SGonglei { 231*dfe79cf2SGonglei VIOsPAPRVLANDevice *dev = VIO_SPAPR_VLAN_DEVICE(obj); 232*dfe79cf2SGonglei 233*dfe79cf2SGonglei device_add_bootindex_property(obj, &dev->nicconf.bootindex, 234*dfe79cf2SGonglei "bootindex", "", 235*dfe79cf2SGonglei DEVICE(dev), NULL); 236*dfe79cf2SGonglei } 237*dfe79cf2SGonglei 238d7e35d4aSPaolo Bonzini void spapr_vlan_create(VIOsPAPRBus *bus, NICInfo *nd) 239d7e35d4aSPaolo Bonzini { 240d7e35d4aSPaolo Bonzini DeviceState *dev; 241d7e35d4aSPaolo Bonzini 242d7e35d4aSPaolo Bonzini dev = qdev_create(&bus->bus, "spapr-vlan"); 243d7e35d4aSPaolo Bonzini 244d7e35d4aSPaolo Bonzini qdev_set_nic_properties(dev, nd); 245d7e35d4aSPaolo Bonzini 246d7e35d4aSPaolo Bonzini qdev_init_nofail(dev); 247d7e35d4aSPaolo Bonzini } 248d7e35d4aSPaolo Bonzini 249d7e35d4aSPaolo Bonzini static int spapr_vlan_devnode(VIOsPAPRDevice *dev, void *fdt, int node_off) 250d7e35d4aSPaolo Bonzini { 251fd506b4fSDavid Gibson VIOsPAPRVLANDevice *vdev = VIO_SPAPR_VLAN_DEVICE(dev); 252d7e35d4aSPaolo Bonzini uint8_t padded_mac[8] = {0, 0}; 253d7e35d4aSPaolo Bonzini int ret; 254d7e35d4aSPaolo Bonzini 255d7e35d4aSPaolo Bonzini /* Some old phyp versions give the mac address in an 8-byte 256d7e35d4aSPaolo Bonzini * property. The kernel driver has an insane workaround for this; 257d7e35d4aSPaolo Bonzini * rather than doing the obvious thing and checking the property 258d7e35d4aSPaolo Bonzini * length, it checks whether the first byte has 0b10 in the low 259d7e35d4aSPaolo Bonzini * bits. If a correct 6-byte property has a different first byte 260d7e35d4aSPaolo Bonzini * the kernel will get the wrong mac address, overrunning its 261d7e35d4aSPaolo Bonzini * buffer in the process (read only, thank goodness). 262d7e35d4aSPaolo Bonzini * 263d7e35d4aSPaolo Bonzini * Here we workaround the kernel workaround by always supplying an 264d7e35d4aSPaolo Bonzini * 8-byte property, with the mac address in the last six bytes */ 265d7e35d4aSPaolo Bonzini memcpy(&padded_mac[2], &vdev->nicconf.macaddr, ETH_ALEN); 266d7e35d4aSPaolo Bonzini ret = fdt_setprop(fdt, node_off, "local-mac-address", 267d7e35d4aSPaolo Bonzini padded_mac, sizeof(padded_mac)); 268d7e35d4aSPaolo Bonzini if (ret < 0) { 269d7e35d4aSPaolo Bonzini return ret; 270d7e35d4aSPaolo Bonzini } 271d7e35d4aSPaolo Bonzini 272d7e35d4aSPaolo Bonzini ret = fdt_setprop_cell(fdt, node_off, "ibm,mac-address-filters", 0); 273d7e35d4aSPaolo Bonzini if (ret < 0) { 274d7e35d4aSPaolo Bonzini return ret; 275d7e35d4aSPaolo Bonzini } 276d7e35d4aSPaolo Bonzini 277d7e35d4aSPaolo Bonzini return 0; 278d7e35d4aSPaolo Bonzini } 279d7e35d4aSPaolo Bonzini 280d7e35d4aSPaolo Bonzini static int check_bd(VIOsPAPRVLANDevice *dev, vlan_bd_t bd, 281d7e35d4aSPaolo Bonzini target_ulong alignment) 282d7e35d4aSPaolo Bonzini { 283d7e35d4aSPaolo Bonzini if ((VLAN_BD_ADDR(bd) % alignment) 284d7e35d4aSPaolo Bonzini || (VLAN_BD_LEN(bd) % alignment)) { 285d7e35d4aSPaolo Bonzini return -1; 286d7e35d4aSPaolo Bonzini } 287d7e35d4aSPaolo Bonzini 288d7e35d4aSPaolo Bonzini if (!spapr_vio_dma_valid(&dev->sdev, VLAN_BD_ADDR(bd), 289d7e35d4aSPaolo Bonzini VLAN_BD_LEN(bd), DMA_DIRECTION_FROM_DEVICE) 290d7e35d4aSPaolo Bonzini || !spapr_vio_dma_valid(&dev->sdev, VLAN_BD_ADDR(bd), 291d7e35d4aSPaolo Bonzini VLAN_BD_LEN(bd), DMA_DIRECTION_TO_DEVICE)) { 292d7e35d4aSPaolo Bonzini return -1; 293d7e35d4aSPaolo Bonzini } 294d7e35d4aSPaolo Bonzini 295d7e35d4aSPaolo Bonzini return 0; 296d7e35d4aSPaolo Bonzini } 297d7e35d4aSPaolo Bonzini 298d7e35d4aSPaolo Bonzini static target_ulong h_register_logical_lan(PowerPCCPU *cpu, 299d7e35d4aSPaolo Bonzini sPAPREnvironment *spapr, 300d7e35d4aSPaolo Bonzini target_ulong opcode, 301d7e35d4aSPaolo Bonzini target_ulong *args) 302d7e35d4aSPaolo Bonzini { 303d7e35d4aSPaolo Bonzini target_ulong reg = args[0]; 304d7e35d4aSPaolo Bonzini target_ulong buf_list = args[1]; 305d7e35d4aSPaolo Bonzini target_ulong rec_queue = args[2]; 306d7e35d4aSPaolo Bonzini target_ulong filter_list = args[3]; 307d7e35d4aSPaolo Bonzini VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); 308fd506b4fSDavid Gibson VIOsPAPRVLANDevice *dev = VIO_SPAPR_VLAN_DEVICE(sdev); 309d7e35d4aSPaolo Bonzini vlan_bd_t filter_list_bd; 310d7e35d4aSPaolo Bonzini 311d7e35d4aSPaolo Bonzini if (!dev) { 312d7e35d4aSPaolo Bonzini return H_PARAMETER; 313d7e35d4aSPaolo Bonzini } 314d7e35d4aSPaolo Bonzini 315d7e35d4aSPaolo Bonzini if (dev->isopen) { 316d7e35d4aSPaolo Bonzini hcall_dprintf("H_REGISTER_LOGICAL_LAN called twice without " 317d7e35d4aSPaolo Bonzini "H_FREE_LOGICAL_LAN\n"); 318d7e35d4aSPaolo Bonzini return H_RESOURCE; 319d7e35d4aSPaolo Bonzini } 320d7e35d4aSPaolo Bonzini 321d7e35d4aSPaolo Bonzini if (check_bd(dev, VLAN_VALID_BD(buf_list, SPAPR_TCE_PAGE_SIZE), 322d7e35d4aSPaolo Bonzini SPAPR_TCE_PAGE_SIZE) < 0) { 323d7e35d4aSPaolo Bonzini hcall_dprintf("Bad buf_list 0x" TARGET_FMT_lx "\n", buf_list); 324d7e35d4aSPaolo Bonzini return H_PARAMETER; 325d7e35d4aSPaolo Bonzini } 326d7e35d4aSPaolo Bonzini 327d7e35d4aSPaolo Bonzini filter_list_bd = VLAN_VALID_BD(filter_list, SPAPR_TCE_PAGE_SIZE); 328d7e35d4aSPaolo Bonzini if (check_bd(dev, filter_list_bd, SPAPR_TCE_PAGE_SIZE) < 0) { 329d7e35d4aSPaolo Bonzini hcall_dprintf("Bad filter_list 0x" TARGET_FMT_lx "\n", filter_list); 330d7e35d4aSPaolo Bonzini return H_PARAMETER; 331d7e35d4aSPaolo Bonzini } 332d7e35d4aSPaolo Bonzini 333d7e35d4aSPaolo Bonzini if (!(rec_queue & VLAN_BD_VALID) 334d7e35d4aSPaolo Bonzini || (check_bd(dev, rec_queue, VLAN_RQ_ALIGNMENT) < 0)) { 335d7e35d4aSPaolo Bonzini hcall_dprintf("Bad receive queue\n"); 336d7e35d4aSPaolo Bonzini return H_PARAMETER; 337d7e35d4aSPaolo Bonzini } 338d7e35d4aSPaolo Bonzini 339d7e35d4aSPaolo Bonzini dev->buf_list = buf_list; 340d7e35d4aSPaolo Bonzini sdev->signal_state = 0; 341d7e35d4aSPaolo Bonzini 342d7e35d4aSPaolo Bonzini rec_queue &= ~VLAN_BD_TOGGLE; 343d7e35d4aSPaolo Bonzini 344d7e35d4aSPaolo Bonzini /* Initialize the buffer list */ 345d7e35d4aSPaolo Bonzini vio_stq(sdev, buf_list, rec_queue); 346d7e35d4aSPaolo Bonzini vio_stq(sdev, buf_list + 8, filter_list_bd); 347d7e35d4aSPaolo Bonzini spapr_vio_dma_set(sdev, buf_list + VLAN_RX_BDS_OFF, 0, 348d7e35d4aSPaolo Bonzini SPAPR_TCE_PAGE_SIZE - VLAN_RX_BDS_OFF); 349d7e35d4aSPaolo Bonzini dev->add_buf_ptr = VLAN_RX_BDS_OFF - 8; 350d7e35d4aSPaolo Bonzini dev->use_buf_ptr = VLAN_RX_BDS_OFF - 8; 351d7e35d4aSPaolo Bonzini dev->rx_bufs = 0; 352d7e35d4aSPaolo Bonzini dev->rxq_ptr = 0; 353d7e35d4aSPaolo Bonzini 354d7e35d4aSPaolo Bonzini /* Initialize the receive queue */ 355d7e35d4aSPaolo Bonzini spapr_vio_dma_set(sdev, VLAN_BD_ADDR(rec_queue), 0, VLAN_BD_LEN(rec_queue)); 356d7e35d4aSPaolo Bonzini 357d7e35d4aSPaolo Bonzini dev->isopen = 1; 358e0ff466cSAlexey Kardashevskiy qemu_flush_queued_packets(qemu_get_queue(dev->nic)); 359e0ff466cSAlexey Kardashevskiy 360d7e35d4aSPaolo Bonzini return H_SUCCESS; 361d7e35d4aSPaolo Bonzini } 362d7e35d4aSPaolo Bonzini 363d7e35d4aSPaolo Bonzini 364d7e35d4aSPaolo Bonzini static target_ulong h_free_logical_lan(PowerPCCPU *cpu, sPAPREnvironment *spapr, 365d7e35d4aSPaolo Bonzini target_ulong opcode, target_ulong *args) 366d7e35d4aSPaolo Bonzini { 367d7e35d4aSPaolo Bonzini target_ulong reg = args[0]; 368d7e35d4aSPaolo Bonzini VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); 369fd506b4fSDavid Gibson VIOsPAPRVLANDevice *dev = VIO_SPAPR_VLAN_DEVICE(sdev); 370d7e35d4aSPaolo Bonzini 371d7e35d4aSPaolo Bonzini if (!dev) { 372d7e35d4aSPaolo Bonzini return H_PARAMETER; 373d7e35d4aSPaolo Bonzini } 374d7e35d4aSPaolo Bonzini 375d7e35d4aSPaolo Bonzini if (!dev->isopen) { 376d7e35d4aSPaolo Bonzini hcall_dprintf("H_FREE_LOGICAL_LAN called without " 377d7e35d4aSPaolo Bonzini "H_REGISTER_LOGICAL_LAN\n"); 378d7e35d4aSPaolo Bonzini return H_RESOURCE; 379d7e35d4aSPaolo Bonzini } 380d7e35d4aSPaolo Bonzini 381d7e35d4aSPaolo Bonzini spapr_vlan_reset(sdev); 382d7e35d4aSPaolo Bonzini return H_SUCCESS; 383d7e35d4aSPaolo Bonzini } 384d7e35d4aSPaolo Bonzini 385d7e35d4aSPaolo Bonzini static target_ulong h_add_logical_lan_buffer(PowerPCCPU *cpu, 386d7e35d4aSPaolo Bonzini sPAPREnvironment *spapr, 387d7e35d4aSPaolo Bonzini target_ulong opcode, 388d7e35d4aSPaolo Bonzini target_ulong *args) 389d7e35d4aSPaolo Bonzini { 390d7e35d4aSPaolo Bonzini target_ulong reg = args[0]; 391d7e35d4aSPaolo Bonzini target_ulong buf = args[1]; 392d7e35d4aSPaolo Bonzini VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); 393fd506b4fSDavid Gibson VIOsPAPRVLANDevice *dev = VIO_SPAPR_VLAN_DEVICE(sdev); 394d7e35d4aSPaolo Bonzini vlan_bd_t bd; 395d7e35d4aSPaolo Bonzini 396f6bda9cbSPeter Maydell DPRINTF("H_ADD_LOGICAL_LAN_BUFFER(0x" TARGET_FMT_lx 397d7e35d4aSPaolo Bonzini ", 0x" TARGET_FMT_lx ")\n", reg, buf); 398d7e35d4aSPaolo Bonzini 399d7e35d4aSPaolo Bonzini if (!sdev) { 400d7e35d4aSPaolo Bonzini hcall_dprintf("Bad device\n"); 401d7e35d4aSPaolo Bonzini return H_PARAMETER; 402d7e35d4aSPaolo Bonzini } 403d7e35d4aSPaolo Bonzini 404d7e35d4aSPaolo Bonzini if ((check_bd(dev, buf, 4) < 0) 405d7e35d4aSPaolo Bonzini || (VLAN_BD_LEN(buf) < 16)) { 406d7e35d4aSPaolo Bonzini hcall_dprintf("Bad buffer enqueued\n"); 407d7e35d4aSPaolo Bonzini return H_PARAMETER; 408d7e35d4aSPaolo Bonzini } 409d7e35d4aSPaolo Bonzini 410d7e35d4aSPaolo Bonzini if (!dev->isopen || dev->rx_bufs >= VLAN_MAX_BUFS) { 411d7e35d4aSPaolo Bonzini return H_RESOURCE; 412d7e35d4aSPaolo Bonzini } 413d7e35d4aSPaolo Bonzini 414d7e35d4aSPaolo Bonzini do { 415d7e35d4aSPaolo Bonzini dev->add_buf_ptr += 8; 416439ce140SAnton Blanchard if (dev->add_buf_ptr >= (VLAN_RX_BDS_LEN + VLAN_RX_BDS_OFF)) { 417d7e35d4aSPaolo Bonzini dev->add_buf_ptr = VLAN_RX_BDS_OFF; 418d7e35d4aSPaolo Bonzini } 419d7e35d4aSPaolo Bonzini 420d7e35d4aSPaolo Bonzini bd = vio_ldq(sdev, dev->buf_list + dev->add_buf_ptr); 421d7e35d4aSPaolo Bonzini } while (bd & VLAN_BD_VALID); 422d7e35d4aSPaolo Bonzini 423d7e35d4aSPaolo Bonzini vio_stq(sdev, dev->buf_list + dev->add_buf_ptr, buf); 424d7e35d4aSPaolo Bonzini 425d7e35d4aSPaolo Bonzini dev->rx_bufs++; 426d7e35d4aSPaolo Bonzini 4270a61f3b4SAlexey Kardashevskiy qemu_flush_queued_packets(qemu_get_queue(dev->nic)); 4280a61f3b4SAlexey Kardashevskiy 429f6bda9cbSPeter Maydell DPRINTF("h_add_logical_lan_buffer(): Added buf ptr=%d rx_bufs=%d" 430d7e35d4aSPaolo Bonzini " bd=0x%016llx\n", dev->add_buf_ptr, dev->rx_bufs, 431d7e35d4aSPaolo Bonzini (unsigned long long)buf); 432d7e35d4aSPaolo Bonzini 433d7e35d4aSPaolo Bonzini return H_SUCCESS; 434d7e35d4aSPaolo Bonzini } 435d7e35d4aSPaolo Bonzini 436d7e35d4aSPaolo Bonzini static target_ulong h_send_logical_lan(PowerPCCPU *cpu, sPAPREnvironment *spapr, 437d7e35d4aSPaolo Bonzini target_ulong opcode, target_ulong *args) 438d7e35d4aSPaolo Bonzini { 439d7e35d4aSPaolo Bonzini target_ulong reg = args[0]; 440d7e35d4aSPaolo Bonzini target_ulong *bufs = args + 1; 441d7e35d4aSPaolo Bonzini target_ulong continue_token = args[7]; 442d7e35d4aSPaolo Bonzini VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); 443fd506b4fSDavid Gibson VIOsPAPRVLANDevice *dev = VIO_SPAPR_VLAN_DEVICE(sdev); 444d7e35d4aSPaolo Bonzini unsigned total_len; 445d7e35d4aSPaolo Bonzini uint8_t *lbuf, *p; 446d7e35d4aSPaolo Bonzini int i, nbufs; 447d7e35d4aSPaolo Bonzini int ret; 448d7e35d4aSPaolo Bonzini 449f6bda9cbSPeter Maydell DPRINTF("H_SEND_LOGICAL_LAN(0x" TARGET_FMT_lx ", <bufs>, 0x" 450d7e35d4aSPaolo Bonzini TARGET_FMT_lx ")\n", reg, continue_token); 451d7e35d4aSPaolo Bonzini 452d7e35d4aSPaolo Bonzini if (!sdev) { 453d7e35d4aSPaolo Bonzini return H_PARAMETER; 454d7e35d4aSPaolo Bonzini } 455d7e35d4aSPaolo Bonzini 456f6bda9cbSPeter Maydell DPRINTF("rxbufs = %d\n", dev->rx_bufs); 457d7e35d4aSPaolo Bonzini 458d7e35d4aSPaolo Bonzini if (!dev->isopen) { 459d7e35d4aSPaolo Bonzini return H_DROPPED; 460d7e35d4aSPaolo Bonzini } 461d7e35d4aSPaolo Bonzini 462d7e35d4aSPaolo Bonzini if (continue_token) { 463d7e35d4aSPaolo Bonzini return H_HARDWARE; /* FIXME actually handle this */ 464d7e35d4aSPaolo Bonzini } 465d7e35d4aSPaolo Bonzini 466d7e35d4aSPaolo Bonzini total_len = 0; 467d7e35d4aSPaolo Bonzini for (i = 0; i < 6; i++) { 468f6bda9cbSPeter Maydell DPRINTF(" buf desc: 0x" TARGET_FMT_lx "\n", bufs[i]); 469d7e35d4aSPaolo Bonzini if (!(bufs[i] & VLAN_BD_VALID)) { 470d7e35d4aSPaolo Bonzini break; 471d7e35d4aSPaolo Bonzini } 472d7e35d4aSPaolo Bonzini total_len += VLAN_BD_LEN(bufs[i]); 473d7e35d4aSPaolo Bonzini } 474d7e35d4aSPaolo Bonzini 475d7e35d4aSPaolo Bonzini nbufs = i; 476f6bda9cbSPeter Maydell DPRINTF("h_send_logical_lan() %d buffers, total length 0x%x\n", 477d7e35d4aSPaolo Bonzini nbufs, total_len); 478d7e35d4aSPaolo Bonzini 479d7e35d4aSPaolo Bonzini if (total_len == 0) { 480d7e35d4aSPaolo Bonzini return H_SUCCESS; 481d7e35d4aSPaolo Bonzini } 482d7e35d4aSPaolo Bonzini 483d7e35d4aSPaolo Bonzini if (total_len > MAX_PACKET_SIZE) { 484d7e35d4aSPaolo Bonzini /* Don't let the guest force too large an allocation */ 485d7e35d4aSPaolo Bonzini return H_RESOURCE; 486d7e35d4aSPaolo Bonzini } 487d7e35d4aSPaolo Bonzini 488d7e35d4aSPaolo Bonzini lbuf = alloca(total_len); 489d7e35d4aSPaolo Bonzini p = lbuf; 490d7e35d4aSPaolo Bonzini for (i = 0; i < nbufs; i++) { 491d7e35d4aSPaolo Bonzini ret = spapr_vio_dma_read(sdev, VLAN_BD_ADDR(bufs[i]), 492d7e35d4aSPaolo Bonzini p, VLAN_BD_LEN(bufs[i])); 493d7e35d4aSPaolo Bonzini if (ret < 0) { 494d7e35d4aSPaolo Bonzini return ret; 495d7e35d4aSPaolo Bonzini } 496d7e35d4aSPaolo Bonzini 497d7e35d4aSPaolo Bonzini p += VLAN_BD_LEN(bufs[i]); 498d7e35d4aSPaolo Bonzini } 499d7e35d4aSPaolo Bonzini 500d7e35d4aSPaolo Bonzini qemu_send_packet(qemu_get_queue(dev->nic), lbuf, total_len); 501d7e35d4aSPaolo Bonzini 502d7e35d4aSPaolo Bonzini return H_SUCCESS; 503d7e35d4aSPaolo Bonzini } 504d7e35d4aSPaolo Bonzini 505d7e35d4aSPaolo Bonzini static target_ulong h_multicast_ctrl(PowerPCCPU *cpu, sPAPREnvironment *spapr, 506d7e35d4aSPaolo Bonzini target_ulong opcode, target_ulong *args) 507d7e35d4aSPaolo Bonzini { 508d7e35d4aSPaolo Bonzini target_ulong reg = args[0]; 509d7e35d4aSPaolo Bonzini VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg); 510d7e35d4aSPaolo Bonzini 511d7e35d4aSPaolo Bonzini if (!dev) { 512d7e35d4aSPaolo Bonzini return H_PARAMETER; 513d7e35d4aSPaolo Bonzini } 514d7e35d4aSPaolo Bonzini 515d7e35d4aSPaolo Bonzini return H_SUCCESS; 516d7e35d4aSPaolo Bonzini } 517d7e35d4aSPaolo Bonzini 518d7e35d4aSPaolo Bonzini static Property spapr_vlan_properties[] = { 519d7e35d4aSPaolo Bonzini DEFINE_SPAPR_PROPERTIES(VIOsPAPRVLANDevice, sdev), 520d7e35d4aSPaolo Bonzini DEFINE_NIC_PROPERTIES(VIOsPAPRVLANDevice, nicconf), 521d7e35d4aSPaolo Bonzini DEFINE_PROP_END_OF_LIST(), 522d7e35d4aSPaolo Bonzini }; 523d7e35d4aSPaolo Bonzini 524686fefe4SDavid Gibson static const VMStateDescription vmstate_spapr_llan = { 525686fefe4SDavid Gibson .name = "spapr_llan", 526686fefe4SDavid Gibson .version_id = 1, 527686fefe4SDavid Gibson .minimum_version_id = 1, 528686fefe4SDavid Gibson .fields = (VMStateField[]) { 529686fefe4SDavid Gibson VMSTATE_SPAPR_VIO(sdev, VIOsPAPRVLANDevice), 530686fefe4SDavid Gibson /* LLAN state */ 531686fefe4SDavid Gibson VMSTATE_BOOL(isopen, VIOsPAPRVLANDevice), 532686fefe4SDavid Gibson VMSTATE_UINTTL(buf_list, VIOsPAPRVLANDevice), 533686fefe4SDavid Gibson VMSTATE_UINT32(add_buf_ptr, VIOsPAPRVLANDevice), 534686fefe4SDavid Gibson VMSTATE_UINT32(use_buf_ptr, VIOsPAPRVLANDevice), 535686fefe4SDavid Gibson VMSTATE_UINT32(rx_bufs, VIOsPAPRVLANDevice), 536686fefe4SDavid Gibson VMSTATE_UINTTL(rxq_ptr, VIOsPAPRVLANDevice), 537686fefe4SDavid Gibson 538686fefe4SDavid Gibson VMSTATE_END_OF_LIST() 539686fefe4SDavid Gibson }, 540686fefe4SDavid Gibson }; 541686fefe4SDavid Gibson 542d7e35d4aSPaolo Bonzini static void spapr_vlan_class_init(ObjectClass *klass, void *data) 543d7e35d4aSPaolo Bonzini { 544d7e35d4aSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(klass); 545d7e35d4aSPaolo Bonzini VIOsPAPRDeviceClass *k = VIO_SPAPR_DEVICE_CLASS(klass); 546d7e35d4aSPaolo Bonzini 547d7e35d4aSPaolo Bonzini k->init = spapr_vlan_init; 548d7e35d4aSPaolo Bonzini k->reset = spapr_vlan_reset; 549d7e35d4aSPaolo Bonzini k->devnode = spapr_vlan_devnode; 550d7e35d4aSPaolo Bonzini k->dt_name = "l-lan"; 551d7e35d4aSPaolo Bonzini k->dt_type = "network"; 552d7e35d4aSPaolo Bonzini k->dt_compatible = "IBM,l-lan"; 553d7e35d4aSPaolo Bonzini k->signal_mask = 0x1; 55429fdedfeSAlexey Kardashevskiy set_bit(DEVICE_CATEGORY_NETWORK, dc->categories); 555d7e35d4aSPaolo Bonzini dc->props = spapr_vlan_properties; 556d7e35d4aSPaolo Bonzini k->rtce_window_size = 0x10000000; 557686fefe4SDavid Gibson dc->vmsd = &vmstate_spapr_llan; 558d7e35d4aSPaolo Bonzini } 559d7e35d4aSPaolo Bonzini 560d7e35d4aSPaolo Bonzini static const TypeInfo spapr_vlan_info = { 561fd506b4fSDavid Gibson .name = TYPE_VIO_SPAPR_VLAN_DEVICE, 562d7e35d4aSPaolo Bonzini .parent = TYPE_VIO_SPAPR_DEVICE, 563d7e35d4aSPaolo Bonzini .instance_size = sizeof(VIOsPAPRVLANDevice), 564d7e35d4aSPaolo Bonzini .class_init = spapr_vlan_class_init, 565*dfe79cf2SGonglei .instance_init = spapr_vlan_instance_init, 566d7e35d4aSPaolo Bonzini }; 567d7e35d4aSPaolo Bonzini 568d7e35d4aSPaolo Bonzini static void spapr_vlan_register_types(void) 569d7e35d4aSPaolo Bonzini { 570d7e35d4aSPaolo Bonzini spapr_register_hypercall(H_REGISTER_LOGICAL_LAN, h_register_logical_lan); 571d7e35d4aSPaolo Bonzini spapr_register_hypercall(H_FREE_LOGICAL_LAN, h_free_logical_lan); 572d7e35d4aSPaolo Bonzini spapr_register_hypercall(H_SEND_LOGICAL_LAN, h_send_logical_lan); 573d7e35d4aSPaolo Bonzini spapr_register_hypercall(H_ADD_LOGICAL_LAN_BUFFER, 574d7e35d4aSPaolo Bonzini h_add_logical_lan_buffer); 575d7e35d4aSPaolo Bonzini spapr_register_hypercall(H_MULTICAST_CTRL, h_multicast_ctrl); 576d7e35d4aSPaolo Bonzini type_register_static(&spapr_vlan_info); 577d7e35d4aSPaolo Bonzini } 578d7e35d4aSPaolo Bonzini 579d7e35d4aSPaolo Bonzini type_init(spapr_vlan_register_types) 580