Archipelago » qemu

/*

 * QEMU USB EHCI Emulation

 *

 * This library is free software; you can redistribute it and/or

 * modify it under the terms of the GNU Lesser General Public

 * License as published by the Free Software Foundation; either

 * version 2 of the License, or(at your option) any later version.

 *

 * This library is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU

 * Lesser General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, see <http://www.gnu.org/licenses/>.

 */

#include "hw/usb/hcd-ehci.h"

#include "qemu/range.h"

typedef struct EHCIPCIInfo {

    const char *name;

    uint16_t vendor_id;

    uint16_t device_id;

    uint8_t  revision;

} EHCIPCIInfo;

static int usb_ehci_pci_initfn(PCIDevice *dev)

{

    EHCIPCIState *i = PCI_EHCI(dev);

    EHCIState *s = &i->ehci;

    uint8_t *pci_conf = dev->config;

    pci_set_byte(&pci_conf[PCI_CLASS_PROG], 0x20);

    /* capabilities pointer */

    pci_set_byte(&pci_conf[PCI_CAPABILITY_LIST], 0x00);

    /* pci_set_byte(&pci_conf[PCI_CAPABILITY_LIST], 0x50); */

    pci_set_byte(&pci_conf[PCI_INTERRUPT_PIN], 4); /* interrupt pin D */

    pci_set_byte(&pci_conf[PCI_MIN_GNT], 0);

    pci_set_byte(&pci_conf[PCI_MAX_LAT], 0);

    /* pci_conf[0x50] = 0x01; *//* power management caps */

    pci_set_byte(&pci_conf[USB_SBRN], USB_RELEASE_2); /* release # (2.1.4) */

    pci_set_byte(&pci_conf[0x61], 0x20);  /* frame length adjustment (2.1.5) */

    pci_set_word(&pci_conf[0x62], 0x00);  /* port wake up capability (2.1.6) */

    pci_conf[0x64] = 0x00;

    pci_conf[0x65] = 0x00;

    pci_conf[0x66] = 0x00;

    pci_conf[0x67] = 0x00;

    pci_conf[0x68] = 0x01;

    pci_conf[0x69] = 0x00;

    pci_conf[0x6a] = 0x00;

    pci_conf[0x6b] = 0x00;  /* USBLEGSUP */

    pci_conf[0x6c] = 0x00;

    pci_conf[0x6d] = 0x00;

    pci_conf[0x6e] = 0x00;

    pci_conf[0x6f] = 0xc0;  /* USBLEFCTLSTS */

    s->caps[0x09] = 0x68;        /* EECP */

    s->irq = dev->irq[3];

    s->as = pci_get_address_space(dev);

    s->capsbase = 0x00;

    s->opregbase = 0x20;

    usb_ehci_initfn(s, DEVICE(dev));

    pci_register_bar(dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY, &s->mem);

    return 0;

}

static void usb_ehci_pci_write_config(PCIDevice *dev, uint32_t addr,

                                      uint32_t val, int l)

{

    EHCIPCIState *i = PCI_EHCI(dev);

    bool busmaster;

    pci_default_write_config(dev, addr, val, l);

    if (!range_covers_byte(addr, l, PCI_COMMAND)) {

        return;

    }

    busmaster = pci_get_word(dev->config + PCI_COMMAND) & PCI_COMMAND_MASTER;

    i->ehci.as = busmaster ? pci_get_address_space(dev) : &address_space_memory;

}

static Property ehci_pci_properties[] = {

    DEFINE_PROP_UINT32("maxframes", EHCIPCIState, ehci.maxframes, 128),

    DEFINE_PROP_END_OF_LIST(),

};

static const VMStateDescription vmstate_ehci_pci = {

    .name        = "ehci",

    .version_id  = 2,

    .minimum_version_id  = 1,

    .fields      = (VMStateField[]) {

        VMSTATE_PCI_DEVICE(pcidev, EHCIPCIState),

        VMSTATE_STRUCT(ehci, EHCIPCIState, 2, vmstate_ehci, EHCIState),

        VMSTATE_END_OF_LIST()

    }

};

static void ehci_class_init(ObjectClass *klass, void *data)

{

    DeviceClass *dc = DEVICE_CLASS(klass);

    PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);

    k->init = usb_ehci_pci_initfn;

    k->class_id = PCI_CLASS_SERIAL_USB;

    k->config_write = usb_ehci_pci_write_config;

    k->no_hotplug = 1;

    dc->vmsd = &vmstate_ehci_pci;

    dc->props = ehci_pci_properties;

}

static const TypeInfo ehci_pci_type_info = {

    .name = TYPE_PCI_EHCI,

    .parent = TYPE_PCI_DEVICE,

    .instance_size = sizeof(EHCIPCIState),

    .abstract = true,

    .class_init = ehci_class_init,

};

static void ehci_data_class_init(ObjectClass *klass, void *data)

{

    PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);

    EHCIPCIInfo *i = data;

    k->vendor_id = i->vendor_id;

    k->device_id = i->device_id;

    k->revision = i->revision;

}

static struct EHCIPCIInfo ehci_pci_info[] = {

    {

        .name      = "usb-ehci",

        .vendor_id = PCI_VENDOR_ID_INTEL,

        .device_id = PCI_DEVICE_ID_INTEL_82801D, /* ich4 */

        .revision  = 0x10,

    },{

        .name      = "ich9-usb-ehci1", /* 00:1d.7 */

        .vendor_id = PCI_VENDOR_ID_INTEL,

        .device_id = PCI_DEVICE_ID_INTEL_82801I_EHCI1,

        .revision  = 0x03,

    },{

        .name      = "ich9-usb-ehci2", /* 00:1a.7 */

        .vendor_id = PCI_VENDOR_ID_INTEL,

        .device_id = PCI_DEVICE_ID_INTEL_82801I_EHCI2,

        .revision  = 0x03,

    }

};

static void ehci_pci_register_types(void)

{

    TypeInfo ehci_type_info = {

        .parent        = TYPE_PCI_EHCI,

        .class_init    = ehci_data_class_init,

    };

    int i;

    type_register_static(&ehci_pci_type_info);

    for (i = 0; i < ARRAY_SIZE(ehci_pci_info); i++) {

        ehci_type_info.name = ehci_pci_info[i].name;

        ehci_type_info.class_data = ehci_pci_info + i;

        type_register(&ehci_type_info);

    }

}

type_init(ehci_pci_register_types)

struct ehci_companions {

    const char *name;

    int func;

    int port;

};

static const struct ehci_companions ich9_1d[] = {

    { .name = "ich9-usb-uhci1", .func = 0, .port = 0 },

    { .name = "ich9-usb-uhci2", .func = 1, .port = 2 },

    { .name = "ich9-usb-uhci3", .func = 2, .port = 4 },

};

static const struct ehci_companions ich9_1a[] = {

    { .name = "ich9-usb-uhci4", .func = 0, .port = 0 },

    { .name = "ich9-usb-uhci5", .func = 1, .port = 2 },

    { .name = "ich9-usb-uhci6", .func = 2, .port = 4 },

};

int ehci_create_ich9_with_companions(PCIBus *bus, int slot)

{

    const struct ehci_companions *comp;

    PCIDevice *ehci, *uhci;

    BusState *usbbus;

    const char *name;

    int i;

    switch (slot) {

    case 0x1d:

        name = "ich9-usb-ehci1";

        comp = ich9_1d;

        break;

    case 0x1a:

        name = "ich9-usb-ehci2";

        comp = ich9_1a;

        break;

    default:

        return -1;

    }

    ehci = pci_create_multifunction(bus, PCI_DEVFN(slot, 7), true, name);

    qdev_init_nofail(&ehci->qdev);

    usbbus = QLIST_FIRST(&ehci->qdev.child_bus);

    for (i = 0; i < 3; i++) {

        uhci = pci_create_multifunction(bus, PCI_DEVFN(slot, comp[i].func),

                                        true, comp[i].name);

        qdev_prop_set_string(&uhci->qdev, "masterbus", usbbus->name);

        qdev_prop_set_uint32(&uhci->qdev, "firstport", comp[i].port);

        qdev_init_nofail(&uhci->qdev);

    }

    return 0;

}