86Box/src/device/hwm_vt82c686.c

/*
 * 86Box	A hypervisor and IBM PC system emulator that specializes in
 *		running old operating systems and software designed for IBM
 *		PC systems and compatibles from 1981 through fairly recent
 *		system designs based on the PCI bus.
 *
 *		This file is part of the 86Box distribution.
 *
 *		Emulation of the VIA VT82C686A/B integrated hardware monitor.
 *
 *
 *
 * Author:	RichardG, <richardg867@gmail.com>
 *
 *		Copyright 2020 RichardG.
 */
#include <stdarg.h>
#include <stdio.h>
#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#define HAVE_STDARG_H
#include <wchar.h>
#include <86box/86box.h>
#include <86box/device.h>
#include <86box/io.h>
#include <86box/hwm.h>


#define CLAMP(a, min, max)		(((a) < (min)) ? (min) : (((a) > (max)) ? (max) : (a)))
#define VT82C686_RPM_TO_REG(r, d)	((r) ? CLAMP(1350000 / (r * d), 1, 255) : 0)
/* Temperature/voltage formulas and factors derived from Linux's via686a.c driver */
#define VT82C686_TEMP_TO_REG(t)		(-1.160370e-10*(t*t*t*t*t*t) + 3.193693e-08*(t*t*t*t*t) - 1.464447e-06*(t*t*t*t) - 2.525453e-04*(t*t*t) + 1.424593e-02*(t*t) + 2.148941e+00*t + 7.275808e+01)
#define VT82C686_VOLTAGE_TO_REG(v, f)	CLAMP((((v) * (2.628 / (f))) - 120.5) / 25, 0, 255)


typedef struct {
    hwm_values_t *values;
    device_t     *lm75[2];

    uint8_t	enable;
    uint16_t	io_base;
    uint8_t	regs[80];
} vt82c686_t;


static double voltage_factors[5] = {1.25, 1.25, 1.67, 2.6, 6.3};


static void	vt82c686_reset(vt82c686_t *dev, uint8_t initialization);


static uint8_t
vt82c686_read(uint16_t addr, void *priv)
{
    vt82c686_t *dev = (vt82c686_t *) priv;
    uint8_t ret;

    addr -= dev->io_base;

    switch (addr) {
	case 0x1f: case 0x20: case 0x21: /* temperatures */
		ret = VT82C686_TEMP_TO_REG(dev->values->temperatures[(addr == 0x1f) ? 2 : (addr & 1)]);
		break;

	case 0x22: case 0x23: case 0x24: case 0x25: case 0x26: /* voltages */
		ret = VT82C686_VOLTAGE_TO_REG(dev->values->voltages[addr - 0x22], voltage_factors[addr - 0x22]);
		break;

	case 0x29: case 0x2a: /* fan speeds */
		ret = VT82C686_RPM_TO_REG(dev->values->fans[addr - 0x29], 1 << ((dev->regs[0x47] >> ((addr == 0x29) ? 4 : 6)) & 0x3));
		break;

	default: /* other registers */
		ret = dev->regs[addr];
		break;
    }

    return ret;
}


static void
vt82c686_write(uint16_t port, uint8_t val, void *priv)
{
    vt82c686_t *dev = (vt82c686_t *) priv;
    uint8_t reg = port - dev->io_base;

    if ((reg == 0x41) || (reg == 0x42) || (reg == 0x45) || (reg == 0x46) || (reg == 0x48) || (reg == 0x4a) || (reg >= 0x4c))
	return;

    if ((reg == 0x40) && (val & 0x80)) {
	val &= 0x7f;
	vt82c686_reset(dev, 1);
    }

    dev->regs[reg] = val;
}


/* Writes to hardware monitor-related configuration space registers
   of the VT82C686 power management function are sent here by via_pipc.c */
void
vt82c686_hwm_write(uint8_t addr, uint8_t val, void *priv)
{
    vt82c686_t *dev = (vt82c686_t *) priv;

    if (dev->io_base)
	io_removehandler(dev->io_base, 0x0050,
			 vt82c686_read, NULL, NULL, vt82c686_write, NULL, NULL, dev);

    switch (addr) {
	case 0x70:
		dev->io_base &= 0xff00;
		dev->io_base |= val & 0x80;
		break;

	case 0x71:
		dev->io_base &= 0x00ff;
		dev->io_base |= val << 8;
		break;

	case 0x74:
		dev->enable = val & 0x01;
		break;
    }

    if (dev->enable && dev->io_base)
	io_sethandler(dev->io_base, 0x0050,
		      vt82c686_read, NULL, NULL, vt82c686_write, NULL, NULL, dev);
}


static void
vt82c686_reset(vt82c686_t *dev, uint8_t initialization)
{
    memset(dev->regs, 0, 80);

    dev->regs[0x40] = 0x08;
    dev->regs[0x47] = 0x50;
    dev->regs[0x4b] = 0x15;

    if (!initialization)
	vt82c686_hwm_write(0x74, 0x00, dev);
}


static void
vt82c686_close(void *priv)
{
    vt82c686_t *dev = (vt82c686_t *) priv;

    free(dev);
}


static void *
vt82c686_init(const device_t *info)
{
    vt82c686_t *dev = (vt82c686_t *) malloc(sizeof(vt82c686_t));
    memset(dev, 0, sizeof(vt82c686_t));

    /* Set default values. Since this hardware monitor has a complex voltage factor system,
       the values struct contains voltage values *before* applying their respective factors. */
    hwm_values_t defaults = {
	{    /* fan speeds */
		3000,	/* usually CPU */
		3000	/* usually Chassis */
	}, { /* temperatures */
		30,	/* usually CPU */
		30,	/* usually System */
		30
	}, { /* voltages */
		hwm_get_vcore(), /* Vcore */
		2500,		 /* +2.5V */
		3300,		 /* +3.3V */
		5000,		 /* +5V */
		12000		 /* +12V */
	}
    };
    hwm_values = defaults;
    dev->values = &hwm_values;

    vt82c686_reset(dev, 0);

    return dev;
}


const device_t via_vt82c686_hwm_device = {
    "VIA VT82C686 Integrated Hardware Monitor",
    DEVICE_ISA,
    0,
    vt82c686_init, vt82c686_close, NULL,
    { NULL }, NULL, NULL,
    NULL
};