136 lines
3.4 KiB
C
136 lines
3.4 KiB
C
|
/*
|
||
|
* BCM2835 dummy thermal sensor
|
||
|
*
|
||
|
* Copyright (C) 2019 Philippe Mathieu-Daudé <f4bug@amsat.org>
|
||
|
*
|
||
|
* SPDX-License-Identifier: GPL-2.0-or-later
|
||
|
*/
|
||
|
|
||
|
#include "qemu/osdep.h"
|
||
|
#include "qemu/log.h"
|
||
|
#include "qapi/error.h"
|
||
|
#include "hw/misc/bcm2835_thermal.h"
|
||
|
#include "hw/registerfields.h"
|
||
|
#include "migration/vmstate.h"
|
||
|
|
||
|
REG32(CTL, 0)
|
||
|
FIELD(CTL, POWER_DOWN, 0, 1)
|
||
|
FIELD(CTL, RESET, 1, 1)
|
||
|
FIELD(CTL, BANDGAP_CTRL, 2, 3)
|
||
|
FIELD(CTL, INTERRUPT_ENABLE, 5, 1)
|
||
|
FIELD(CTL, DIRECT, 6, 1)
|
||
|
FIELD(CTL, INTERRUPT_CLEAR, 7, 1)
|
||
|
FIELD(CTL, HOLD, 8, 10)
|
||
|
FIELD(CTL, RESET_DELAY, 18, 8)
|
||
|
FIELD(CTL, REGULATOR_ENABLE, 26, 1)
|
||
|
|
||
|
REG32(STAT, 4)
|
||
|
FIELD(STAT, DATA, 0, 10)
|
||
|
FIELD(STAT, VALID, 10, 1)
|
||
|
FIELD(STAT, INTERRUPT, 11, 1)
|
||
|
|
||
|
#define THERMAL_OFFSET_C 412
|
||
|
#define THERMAL_COEFF (-0.538f)
|
||
|
|
||
|
static uint16_t bcm2835_thermal_temp2adc(int temp_C)
|
||
|
{
|
||
|
return (temp_C - THERMAL_OFFSET_C) / THERMAL_COEFF;
|
||
|
}
|
||
|
|
||
|
static uint64_t bcm2835_thermal_read(void *opaque, hwaddr addr, unsigned size)
|
||
|
{
|
||
|
Bcm2835ThermalState *s = BCM2835_THERMAL(opaque);
|
||
|
uint32_t val = 0;
|
||
|
|
||
|
switch (addr) {
|
||
|
case A_CTL:
|
||
|
val = s->ctl;
|
||
|
break;
|
||
|
case A_STAT:
|
||
|
/* Temperature is constantly 25°C. */
|
||
|
val = FIELD_DP32(bcm2835_thermal_temp2adc(25), STAT, VALID, true);
|
||
|
break;
|
||
|
default:
|
||
|
/* MemoryRegionOps are aligned, so this can not happen. */
|
||
|
g_assert_not_reached();
|
||
|
}
|
||
|
return val;
|
||
|
}
|
||
|
|
||
|
static void bcm2835_thermal_write(void *opaque, hwaddr addr,
|
||
|
uint64_t value, unsigned size)
|
||
|
{
|
||
|
Bcm2835ThermalState *s = BCM2835_THERMAL(opaque);
|
||
|
|
||
|
switch (addr) {
|
||
|
case A_CTL:
|
||
|
s->ctl = value;
|
||
|
break;
|
||
|
case A_STAT:
|
||
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: write 0x%" PRIx64
|
||
|
" to 0x%" HWADDR_PRIx "\n",
|
||
|
__func__, value, addr);
|
||
|
break;
|
||
|
default:
|
||
|
/* MemoryRegionOps are aligned, so this can not happen. */
|
||
|
g_assert_not_reached();
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static const MemoryRegionOps bcm2835_thermal_ops = {
|
||
|
.read = bcm2835_thermal_read,
|
||
|
.write = bcm2835_thermal_write,
|
||
|
.impl.max_access_size = 4,
|
||
|
.valid.min_access_size = 4,
|
||
|
.endianness = DEVICE_NATIVE_ENDIAN,
|
||
|
};
|
||
|
|
||
|
static void bcm2835_thermal_reset(DeviceState *dev)
|
||
|
{
|
||
|
Bcm2835ThermalState *s = BCM2835_THERMAL(dev);
|
||
|
|
||
|
s->ctl = 0;
|
||
|
}
|
||
|
|
||
|
static void bcm2835_thermal_realize(DeviceState *dev, Error **errp)
|
||
|
{
|
||
|
Bcm2835ThermalState *s = BCM2835_THERMAL(dev);
|
||
|
|
||
|
memory_region_init_io(&s->iomem, OBJECT(s), &bcm2835_thermal_ops,
|
||
|
s, TYPE_BCM2835_THERMAL, 8);
|
||
|
sysbus_init_mmio(SYS_BUS_DEVICE(s), &s->iomem);
|
||
|
}
|
||
|
|
||
|
static const VMStateDescription bcm2835_thermal_vmstate = {
|
||
|
.name = "bcm2835_thermal",
|
||
|
.version_id = 1,
|
||
|
.minimum_version_id = 1,
|
||
|
.fields = (VMStateField[]) {
|
||
|
VMSTATE_UINT32(ctl, Bcm2835ThermalState),
|
||
|
VMSTATE_END_OF_LIST()
|
||
|
}
|
||
|
};
|
||
|
|
||
|
static void bcm2835_thermal_class_init(ObjectClass *klass, void *data)
|
||
|
{
|
||
|
DeviceClass *dc = DEVICE_CLASS(klass);
|
||
|
|
||
|
dc->realize = bcm2835_thermal_realize;
|
||
|
dc->reset = bcm2835_thermal_reset;
|
||
|
dc->vmsd = &bcm2835_thermal_vmstate;
|
||
|
}
|
||
|
|
||
|
static const TypeInfo bcm2835_thermal_info = {
|
||
|
.name = TYPE_BCM2835_THERMAL,
|
||
|
.parent = TYPE_SYS_BUS_DEVICE,
|
||
|
.instance_size = sizeof(Bcm2835ThermalState),
|
||
|
.class_init = bcm2835_thermal_class_init,
|
||
|
};
|
||
|
|
||
|
static void bcm2835_thermal_register_types(void)
|
||
|
{
|
||
|
type_register_static(&bcm2835_thermal_info);
|
||
|
}
|
||
|
|
||
|
type_init(bcm2835_thermal_register_types)
|