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)
							 |