hw/ide/via.c - qemu - Git at Google

 /*
  * QEMU IDE Emulation: PCI VIA82C686B support.
  *
  * Copyright (c) 2003 Fabrice Bellard
  * Copyright (c) 2006 Openedhand Ltd.
  * Copyright (c) 2010 Huacai Chen <zltjiangshi@gmail.com>
  *
  * 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 "qemu/osdep.h"
 #include "hw/pci/pci.h"
 #include "migration/vmstate.h"
 #include "qemu/module.h"
 #include "qemu/range.h"
 #include "sysemu/dma.h"
 #include "hw/isa/vt82c686.h"
 #include "hw/ide/pci.h"
 #include "hw/irq.h"
 #include "ide-internal.h"
 #include "trace.h"

 static uint64_t bmdma_read(void *opaque, hwaddr addr,
                            unsigned size)
 {
     BMDMAState *bm = opaque;
     uint32_t val;

     if (size != 1) {
         return ((uint64_t)1 << (size * 8)) - 1;
     }

     switch (addr & 3) {
     case 0:
         val = bm->cmd;
         break;
     case 2:
         val = bm->status;
         break;
     default:
         val = 0xff;
         break;
     }

     trace_bmdma_read_via(addr, val);
     return val;
 }

 static void bmdma_write(void *opaque, hwaddr addr,
                         uint64_t val, unsigned size)
 {
     BMDMAState *bm = opaque;

     if (size != 1) {
         return;
     }

     trace_bmdma_write_via(addr, val);
     switch (addr & 3) {
     case 0:
         bmdma_cmd_writeb(bm, val);
         break;
     case 2:
         bmdma_status_writeb(bm, val);
         break;
     default:;
     }
 }

 static const MemoryRegionOps via_bmdma_ops = {
     .read = bmdma_read,
     .write = bmdma_write,
 };

 static void bmdma_setup_bar(PCIIDEState *d)
 {
     int i;

     memory_region_init(&d->bmdma_bar, OBJECT(d), "via-bmdma-container", 16);
     for (i = 0; i < ARRAY_SIZE(d->bmdma); i++) {
         BMDMAState *bm = &d->bmdma[i];

         memory_region_init_io(&bm->extra_io, OBJECT(d), &via_bmdma_ops, bm,
                               "via-bmdma", 4);
         memory_region_add_subregion(&d->bmdma_bar, i * 8, &bm->extra_io);
         memory_region_init_io(&bm->addr_ioport, OBJECT(d),
                               &bmdma_addr_ioport_ops, bm, "bmdma", 4);
         memory_region_add_subregion(&d->bmdma_bar, i * 8 + 4, &bm->addr_ioport);
     }
 }

 static void via_ide_set_irq(void *opaque, int n, int level)
 {
     PCIIDEState *s = opaque;
     PCIDevice *d = PCI_DEVICE(s);

     if (level) {
         d->config[0x70 + n * 8] |= 0x80;
     } else {
         d->config[0x70 + n * 8] &= ~0x80;
     }

     qemu_set_irq(s->isa_irq[n], level);
 }

 static void via_ide_reset(DeviceState *dev)
 {
     PCIIDEState *d = PCI_IDE(dev);
     PCIDevice *pd = PCI_DEVICE(dev);
     uint8_t *pci_conf = pd->config;
     int i;

     for (i = 0; i < ARRAY_SIZE(d->bus); i++) {
         ide_bus_reset(&d->bus[i]);
     }

     pci_config_set_prog_interface(pci_conf, 0x8a); /* legacy mode */
     pci_ide_update_mode(d);

     pci_set_word(pci_conf + PCI_COMMAND, PCI_COMMAND_IO | PCI_COMMAND_WAIT);
     pci_set_word(pci_conf + PCI_STATUS, PCI_STATUS_FAST_BACK |
                  PCI_STATUS_DEVSEL_MEDIUM);

     pci_set_byte(pci_conf + PCI_INTERRUPT_LINE, 0xe);

     /* IDE chip enable, IDE configuration 1/2, IDE FIFO Configuration*/
     pci_set_long(pci_conf + 0x40, 0x0a090600);
     /* IDE misc configuration 1/2/3 */
     pci_set_long(pci_conf + 0x44, 0x00c00068);
     /* IDE Timing control */
     pci_set_long(pci_conf + 0x48, 0xa8a8a8a8);
     /* IDE Address Setup Time */
     pci_set_long(pci_conf + 0x4c, 0x000000ff);
     /* UltraDMA Extended Timing Control*/
     pci_set_long(pci_conf + 0x50, 0x07070707);
     /* UltraDMA FIFO Control */
     pci_set_long(pci_conf + 0x54, 0x00000004);
     /* IDE primary sector size */
     pci_set_long(pci_conf + 0x60, 0x00000200);
     /* IDE secondary sector size */
     pci_set_long(pci_conf + 0x68, 0x00000200);
     /* PCI PM Block */
     pci_set_long(pci_conf + 0xc0, 0x00020001);
 }

 static uint32_t via_ide_cfg_read(PCIDevice *pd, uint32_t addr, int len)
 {
     uint32_t val = pci_default_read_config(pd, addr, len);
     uint8_t mode = pd->config[PCI_CLASS_PROG];

     if ((mode & 0xf) == 0xa) {
         if (ranges_overlap(addr, len, PCI_BASE_ADDRESS_0, 16)) {
             /* BARs 0-3 always read back zero in legacy mode */
             for (int i = addr; i < addr + len; i++) {
                 if (i >= PCI_BASE_ADDRESS_0 && i < PCI_BASE_ADDRESS_0 + 16) {
                     val &= ~(0xffULL << ((i - addr) << 3));
                 }
             }
         }
         if (addr == PCI_BASE_ADDRESS_4 && val == PCI_BASE_ADDRESS_SPACE_IO) {
             /* BAR4 default value if unset */
             val = 0xcc00 | PCI_BASE_ADDRESS_SPACE_IO;
         }
     }

     return val;
 }

 static void via_ide_cfg_write(PCIDevice *pd, uint32_t addr,
                               uint32_t val, int len)
 {
     PCIIDEState *d = PCI_IDE(pd);

     pci_default_write_config(pd, addr, val, len);

     if (range_covers_byte(addr, len, PCI_CLASS_PROG)) {
         pci_ide_update_mode(d);
     }
 }

 static void via_ide_realize(PCIDevice *dev, Error **errp)
 {
     PCIIDEState *d = PCI_IDE(dev);
     DeviceState *ds = DEVICE(dev);
     uint8_t *pci_conf = dev->config;
     int i;

     pci_set_long(pci_conf + PCI_CAPABILITY_LIST, 0x000000c0);
     dev->wmask[PCI_INTERRUPT_LINE] = 0;
     dev->wmask[PCI_CLASS_PROG] = 5;

     memory_region_init_io(&d->data_bar[0], OBJECT(d), &pci_ide_data_le_ops,
                           &d->bus[0], "via-ide0-data", 8);
     pci_register_bar(dev, 0, PCI_BASE_ADDRESS_SPACE_IO, &d->data_bar[0]);

     memory_region_init_io(&d->cmd_bar[0], OBJECT(d), &pci_ide_cmd_le_ops,
                           &d->bus[0], "via-ide0-cmd", 4);
     pci_register_bar(dev, 1, PCI_BASE_ADDRESS_SPACE_IO, &d->cmd_bar[0]);

     memory_region_init_io(&d->data_bar[1], OBJECT(d), &pci_ide_data_le_ops,
                           &d->bus[1], "via-ide1-data", 8);
     pci_register_bar(dev, 2, PCI_BASE_ADDRESS_SPACE_IO, &d->data_bar[1]);

     memory_region_init_io(&d->cmd_bar[1], OBJECT(d), &pci_ide_cmd_le_ops,
                           &d->bus[1], "via-ide1-cmd", 4);
     pci_register_bar(dev, 3, PCI_BASE_ADDRESS_SPACE_IO, &d->cmd_bar[1]);

     bmdma_setup_bar(d);
     pci_register_bar(dev, 4, PCI_BASE_ADDRESS_SPACE_IO, &d->bmdma_bar);

     qdev_init_gpio_in(ds, via_ide_set_irq, ARRAY_SIZE(d->bus));
     for (i = 0; i < ARRAY_SIZE(d->bus); i++) {
         ide_bus_init(&d->bus[i], sizeof(d->bus[i]), ds, i, MAX_IDE_DEVS);
         ide_bus_init_output_irq(&d->bus[i], qdev_get_gpio_in(ds, i));

         bmdma_init(&d->bus[i], &d->bmdma[i], d);
         ide_bus_register_restart_cb(&d->bus[i]);
     }
 }

 static void via_ide_exitfn(PCIDevice *dev)
 {
     PCIIDEState *d = PCI_IDE(dev);
     unsigned i;

     for (i = 0; i < ARRAY_SIZE(d->bmdma); ++i) {
         memory_region_del_subregion(&d->bmdma_bar, &d->bmdma[i].extra_io);
         memory_region_del_subregion(&d->bmdma_bar, &d->bmdma[i].addr_ioport);
     }
 }

 static void via_ide_class_init(ObjectClass *klass, void *data)
 {
     DeviceClass *dc = DEVICE_CLASS(klass);
     PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);

     device_class_set_legacy_reset(dc, via_ide_reset);
     dc->vmsd = &vmstate_ide_pci;
     /* Reason: only works as function of VIA southbridge */
     dc->user_creatable = false;

     k->config_read = via_ide_cfg_read;
     k->config_write = via_ide_cfg_write;
     k->realize = via_ide_realize;
     k->exit = via_ide_exitfn;
     k->vendor_id = PCI_VENDOR_ID_VIA;
     k->device_id = PCI_DEVICE_ID_VIA_IDE;
     k->revision = 0x06;
     k->class_id = PCI_CLASS_STORAGE_IDE;
     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
 }

 static const TypeInfo via_ide_info = {
     .name          = TYPE_VIA_IDE,
     .parent        = TYPE_PCI_IDE,
     .class_init    = via_ide_class_init,
 };

 static void via_ide_register_types(void)
 {
     type_register_static(&via_ide_info);
 }

 type_init(via_ide_register_types)
	/*
	* QEMU IDE Emulation: PCI VIA82C686B support.
	*
	* Copyright (c) 2003 Fabrice Bellard
	* Copyright (c) 2006 Openedhand Ltd.
	* Copyright (c) 2010 Huacai Chen <zltjiangshi@gmail.com>
	*
	* 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 "qemu/osdep.h"
	#include "hw/pci/pci.h"
	#include "migration/vmstate.h"
	#include "qemu/module.h"
	#include "qemu/range.h"
	#include "sysemu/dma.h"
	#include "hw/isa/vt82c686.h"
	#include "hw/ide/pci.h"
	#include "hw/irq.h"
	#include "ide-internal.h"
	#include "trace.h"

	static uint64_t bmdma_read(void *opaque, hwaddr addr,
	unsigned size)
	{
	BMDMAState *bm = opaque;
	uint32_t val;

	if (size != 1) {
	return ((uint64_t)1 << (size * 8)) - 1;
	}

	switch (addr & 3) {
	case 0:
	val = bm->cmd;
	break;
	case 2:
	val = bm->status;
	break;
	default:
	val = 0xff;
	break;
	}

	trace_bmdma_read_via(addr, val);
	return val;
	}

	static void bmdma_write(void *opaque, hwaddr addr,
	uint64_t val, unsigned size)
	{
	BMDMAState *bm = opaque;

	if (size != 1) {
	return;
	}

	trace_bmdma_write_via(addr, val);
	switch (addr & 3) {
	case 0:
	bmdma_cmd_writeb(bm, val);
	break;
	case 2:
	bmdma_status_writeb(bm, val);
	break;
	default:;
	}
	}

	static const MemoryRegionOps via_bmdma_ops = {
	.read = bmdma_read,
	.write = bmdma_write,
	};

	static void bmdma_setup_bar(PCIIDEState *d)
	{
	int i;

	memory_region_init(&d->bmdma_bar, OBJECT(d), "via-bmdma-container", 16);
	for (i = 0; i < ARRAY_SIZE(d->bmdma); i++) {
	BMDMAState *bm = &d->bmdma[i];

	memory_region_init_io(&bm->extra_io, OBJECT(d), &via_bmdma_ops, bm,
	"via-bmdma", 4);
	memory_region_add_subregion(&d->bmdma_bar, i * 8, &bm->extra_io);
	memory_region_init_io(&bm->addr_ioport, OBJECT(d),
	&bmdma_addr_ioport_ops, bm, "bmdma", 4);
	memory_region_add_subregion(&d->bmdma_bar, i * 8 + 4, &bm->addr_ioport);
	}
	}

	static void via_ide_set_irq(void *opaque, int n, int level)
	{
	PCIIDEState *s = opaque;
	PCIDevice *d = PCI_DEVICE(s);

	if (level) {
	d->config[0x70 + n * 8] \|= 0x80;
	} else {
	d->config[0x70 + n * 8] &= ~0x80;
	}

	qemu_set_irq(s->isa_irq[n], level);
	}

	static void via_ide_reset(DeviceState *dev)
	{
	PCIIDEState *d = PCI_IDE(dev);
	PCIDevice *pd = PCI_DEVICE(dev);
	uint8_t *pci_conf = pd->config;
	int i;

	for (i = 0; i < ARRAY_SIZE(d->bus); i++) {
	ide_bus_reset(&d->bus[i]);
	}

	pci_config_set_prog_interface(pci_conf, 0x8a); /* legacy mode */
	pci_ide_update_mode(d);

	pci_set_word(pci_conf + PCI_COMMAND, PCI_COMMAND_IO \| PCI_COMMAND_WAIT);
	pci_set_word(pci_conf + PCI_STATUS, PCI_STATUS_FAST_BACK \|
	PCI_STATUS_DEVSEL_MEDIUM);

	pci_set_byte(pci_conf + PCI_INTERRUPT_LINE, 0xe);

	/* IDE chip enable, IDE configuration 1/2, IDE FIFO Configuration*/
	pci_set_long(pci_conf + 0x40, 0x0a090600);
	/* IDE misc configuration 1/2/3 */
	pci_set_long(pci_conf + 0x44, 0x00c00068);
	/* IDE Timing control */
	pci_set_long(pci_conf + 0x48, 0xa8a8a8a8);
	/* IDE Address Setup Time */
	pci_set_long(pci_conf + 0x4c, 0x000000ff);
	/* UltraDMA Extended Timing Control*/
	pci_set_long(pci_conf + 0x50, 0x07070707);
	/* UltraDMA FIFO Control */
	pci_set_long(pci_conf + 0x54, 0x00000004);
	/* IDE primary sector size */
	pci_set_long(pci_conf + 0x60, 0x00000200);
	/* IDE secondary sector size */
	pci_set_long(pci_conf + 0x68, 0x00000200);
	/* PCI PM Block */
	pci_set_long(pci_conf + 0xc0, 0x00020001);
	}

	static uint32_t via_ide_cfg_read(PCIDevice *pd, uint32_t addr, int len)
	{
	uint32_t val = pci_default_read_config(pd, addr, len);
	uint8_t mode = pd->config[PCI_CLASS_PROG];

	if ((mode & 0xf) == 0xa) {
	if (ranges_overlap(addr, len, PCI_BASE_ADDRESS_0, 16)) {
	/* BARs 0-3 always read back zero in legacy mode */
	for (int i = addr; i < addr + len; i++) {
	if (i >= PCI_BASE_ADDRESS_0 && i < PCI_BASE_ADDRESS_0 + 16) {
	val &= ~(0xffULL << ((i - addr) << 3));
	}
	}
	}
	if (addr == PCI_BASE_ADDRESS_4 && val == PCI_BASE_ADDRESS_SPACE_IO) {
	/* BAR4 default value if unset */
	val = 0xcc00 \| PCI_BASE_ADDRESS_SPACE_IO;
	}
	}

	return val;
	}

	static void via_ide_cfg_write(PCIDevice *pd, uint32_t addr,
	uint32_t val, int len)
	{
	PCIIDEState *d = PCI_IDE(pd);

	pci_default_write_config(pd, addr, val, len);

	if (range_covers_byte(addr, len, PCI_CLASS_PROG)) {
	pci_ide_update_mode(d);
	}
	}

	static void via_ide_realize(PCIDevice dev, Error *errp)
	{
	PCIIDEState *d = PCI_IDE(dev);
	DeviceState *ds = DEVICE(dev);
	uint8_t *pci_conf = dev->config;
	int i;

	pci_set_long(pci_conf + PCI_CAPABILITY_LIST, 0x000000c0);
	dev->wmask[PCI_INTERRUPT_LINE] = 0;
	dev->wmask[PCI_CLASS_PROG] = 5;

	memory_region_init_io(&d->data_bar[0], OBJECT(d), &pci_ide_data_le_ops,
	&d->bus[0], "via-ide0-data", 8);
	pci_register_bar(dev, 0, PCI_BASE_ADDRESS_SPACE_IO, &d->data_bar[0]);

	memory_region_init_io(&d->cmd_bar[0], OBJECT(d), &pci_ide_cmd_le_ops,
	&d->bus[0], "via-ide0-cmd", 4);
	pci_register_bar(dev, 1, PCI_BASE_ADDRESS_SPACE_IO, &d->cmd_bar[0]);

	memory_region_init_io(&d->data_bar[1], OBJECT(d), &pci_ide_data_le_ops,
	&d->bus[1], "via-ide1-data", 8);
	pci_register_bar(dev, 2, PCI_BASE_ADDRESS_SPACE_IO, &d->data_bar[1]);

	memory_region_init_io(&d->cmd_bar[1], OBJECT(d), &pci_ide_cmd_le_ops,
	&d->bus[1], "via-ide1-cmd", 4);
	pci_register_bar(dev, 3, PCI_BASE_ADDRESS_SPACE_IO, &d->cmd_bar[1]);

	bmdma_setup_bar(d);
	pci_register_bar(dev, 4, PCI_BASE_ADDRESS_SPACE_IO, &d->bmdma_bar);

	qdev_init_gpio_in(ds, via_ide_set_irq, ARRAY_SIZE(d->bus));
	for (i = 0; i < ARRAY_SIZE(d->bus); i++) {
	ide_bus_init(&d->bus[i], sizeof(d->bus[i]), ds, i, MAX_IDE_DEVS);
	ide_bus_init_output_irq(&d->bus[i], qdev_get_gpio_in(ds, i));

	bmdma_init(&d->bus[i], &d->bmdma[i], d);
	ide_bus_register_restart_cb(&d->bus[i]);
	}
	}

	static void via_ide_exitfn(PCIDevice *dev)
	{
	PCIIDEState *d = PCI_IDE(dev);
	unsigned i;

	for (i = 0; i < ARRAY_SIZE(d->bmdma); ++i) {
	memory_region_del_subregion(&d->bmdma_bar, &d->bmdma[i].extra_io);
	memory_region_del_subregion(&d->bmdma_bar, &d->bmdma[i].addr_ioport);
	}
	}

	static void via_ide_class_init(ObjectClass klass, void data)
	{
	DeviceClass *dc = DEVICE_CLASS(klass);
	PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);

	device_class_set_legacy_reset(dc, via_ide_reset);
	dc->vmsd = &vmstate_ide_pci;
	/* Reason: only works as function of VIA southbridge */
	dc->user_creatable = false;

	k->config_read = via_ide_cfg_read;
	k->config_write = via_ide_cfg_write;
	k->realize = via_ide_realize;
	k->exit = via_ide_exitfn;
	k->vendor_id = PCI_VENDOR_ID_VIA;
	k->device_id = PCI_DEVICE_ID_VIA_IDE;
	k->revision = 0x06;
	k->class_id = PCI_CLASS_STORAGE_IDE;
	set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
	}

	static const TypeInfo via_ide_info = {
	.name = TYPE_VIA_IDE,
	.parent = TYPE_PCI_IDE,
	.class_init = via_ide_class_init,
	};

	static void via_ide_register_types(void)
	{
	type_register_static(&via_ide_info);
	}

	type_init(via_ide_register_types)