1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
|
/*
* SPDX-License-Identifier: GPL-2.0-or-later
* Copyright (C) 2024 IBM Corp.
*
* IBM Local bus where FSI slaves are connected
*/
#include "qemu/osdep.h"
#include "qapi/error.h"
#include "hw/fsi/lbus.h"
#include "hw/qdev-properties.h"
#include "qemu/log.h"
#include "trace.h"
#define TO_REG(offset) ((offset) >> 2)
static void fsi_lbus_init(Object *o)
{
FSILBus *lbus = FSI_LBUS(o);
memory_region_init(&lbus->mr, OBJECT(lbus), TYPE_FSI_LBUS, 1 * MiB);
}
static const TypeInfo fsi_lbus_info = {
.name = TYPE_FSI_LBUS,
.parent = TYPE_BUS,
.instance_init = fsi_lbus_init,
.instance_size = sizeof(FSILBus),
};
static const TypeInfo fsi_lbus_device_type_info = {
.name = TYPE_FSI_LBUS_DEVICE,
.parent = TYPE_DEVICE,
.instance_size = sizeof(FSILBusDevice),
.abstract = true,
};
static uint64_t fsi_scratchpad_read(void *opaque, hwaddr addr, unsigned size)
{
FSIScratchPad *s = SCRATCHPAD(opaque);
int reg = TO_REG(addr);
trace_fsi_scratchpad_read(addr, size);
if (reg >= FSI_SCRATCHPAD_NR_REGS) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: Out-of-bounds read at offset 0x%" HWADDR_PRIx "\n",
__func__, addr);
return 0;
}
return s->regs[reg];
}
static void fsi_scratchpad_write(void *opaque, hwaddr addr, uint64_t data,
unsigned size)
{
FSIScratchPad *s = SCRATCHPAD(opaque);
trace_fsi_scratchpad_write(addr, size, data);
int reg = TO_REG(addr);
if (reg >= FSI_SCRATCHPAD_NR_REGS) {
qemu_log_mask(LOG_GUEST_ERROR,
"%s: Out-of-bounds write at offset 0x%" HWADDR_PRIx "\n",
__func__, addr);
return;
}
s->regs[reg] = data;
}
static const struct MemoryRegionOps scratchpad_ops = {
.read = fsi_scratchpad_read,
.write = fsi_scratchpad_write,
.endianness = DEVICE_BIG_ENDIAN,
};
static void fsi_scratchpad_realize(DeviceState *dev, Error **errp)
{
FSILBusDevice *ldev = FSI_LBUS_DEVICE(dev);
memory_region_init_io(&ldev->iomem, OBJECT(ldev), &scratchpad_ops,
ldev, TYPE_FSI_SCRATCHPAD, 0x400);
}
static void fsi_scratchpad_reset(DeviceState *dev)
{
FSIScratchPad *s = SCRATCHPAD(dev);
memset(s->regs, 0, sizeof(s->regs));
}
static void fsi_scratchpad_class_init(ObjectClass *klass, void *data)
{
DeviceClass *dc = DEVICE_CLASS(klass);
dc->bus_type = TYPE_FSI_LBUS;
dc->realize = fsi_scratchpad_realize;
dc->reset = fsi_scratchpad_reset;
}
static const TypeInfo fsi_scratchpad_info = {
.name = TYPE_FSI_SCRATCHPAD,
.parent = TYPE_FSI_LBUS_DEVICE,
.instance_size = sizeof(FSIScratchPad),
.class_init = fsi_scratchpad_class_init,
};
static void fsi_lbus_register_types(void)
{
type_register_static(&fsi_lbus_info);
type_register_static(&fsi_lbus_device_type_info);
type_register_static(&fsi_scratchpad_info);
}
type_init(fsi_lbus_register_types);
|
