[mirror_qemu.git] / hw / spapr_llan.c

/*
 * QEMU PowerPC pSeries Logical Partition (aka sPAPR) hardware System Emulator
 *
 * PAPR Inter-VM Logical Lan, aka ibmveth
 *
 * Copyright (c) 2010,2011 David Gibson, IBM Corporation.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 *
 */
#include "hw.h"
#include "net/net.h"
#include "hw/qdev.h"
#include "hw/spapr.h"
#include "hw/spapr_vio.h"

#include <libfdt.h>

#define ETH_ALEN        6
#define MAX_PACKET_SIZE 65536

/*#define DEBUG*/

#ifdef DEBUG
#define dprintf(fmt...) do { fprintf(stderr, fmt); } while (0)
#else
#define dprintf(fmt...)
#endif

/*
 * Virtual LAN device
 */

typedef uint64_t vlan_bd_t;

#define VLAN_BD_VALID        0x8000000000000000ULL
#define VLAN_BD_TOGGLE       0x4000000000000000ULL
#define VLAN_BD_NO_CSUM      0x0200000000000000ULL
#define VLAN_BD_CSUM_GOOD    0x0100000000000000ULL
#define VLAN_BD_LEN_MASK     0x00ffffff00000000ULL
#define VLAN_BD_LEN(bd)      (((bd) & VLAN_BD_LEN_MASK) >> 32)
#define VLAN_BD_ADDR_MASK    0x00000000ffffffffULL
#define VLAN_BD_ADDR(bd)     ((bd) & VLAN_BD_ADDR_MASK)

#define VLAN_VALID_BD(addr, len) (VLAN_BD_VALID | \
                                  (((len) << 32) & VLAN_BD_LEN_MASK) |  \
                                  (addr & VLAN_BD_ADDR_MASK))

#define VLAN_RXQC_TOGGLE     0x80
#define VLAN_RXQC_VALID      0x40
#define VLAN_RXQC_NO_CSUM    0x02
#define VLAN_RXQC_CSUM_GOOD  0x01

#define VLAN_RQ_ALIGNMENT    16
#define VLAN_RXQ_BD_OFF      0
#define VLAN_FILTER_BD_OFF   8
#define VLAN_RX_BDS_OFF      16
#define VLAN_MAX_BUFS        ((SPAPR_TCE_PAGE_SIZE - VLAN_RX_BDS_OFF) / 8)

typedef struct VIOsPAPRVLANDevice {
    VIOsPAPRDevice sdev;
    NICConf nicconf;
    NICState *nic;
    int isopen;
    target_ulong buf_list;
    int add_buf_ptr, use_buf_ptr, rx_bufs;
    target_ulong rxq_ptr;
} VIOsPAPRVLANDevice;

static int spapr_vlan_can_receive(NetClientState *nc)
{
    VIOsPAPRVLANDevice *dev = DO_UPCAST(NICState, nc, nc)->opaque;

    return (dev->isopen && dev->rx_bufs > 0);
}

static ssize_t spapr_vlan_receive(NetClientState *nc, const uint8_t *buf,
                                  size_t size)
{
    VIOsPAPRDevice *sdev = DO_UPCAST(NICState, nc, nc)->opaque;
    VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev;
    vlan_bd_t rxq_bd = vio_ldq(sdev, dev->buf_list + VLAN_RXQ_BD_OFF);
    vlan_bd_t bd;
    int buf_ptr = dev->use_buf_ptr;
    uint64_t handle;
    uint8_t control;

    dprintf("spapr_vlan_receive() [%s] rx_bufs=%d\n", sdev->qdev.id,
            dev->rx_bufs);

    if (!dev->isopen) {
        return -1;
    }

    if (!dev->rx_bufs) {
        return -1;
    }

    do {
        buf_ptr += 8;
        if (buf_ptr >= SPAPR_TCE_PAGE_SIZE) {
            buf_ptr = VLAN_RX_BDS_OFF;
        }

        bd = vio_ldq(sdev, dev->buf_list + buf_ptr);
        dprintf("use_buf_ptr=%d bd=0x%016llx\n",
                buf_ptr, (unsigned long long)bd);
    } while ((!(bd & VLAN_BD_VALID) || (VLAN_BD_LEN(bd) < (size + 8)))
             && (buf_ptr != dev->use_buf_ptr));

    if (!(bd & VLAN_BD_VALID) || (VLAN_BD_LEN(bd) < (size + 8))) {
        /* Failed to find a suitable buffer */
        return -1;
    }

    /* Remove the buffer from the pool */
    dev->rx_bufs--;
    dev->use_buf_ptr = buf_ptr;
    vio_stq(sdev, dev->buf_list + dev->use_buf_ptr, 0);

    dprintf("Found buffer: ptr=%d num=%d\n", dev->use_buf_ptr, dev->rx_bufs);

    /* Transfer the packet data */
    if (spapr_vio_dma_write(sdev, VLAN_BD_ADDR(bd) + 8, buf, size) < 0) {
        return -1;
    }

    dprintf("spapr_vlan_receive: DMA write completed\n");

    /* Update the receive queue */
    control = VLAN_RXQC_TOGGLE | VLAN_RXQC_VALID;
    if (rxq_bd & VLAN_BD_TOGGLE) {
        control ^= VLAN_RXQC_TOGGLE;
    }

    handle = vio_ldq(sdev, VLAN_BD_ADDR(bd));
    vio_stq(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 8, handle);
    vio_stl(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 4, size);
    vio_sth(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 2, 8);
    vio_stb(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr, control);

    dprintf("wrote rxq entry (ptr=0x%llx): 0x%016llx 0x%016llx\n",
            (unsigned long long)dev->rxq_ptr,
            (unsigned long long)vio_ldq(sdev, VLAN_BD_ADDR(rxq_bd) +
                                        dev->rxq_ptr),
            (unsigned long long)vio_ldq(sdev, VLAN_BD_ADDR(rxq_bd) +
                                        dev->rxq_ptr + 8));

    dev->rxq_ptr += 16;
    if (dev->rxq_ptr >= VLAN_BD_LEN(rxq_bd)) {
        dev->rxq_ptr = 0;
        vio_stq(sdev, dev->buf_list + VLAN_RXQ_BD_OFF, rxq_bd ^ VLAN_BD_TOGGLE);
    }

    if (sdev->signal_state & 1) {
        qemu_irq_pulse(spapr_vio_qirq(sdev));
    }

    return size;
}

static NetClientInfo net_spapr_vlan_info = {
    .type = NET_CLIENT_OPTIONS_KIND_NIC,
    .size = sizeof(NICState),
    .can_receive = spapr_vlan_can_receive,
    .receive = spapr_vlan_receive,
};

static void spapr_vlan_reset(VIOsPAPRDevice *sdev)
{
    VIOsPAPRVLANDevice *dev = DO_UPCAST(VIOsPAPRVLANDevice, sdev, sdev);

    dev->buf_list = 0;
    dev->rx_bufs = 0;
    dev->isopen = 0;
}

static int spapr_vlan_init(VIOsPAPRDevice *sdev)
{
    VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev;

    qemu_macaddr_default_if_unset(&dev->nicconf.macaddr);

    dev->nic = qemu_new_nic(&net_spapr_vlan_info, &dev->nicconf,
                            object_get_typename(OBJECT(sdev)), sdev->qdev.id, dev);
    qemu_format_nic_info_str(&dev->nic->nc, dev->nicconf.macaddr.a);

    return 0;
}

void spapr_vlan_create(VIOsPAPRBus *bus, NICInfo *nd)
{
    DeviceState *dev;

    dev = qdev_create(&bus->bus, "spapr-vlan");

    qdev_set_nic_properties(dev, nd);

    qdev_init_nofail(dev);
}

static int spapr_vlan_devnode(VIOsPAPRDevice *dev, void *fdt, int node_off)
{
    VIOsPAPRVLANDevice *vdev = (VIOsPAPRVLANDevice *)dev;
    uint8_t padded_mac[8] = {0, 0};
    int ret;

    /* Some old phyp versions give the mac address in an 8-byte
     * property.  The kernel driver has an insane workaround for this;
     * rather than doing the obvious thing and checking the property
     * length, it checks whether the first byte has 0b10 in the low
     * bits.  If a correct 6-byte property has a different first byte
     * the kernel will get the wrong mac address, overrunning its
     * buffer in the process (read only, thank goodness).
     *
     * Here we workaround the kernel workaround by always supplying an
     * 8-byte property, with the mac address in the last six bytes */
    memcpy(&padded_mac[2], &vdev->nicconf.macaddr, ETH_ALEN);
    ret = fdt_setprop(fdt, node_off, "local-mac-address",
                      padded_mac, sizeof(padded_mac));
    if (ret < 0) {
        return ret;
    }

    ret = fdt_setprop_cell(fdt, node_off, "ibm,mac-address-filters", 0);
    if (ret < 0) {
        return ret;
    }

    return 0;
}

static int check_bd(VIOsPAPRVLANDevice *dev, vlan_bd_t bd,
                    target_ulong alignment)
{
    if ((VLAN_BD_ADDR(bd) % alignment)
        || (VLAN_BD_LEN(bd) % alignment)) {
        return -1;
    }

    if (!spapr_vio_dma_valid(&dev->sdev, VLAN_BD_ADDR(bd),
                             VLAN_BD_LEN(bd), DMA_DIRECTION_FROM_DEVICE)
        || !spapr_vio_dma_valid(&dev->sdev, VLAN_BD_ADDR(bd),
                                VLAN_BD_LEN(bd), DMA_DIRECTION_TO_DEVICE)) {
        return -1;
    }

    return 0;
}

static target_ulong h_register_logical_lan(PowerPCCPU *cpu,
                                           sPAPREnvironment *spapr,
                                           target_ulong opcode,
                                           target_ulong *args)
{
    target_ulong reg = args[0];
    target_ulong buf_list = args[1];
    target_ulong rec_queue = args[2];
    target_ulong filter_list = args[3];
    VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
    VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev;
    vlan_bd_t filter_list_bd;

    if (!dev) {
        return H_PARAMETER;
    }

    if (dev->isopen) {
        hcall_dprintf("H_REGISTER_LOGICAL_LAN called twice without "
                      "H_FREE_LOGICAL_LAN\n");
        return H_RESOURCE;
    }

    if (check_bd(dev, VLAN_VALID_BD(buf_list, SPAPR_TCE_PAGE_SIZE),
                 SPAPR_TCE_PAGE_SIZE) < 0) {
        hcall_dprintf("Bad buf_list 0x" TARGET_FMT_lx "\n", buf_list);
        return H_PARAMETER;
    }

    filter_list_bd = VLAN_VALID_BD(filter_list, SPAPR_TCE_PAGE_SIZE);
    if (check_bd(dev, filter_list_bd, SPAPR_TCE_PAGE_SIZE) < 0) {
        hcall_dprintf("Bad filter_list 0x" TARGET_FMT_lx "\n", filter_list);
        return H_PARAMETER;
    }

    if (!(rec_queue & VLAN_BD_VALID)
        || (check_bd(dev, rec_queue, VLAN_RQ_ALIGNMENT) < 0)) {
        hcall_dprintf("Bad receive queue\n");
        return H_PARAMETER;
    }

    dev->buf_list = buf_list;
    sdev->signal_state = 0;

    rec_queue &= ~VLAN_BD_TOGGLE;

    /* Initialize the buffer list */
    vio_stq(sdev, buf_list, rec_queue);
    vio_stq(sdev, buf_list + 8, filter_list_bd);
    spapr_vio_dma_set(sdev, buf_list + VLAN_RX_BDS_OFF, 0,
                      SPAPR_TCE_PAGE_SIZE - VLAN_RX_BDS_OFF);
    dev->add_buf_ptr = VLAN_RX_BDS_OFF - 8;
    dev->use_buf_ptr = VLAN_RX_BDS_OFF - 8;
    dev->rx_bufs = 0;
    dev->rxq_ptr = 0;

    /* Initialize the receive queue */
    spapr_vio_dma_set(sdev, VLAN_BD_ADDR(rec_queue), 0, VLAN_BD_LEN(rec_queue));

    dev->isopen = 1;
    return H_SUCCESS;
}


static target_ulong h_free_logical_lan(PowerPCCPU *cpu, sPAPREnvironment *spapr,
                                       target_ulong opcode, target_ulong *args)
{
    target_ulong reg = args[0];
    VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
    VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev;

    if (!dev) {
        return H_PARAMETER;
    }

    if (!dev->isopen) {
        hcall_dprintf("H_FREE_LOGICAL_LAN called without "
                      "H_REGISTER_LOGICAL_LAN\n");
        return H_RESOURCE;
    }

    spapr_vlan_reset(sdev);
    return H_SUCCESS;
}

static target_ulong h_add_logical_lan_buffer(PowerPCCPU *cpu,
                                             sPAPREnvironment *spapr,
                                             target_ulong opcode,
                                             target_ulong *args)
{
    target_ulong reg = args[0];
    target_ulong buf = args[1];
    VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
    VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev;
    vlan_bd_t bd;

    dprintf("H_ADD_LOGICAL_LAN_BUFFER(0x" TARGET_FMT_lx
            ", 0x" TARGET_FMT_lx ")\n", reg, buf);

    if (!sdev) {
        hcall_dprintf("Bad device\n");
        return H_PARAMETER;
    }

    if ((check_bd(dev, buf, 4) < 0)
        || (VLAN_BD_LEN(buf) < 16)) {
        hcall_dprintf("Bad buffer enqueued\n");
        return H_PARAMETER;
    }

    if (!dev->isopen || dev->rx_bufs >= VLAN_MAX_BUFS) {
        return H_RESOURCE;
    }

    do {
        dev->add_buf_ptr += 8;
        if (dev->add_buf_ptr >= SPAPR_TCE_PAGE_SIZE) {
            dev->add_buf_ptr = VLAN_RX_BDS_OFF;
        }

        bd = vio_ldq(sdev, dev->buf_list + dev->add_buf_ptr);
    } while (bd & VLAN_BD_VALID);

    vio_stq(sdev, dev->buf_list + dev->add_buf_ptr, buf);

    dev->rx_bufs++;

    dprintf("h_add_logical_lan_buffer():  Added buf  ptr=%d  rx_bufs=%d"
            " bd=0x%016llx\n", dev->add_buf_ptr, dev->rx_bufs,
            (unsigned long long)buf);

    return H_SUCCESS;
}

static target_ulong h_send_logical_lan(PowerPCCPU *cpu, sPAPREnvironment *spapr,
                                       target_ulong opcode, target_ulong *args)
{
    target_ulong reg = args[0];
    target_ulong *bufs = args + 1;
    target_ulong continue_token = args[7];
    VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg);
    VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev;
    unsigned total_len;
    uint8_t *lbuf, *p;
    int i, nbufs;
    int ret;

    dprintf("H_SEND_LOGICAL_LAN(0x" TARGET_FMT_lx ", <bufs>, 0x"
            TARGET_FMT_lx ")\n", reg, continue_token);

    if (!sdev) {
        return H_PARAMETER;
    }

    dprintf("rxbufs = %d\n", dev->rx_bufs);

    if (!dev->isopen) {
        return H_DROPPED;
    }

    if (continue_token) {
        return H_HARDWARE; /* FIXME actually handle this */
    }

    total_len = 0;
    for (i = 0; i < 6; i++) {
        dprintf("   buf desc: 0x" TARGET_FMT_lx "\n", bufs[i]);
        if (!(bufs[i] & VLAN_BD_VALID)) {
            break;
        }
        total_len += VLAN_BD_LEN(bufs[i]);
    }

    nbufs = i;
    dprintf("h_send_logical_lan() %d buffers, total length 0x%x\n",
            nbufs, total_len);

    if (total_len == 0) {
        return H_SUCCESS;
    }

    if (total_len > MAX_PACKET_SIZE) {
        /* Don't let the guest force too large an allocation */
        return H_RESOURCE;
    }

    lbuf = alloca(total_len);
    p = lbuf;
    for (i = 0; i < nbufs; i++) {
        ret = spapr_vio_dma_read(sdev, VLAN_BD_ADDR(bufs[i]),
                                 p, VLAN_BD_LEN(bufs[i]));
        if (ret < 0) {
            return ret;
        }

        p += VLAN_BD_LEN(bufs[i]);
    }

    qemu_send_packet(&dev->nic->nc, lbuf, total_len);

    return H_SUCCESS;
}

static target_ulong h_multicast_ctrl(PowerPCCPU *cpu, sPAPREnvironment *spapr,
                                     target_ulong opcode, target_ulong *args)
{
    target_ulong reg = args[0];
    VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg);

    if (!dev) {
        return H_PARAMETER;
    }

    return H_SUCCESS;
}

static Property spapr_vlan_properties[] = {
    DEFINE_SPAPR_PROPERTIES(VIOsPAPRVLANDevice, sdev),
    DEFINE_NIC_PROPERTIES(VIOsPAPRVLANDevice, nicconf),
    DEFINE_PROP_END_OF_LIST(),
};

static void spapr_vlan_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    VIOsPAPRDeviceClass *k = VIO_SPAPR_DEVICE_CLASS(klass);

    k->init = spapr_vlan_init;
    k->reset = spapr_vlan_reset;
    k->devnode = spapr_vlan_devnode;
    k->dt_name = "l-lan";
    k->dt_type = "network";
    k->dt_compatible = "IBM,l-lan";
    k->signal_mask = 0x1;
    dc->props = spapr_vlan_properties;
    k->rtce_window_size = 0x10000000;
}

static TypeInfo spapr_vlan_info = {
    .name          = "spapr-vlan",
    .parent        = TYPE_VIO_SPAPR_DEVICE,
    .instance_size = sizeof(VIOsPAPRVLANDevice),
    .class_init    = spapr_vlan_class_init,
};

static void spapr_vlan_register_types(void)
{
    spapr_register_hypercall(H_REGISTER_LOGICAL_LAN, h_register_logical_lan);
    spapr_register_hypercall(H_FREE_LOGICAL_LAN, h_free_logical_lan);
    spapr_register_hypercall(H_SEND_LOGICAL_LAN, h_send_logical_lan);
    spapr_register_hypercall(H_ADD_LOGICAL_LAN_BUFFER,
                             h_add_logical_lan_buffer);
    spapr_register_hypercall(H_MULTICAST_CTRL, h_multicast_ctrl);
    type_register_static(&spapr_vlan_info);
}

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