raspi: added yield instruction to smpboot spin-wait to speed up multi-core boot
[qemu/ar7.git] / hw / acpi / memory_hotplug.c
blobe4b9a01f80b024aa139c65895d1db1820ddaa568
1 #include "hw/acpi/memory_hotplug.h"
2 #include "hw/acpi/pc-hotplug.h"
3 #include "hw/mem/pc-dimm.h"
4 #include "hw/boards.h"
5 #include "hw/qdev-core.h"
6 #include "trace.h"
7 #include "qapi-event.h"
9 static ACPIOSTInfo *acpi_memory_device_status(int slot, MemStatus *mdev)
11 ACPIOSTInfo *info = g_new0(ACPIOSTInfo, 1);
13 info->slot_type = ACPI_SLOT_TYPE_DIMM;
14 info->slot = g_strdup_printf("%d", slot);
15 info->source = mdev->ost_event;
16 info->status = mdev->ost_status;
17 if (mdev->dimm) {
18 DeviceState *dev = DEVICE(mdev->dimm);
19 if (dev->id) {
20 info->device = g_strdup(dev->id);
21 info->has_device = true;
24 return info;
27 void acpi_memory_ospm_status(MemHotplugState *mem_st, ACPIOSTInfoList ***list)
29 int i;
31 for (i = 0; i < mem_st->dev_count; i++) {
32 ACPIOSTInfoList *elem = g_new0(ACPIOSTInfoList, 1);
33 elem->value = acpi_memory_device_status(i, &mem_st->devs[i]);
34 elem->next = NULL;
35 **list = elem;
36 *list = &elem->next;
40 static uint64_t acpi_memory_hotplug_read(void *opaque, hwaddr addr,
41 unsigned int size)
43 uint32_t val = 0;
44 MemHotplugState *mem_st = opaque;
45 MemStatus *mdev;
46 Object *o;
48 if (mem_st->selector >= mem_st->dev_count) {
49 trace_mhp_acpi_invalid_slot_selected(mem_st->selector);
50 return 0;
53 mdev = &mem_st->devs[mem_st->selector];
54 o = OBJECT(mdev->dimm);
55 switch (addr) {
56 case 0x0: /* Lo part of phys address where DIMM is mapped */
57 val = o ? object_property_get_int(o, PC_DIMM_ADDR_PROP, NULL) : 0;
58 trace_mhp_acpi_read_addr_lo(mem_st->selector, val);
59 break;
60 case 0x4: /* Hi part of phys address where DIMM is mapped */
61 val = o ? object_property_get_int(o, PC_DIMM_ADDR_PROP, NULL) >> 32 : 0;
62 trace_mhp_acpi_read_addr_hi(mem_st->selector, val);
63 break;
64 case 0x8: /* Lo part of DIMM size */
65 val = o ? object_property_get_int(o, PC_DIMM_SIZE_PROP, NULL) : 0;
66 trace_mhp_acpi_read_size_lo(mem_st->selector, val);
67 break;
68 case 0xc: /* Hi part of DIMM size */
69 val = o ? object_property_get_int(o, PC_DIMM_SIZE_PROP, NULL) >> 32 : 0;
70 trace_mhp_acpi_read_size_hi(mem_st->selector, val);
71 break;
72 case 0x10: /* node proximity for _PXM method */
73 val = o ? object_property_get_int(o, PC_DIMM_NODE_PROP, NULL) : 0;
74 trace_mhp_acpi_read_pxm(mem_st->selector, val);
75 break;
76 case 0x14: /* pack and return is_* fields */
77 val |= mdev->is_enabled ? 1 : 0;
78 val |= mdev->is_inserting ? 2 : 0;
79 val |= mdev->is_removing ? 4 : 0;
80 trace_mhp_acpi_read_flags(mem_st->selector, val);
81 break;
82 default:
83 val = ~0;
84 break;
86 return val;
89 static void acpi_memory_hotplug_write(void *opaque, hwaddr addr, uint64_t data,
90 unsigned int size)
92 MemHotplugState *mem_st = opaque;
93 MemStatus *mdev;
94 ACPIOSTInfo *info;
95 DeviceState *dev = NULL;
96 HotplugHandler *hotplug_ctrl = NULL;
97 Error *local_err = NULL;
99 if (!mem_st->dev_count) {
100 return;
103 if (addr) {
104 if (mem_st->selector >= mem_st->dev_count) {
105 trace_mhp_acpi_invalid_slot_selected(mem_st->selector);
106 return;
110 switch (addr) {
111 case 0x0: /* DIMM slot selector */
112 mem_st->selector = data;
113 trace_mhp_acpi_write_slot(mem_st->selector);
114 break;
115 case 0x4: /* _OST event */
116 mdev = &mem_st->devs[mem_st->selector];
117 if (data == 1) {
118 /* TODO: handle device insert OST event */
119 } else if (data == 3) {
120 /* TODO: handle device remove OST event */
122 mdev->ost_event = data;
123 trace_mhp_acpi_write_ost_ev(mem_st->selector, mdev->ost_event);
124 break;
125 case 0x8: /* _OST status */
126 mdev = &mem_st->devs[mem_st->selector];
127 mdev->ost_status = data;
128 trace_mhp_acpi_write_ost_status(mem_st->selector, mdev->ost_status);
129 /* TODO: implement memory removal on guest signal */
131 info = acpi_memory_device_status(mem_st->selector, mdev);
132 qapi_event_send_acpi_device_ost(info, &error_abort);
133 qapi_free_ACPIOSTInfo(info);
134 break;
135 case 0x14: /* set is_* fields */
136 mdev = &mem_st->devs[mem_st->selector];
137 if (data & 2) { /* clear insert event */
138 mdev->is_inserting = false;
139 trace_mhp_acpi_clear_insert_evt(mem_st->selector);
140 } else if (data & 4) {
141 mdev->is_removing = false;
142 trace_mhp_acpi_clear_remove_evt(mem_st->selector);
143 } else if (data & 8) {
144 if (!mdev->is_enabled) {
145 trace_mhp_acpi_ejecting_invalid_slot(mem_st->selector);
146 break;
149 dev = DEVICE(mdev->dimm);
150 hotplug_ctrl = qdev_get_hotplug_handler(dev);
151 /* call pc-dimm unplug cb */
152 hotplug_handler_unplug(hotplug_ctrl, dev, &local_err);
153 if (local_err) {
154 trace_mhp_acpi_pc_dimm_delete_failed(mem_st->selector);
155 qapi_event_send_mem_unplug_error(dev->id,
156 error_get_pretty(local_err),
157 &error_abort);
158 error_free(local_err);
159 break;
161 trace_mhp_acpi_pc_dimm_deleted(mem_st->selector);
163 break;
164 default:
165 break;
169 static const MemoryRegionOps acpi_memory_hotplug_ops = {
170 .read = acpi_memory_hotplug_read,
171 .write = acpi_memory_hotplug_write,
172 .endianness = DEVICE_LITTLE_ENDIAN,
173 .valid = {
174 .min_access_size = 1,
175 .max_access_size = 4,
179 void acpi_memory_hotplug_init(MemoryRegion *as, Object *owner,
180 MemHotplugState *state)
182 MachineState *machine = MACHINE(qdev_get_machine());
184 state->dev_count = machine->ram_slots;
185 if (!state->dev_count) {
186 return;
189 state->devs = g_malloc0(sizeof(*state->devs) * state->dev_count);
190 memory_region_init_io(&state->io, owner, &acpi_memory_hotplug_ops, state,
191 "acpi-mem-hotplug", ACPI_MEMORY_HOTPLUG_IO_LEN);
192 memory_region_add_subregion(as, ACPI_MEMORY_HOTPLUG_BASE, &state->io);
196 * acpi_memory_slot_status:
197 * @mem_st: memory hotplug state
198 * @dev: device
199 * @errp: set in case of an error
201 * Obtain a single memory slot status.
203 * This function will be called by memory unplug request cb and unplug cb.
205 static MemStatus *
206 acpi_memory_slot_status(MemHotplugState *mem_st,
207 DeviceState *dev, Error **errp)
209 Error *local_err = NULL;
210 int slot = object_property_get_int(OBJECT(dev), PC_DIMM_SLOT_PROP,
211 &local_err);
213 if (local_err) {
214 error_propagate(errp, local_err);
215 return NULL;
218 if (slot >= mem_st->dev_count) {
219 char *dev_path = object_get_canonical_path(OBJECT(dev));
220 error_setg(errp, "acpi_memory_slot_status: "
221 "device [%s] returned invalid memory slot[%d]",
222 dev_path, slot);
223 g_free(dev_path);
224 return NULL;
227 return &mem_st->devs[slot];
230 void acpi_memory_plug_cb(ACPIREGS *ar, qemu_irq irq, MemHotplugState *mem_st,
231 DeviceState *dev, Error **errp)
233 MemStatus *mdev;
235 mdev = acpi_memory_slot_status(mem_st, dev, errp);
236 if (!mdev) {
237 return;
240 mdev->dimm = dev;
241 mdev->is_enabled = true;
242 if (dev->hotplugged) {
243 mdev->is_inserting = true;
245 /* do ACPI magic */
246 acpi_send_gpe_event(ar, irq, ACPI_MEMORY_HOTPLUG_STATUS);
248 return;
251 void acpi_memory_unplug_request_cb(ACPIREGS *ar, qemu_irq irq,
252 MemHotplugState *mem_st,
253 DeviceState *dev, Error **errp)
255 MemStatus *mdev;
257 mdev = acpi_memory_slot_status(mem_st, dev, errp);
258 if (!mdev) {
259 return;
262 mdev->is_removing = true;
264 /* Do ACPI magic */
265 acpi_send_gpe_event(ar, irq, ACPI_MEMORY_HOTPLUG_STATUS);
268 void acpi_memory_unplug_cb(MemHotplugState *mem_st,
269 DeviceState *dev, Error **errp)
271 MemStatus *mdev;
273 mdev = acpi_memory_slot_status(mem_st, dev, errp);
274 if (!mdev) {
275 return;
278 mdev->is_enabled = false;
279 mdev->dimm = NULL;
282 static const VMStateDescription vmstate_memhp_sts = {
283 .name = "memory hotplug device state",
284 .version_id = 1,
285 .minimum_version_id = 1,
286 .minimum_version_id_old = 1,
287 .fields = (VMStateField[]) {
288 VMSTATE_BOOL(is_enabled, MemStatus),
289 VMSTATE_BOOL(is_inserting, MemStatus),
290 VMSTATE_UINT32(ost_event, MemStatus),
291 VMSTATE_UINT32(ost_status, MemStatus),
292 VMSTATE_END_OF_LIST()
296 const VMStateDescription vmstate_memory_hotplug = {
297 .name = "memory hotplug state",
298 .version_id = 1,
299 .minimum_version_id = 1,
300 .minimum_version_id_old = 1,
301 .fields = (VMStateField[]) {
302 VMSTATE_UINT32(selector, MemHotplugState),
303 VMSTATE_STRUCT_VARRAY_POINTER_UINT32(devs, MemHotplugState, dev_count,
304 vmstate_memhp_sts, MemStatus),
305 VMSTATE_END_OF_LIST()