| /* |
| * SPDX-License-Identifier: GPL-2.0-or-later |
| * Copyright (C) 2024 IBM Corp. |
| * |
| * IBM Flexible Service Interface master |
| */ |
| |
| #include "qemu/osdep.h" |
| #include "qapi/error.h" |
| #include "qemu/log.h" |
| #include "trace.h" |
| |
| #include "hw/fsi/fsi-master.h" |
| |
| #define TYPE_OP_BUS "opb" |
| |
| #define TO_REG(x) ((x) >> 2) |
| |
| #define FSI_MENP0 TO_REG(0x010) |
| #define FSI_MENP32 TO_REG(0x014) |
| #define FSI_MSENP0 TO_REG(0x018) |
| #define FSI_MLEVP0 TO_REG(0x018) |
| #define FSI_MSENP32 TO_REG(0x01c) |
| #define FSI_MLEVP32 TO_REG(0x01c) |
| #define FSI_MCENP0 TO_REG(0x020) |
| #define FSI_MREFP0 TO_REG(0x020) |
| #define FSI_MCENP32 TO_REG(0x024) |
| #define FSI_MREFP32 TO_REG(0x024) |
| |
| #define FSI_MVER TO_REG(0x074) |
| #define FSI_MRESP0 TO_REG(0x0d0) |
| |
| #define FSI_MRESB0 TO_REG(0x1d0) |
| #define FSI_MRESB0_RESET_GENERAL BIT(31) |
| #define FSI_MRESB0_RESET_ERROR BIT(30) |
| |
| static uint64_t fsi_master_read(void *opaque, hwaddr addr, unsigned size) |
| { |
| FSIMasterState *s = FSI_MASTER(opaque); |
| int reg = TO_REG(addr); |
| |
| trace_fsi_master_read(addr, size); |
| |
| if (reg >= FSI_MASTER_NR_REGS) { |
| qemu_log_mask(LOG_GUEST_ERROR, |
| "%s: Out of bounds read: 0x%"HWADDR_PRIx" for %u\n", |
| __func__, addr, size); |
| return 0; |
| } |
| |
| return s->regs[reg]; |
| } |
| |
| static void fsi_master_write(void *opaque, hwaddr addr, uint64_t data, |
| unsigned size) |
| { |
| FSIMasterState *s = FSI_MASTER(opaque); |
| int reg = TO_REG(addr); |
| |
| trace_fsi_master_write(addr, size, data); |
| |
| if (reg >= FSI_MASTER_NR_REGS) { |
| qemu_log_mask(LOG_GUEST_ERROR, |
| "%s: Out of bounds write: %"HWADDR_PRIx" for %u\n", |
| __func__, addr, size); |
| return; |
| } |
| |
| switch (reg) { |
| case FSI_MENP0: |
| s->regs[FSI_MENP0] = data; |
| break; |
| case FSI_MENP32: |
| s->regs[FSI_MENP32] = data; |
| break; |
| case FSI_MSENP0: |
| s->regs[FSI_MENP0] |= data; |
| break; |
| case FSI_MSENP32: |
| s->regs[FSI_MENP32] |= data; |
| break; |
| case FSI_MCENP0: |
| s->regs[FSI_MENP0] &= ~data; |
| break; |
| case FSI_MCENP32: |
| s->regs[FSI_MENP32] &= ~data; |
| break; |
| case FSI_MRESP0: |
| /* Perform necessary resets leave register 0 to indicate no errors */ |
| break; |
| case FSI_MRESB0: |
| if (data & FSI_MRESB0_RESET_GENERAL) { |
| device_cold_reset(DEVICE(opaque)); |
| } |
| if (data & FSI_MRESB0_RESET_ERROR) { |
| /* FIXME: this seems dubious */ |
| device_cold_reset(DEVICE(opaque)); |
| } |
| break; |
| default: |
| s->regs[reg] = data; |
| } |
| } |
| |
| static const struct MemoryRegionOps fsi_master_ops = { |
| .read = fsi_master_read, |
| .write = fsi_master_write, |
| .endianness = DEVICE_BIG_ENDIAN, |
| }; |
| |
| static void fsi_master_init(Object *o) |
| { |
| FSIMasterState *s = FSI_MASTER(o); |
| |
| object_initialize_child(o, "cfam", &s->cfam, TYPE_FSI_CFAM); |
| |
| qbus_init(&s->bus, sizeof(s->bus), TYPE_FSI_BUS, DEVICE(s), NULL); |
| |
| memory_region_init_io(&s->iomem, OBJECT(s), &fsi_master_ops, s, |
| TYPE_FSI_MASTER, 0x10000000); |
| memory_region_init(&s->opb2fsi, OBJECT(s), "fsi.opb2fsi", 0x10000000); |
| } |
| |
| static void fsi_master_realize(DeviceState *dev, Error **errp) |
| { |
| FSIMasterState *s = FSI_MASTER(dev); |
| |
| if (!qdev_realize(DEVICE(&s->cfam), BUS(&s->bus), errp)) { |
| return; |
| } |
| |
| /* address ? */ |
| memory_region_add_subregion(&s->opb2fsi, 0, &s->cfam.mr); |
| } |
| |
| static void fsi_master_reset(DeviceState *dev) |
| { |
| FSIMasterState *s = FSI_MASTER(dev); |
| |
| /* Initialize registers */ |
| memset(s->regs, 0, sizeof(s->regs)); |
| |
| /* ASPEED default */ |
| s->regs[FSI_MVER] = 0xe0050101; |
| } |
| |
| static void fsi_master_class_init(ObjectClass *klass, void *data) |
| { |
| DeviceClass *dc = DEVICE_CLASS(klass); |
| |
| dc->bus_type = TYPE_OP_BUS; |
| dc->desc = "FSI Master"; |
| dc->realize = fsi_master_realize; |
| dc->reset = fsi_master_reset; |
| } |
| |
| static const TypeInfo fsi_master_info = { |
| .name = TYPE_FSI_MASTER, |
| .parent = TYPE_DEVICE, |
| .instance_init = fsi_master_init, |
| .instance_size = sizeof(FSIMasterState), |
| .class_init = fsi_master_class_init, |
| }; |
| |
| static void fsi_register_types(void) |
| { |
| type_register_static(&fsi_master_info); |
| } |
| |
| type_init(fsi_register_types); |