| /* |
| * Virtio Support |
| * |
| * Copyright IBM, Corp. 2007 |
| * |
| * Authors: |
| * Anthony Liguori <aliguori@us.ibm.com> |
| * |
| * SPDX-License-Identifier: GPL-2.0-or-later |
| */ |
| |
| #include "qemu/osdep.h" |
| #include "hw/virtio/virtio.h" |
| #include "cpu.h" |
| |
| uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint8_t val; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return (uint32_t)-1; |
| } |
| |
| k->get_config(vdev, vdev->config); |
| |
| val = ldub_p(vdev->config + addr); |
| return val; |
| } |
| |
| uint32_t virtio_config_readw(VirtIODevice *vdev, uint32_t addr) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint16_t val; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return (uint32_t)-1; |
| } |
| |
| k->get_config(vdev, vdev->config); |
| |
| val = lduw_p(vdev->config + addr); |
| return val; |
| } |
| |
| uint32_t virtio_config_readl(VirtIODevice *vdev, uint32_t addr) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint32_t val; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return (uint32_t)-1; |
| } |
| |
| k->get_config(vdev, vdev->config); |
| |
| val = ldl_p(vdev->config + addr); |
| return val; |
| } |
| |
| void virtio_config_writeb(VirtIODevice *vdev, uint32_t addr, uint32_t data) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint8_t val = data; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return; |
| } |
| |
| stb_p(vdev->config + addr, val); |
| |
| if (k->set_config) { |
| k->set_config(vdev, vdev->config); |
| } |
| } |
| |
| void virtio_config_writew(VirtIODevice *vdev, uint32_t addr, uint32_t data) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint16_t val = data; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return; |
| } |
| |
| stw_p(vdev->config + addr, val); |
| |
| if (k->set_config) { |
| k->set_config(vdev, vdev->config); |
| } |
| } |
| |
| void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint32_t val = data; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return; |
| } |
| |
| stl_p(vdev->config + addr, val); |
| |
| if (k->set_config) { |
| k->set_config(vdev, vdev->config); |
| } |
| } |
| |
| uint32_t virtio_config_modern_readb(VirtIODevice *vdev, uint32_t addr) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint8_t val; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return (uint32_t)-1; |
| } |
| |
| k->get_config(vdev, vdev->config); |
| |
| val = ldub_p(vdev->config + addr); |
| return val; |
| } |
| |
| uint32_t virtio_config_modern_readw(VirtIODevice *vdev, uint32_t addr) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint16_t val; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return (uint32_t)-1; |
| } |
| |
| k->get_config(vdev, vdev->config); |
| |
| val = lduw_le_p(vdev->config + addr); |
| return val; |
| } |
| |
| uint32_t virtio_config_modern_readl(VirtIODevice *vdev, uint32_t addr) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint32_t val; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return (uint32_t)-1; |
| } |
| |
| k->get_config(vdev, vdev->config); |
| |
| val = ldl_le_p(vdev->config + addr); |
| return val; |
| } |
| |
| void virtio_config_modern_writeb(VirtIODevice *vdev, |
| uint32_t addr, uint32_t data) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint8_t val = data; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return; |
| } |
| |
| stb_p(vdev->config + addr, val); |
| |
| if (k->set_config) { |
| k->set_config(vdev, vdev->config); |
| } |
| } |
| |
| void virtio_config_modern_writew(VirtIODevice *vdev, |
| uint32_t addr, uint32_t data) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint16_t val = data; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return; |
| } |
| |
| stw_le_p(vdev->config + addr, val); |
| |
| if (k->set_config) { |
| k->set_config(vdev, vdev->config); |
| } |
| } |
| |
| void virtio_config_modern_writel(VirtIODevice *vdev, |
| uint32_t addr, uint32_t data) |
| { |
| VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev); |
| uint32_t val = data; |
| |
| if (addr + sizeof(val) > vdev->config_len) { |
| return; |
| } |
| |
| stl_le_p(vdev->config + addr, val); |
| |
| if (k->set_config) { |
| k->set_config(vdev, vdev->config); |
| } |
| } |
| |