2f0d866e126dd288169fed591c259c1c6b4016e5vboxsync

2f0d866e126dd288169fed591c259c1c6b4016e5vboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define LOG_GROUP LOG_GROUP_DEV_HPET

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#include <VBox/pdmdev.h>

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#include <VBox/log.h>

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#include <VBox/stam.h>

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#include <iprt/assert.h>

2f0d866e126dd288169fed591c259c1c6b4016e5vboxsync#include <iprt/asm-math.h>

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#include <iprt/string.h>

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#include "../Builtins.h"

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_BASE 0xfed00000

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_NUM_TIMERS 3

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_CLK_PERIOD 10000000UL

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define FS_PER_NS 1000000

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TIMER_TYPE_LEVEL 1

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TIMER_TYPE_EDGE 0

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TIMER_DELIVERY_APIC 0

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TIMER_DELIVERY_FSB 1

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TIMER_CAP_FSB_INT_DEL (1 << 15)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TIMER_CAP_PER_INT (1 << 4)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_CFG_ENABLE 0x001 /* ENABLE_CNF */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_CFG_LEGACY 0x002 /* LEG_RT_CNF */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_ID 0x000

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_PERIOD 0x004

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_CFG 0x010

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_STATUS 0x020

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_COUNTER 0x0f0

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TN_CFG 0x000

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TN_CMP 0x008

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TN_ROUTE 0x010

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_CFG_WRITE_MASK 0x3

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_INT_TYPE (1 << 1)

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_ENABLE (1 << 2)

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_PERIODIC (1 << 3)

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_PERIODIC_CAP (1 << 4)

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_SIZE_CAP (1 << 5)

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_SETVAL (1 << 6)

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_32BIT (1 << 8)

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_INT_ROUTE_MASK 0x3e00

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_CFG_WRITE_MASK 0x3f4e

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_INT_ROUTE_SHIFT 9

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync#define HPET_TN_INT_ROUTE_CAP_SHIFT 32

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_TN_CFG_BITS_READONLY_OR_RESERVED 0xffff80b1U

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_SAVED_STATE_VERSION 2

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#define HPET_SAVED_STATE_VERSION_EMPTY 1

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

2f0d866e126dd288169fed591c259c1c6b4016e5vboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstruct HpetState;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsynctypedef struct HpetTimer

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** The HPET timer - R3 Ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PTMTIMERR3 pTimerR3;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** Pointer to the instance data - R3 Ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync R3PTRTYPE(struct HpetState *) pHpetR3;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** The HPET timer - R0 Ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PTMTIMERR0 pTimerR0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** Pointer to the instance data - R0 Ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync R0PTRTYPE(struct HpetState *) pHpetR0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** The HPET timer - RC Ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PTMTIMERRC pTimerRC;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** Pointer to the instance data - RC Ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync RCPTRTYPE(struct HpetState *) pHpetRC;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* timer number*/

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint8_t u8TimerNumber;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Wrap */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint8_t u8Wrap;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Alignment */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t alignment0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Memory-mapped, software visible timer registers */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Configuration/capabilities */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Config;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* comparator */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Cmp;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* FSB route, not supported now */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Fsb;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Hidden register state */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Last value written to comparator */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Period;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync} HpetTimer;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsynctypedef struct HpetState

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** Pointer to the device instance. - R3 ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PPDMDEVINSR3 pDevInsR3;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** The HPET helpers - R3 Ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PCPDMHPETHLPR3 pHpetHlpR3;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** Pointer to the device instance. - R0 ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PPDMDEVINSR0 pDevInsR0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** The HPET helpers - R0 Ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PCPDMHPETHLPR0 pHpetHlpR0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** Pointer to the device instance. - RC ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PPDMDEVINSRC pDevInsRC;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** The HPET helpers - RC Ptr. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PCPDMHPETHLPRC pHpetHlpRC;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Timer structures */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetTimer aTimers[HPET_NUM_TIMERS];

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Offset realtive to the system clock */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64HpetOffset;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Memory-mapped, software visible registers */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* capabilities */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Capabilities;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* configuration */

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint64_t u64HpetConfig;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* interrupt status register */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Isr;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* main counter */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64HpetCounter;

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync /* Global device lock */

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync PDMCRITSECT csLock;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync} HpetState;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#ifndef VBOX_DEVICE_STRUCT_TESTCASE

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncPDMBOTHCBDECL(int) hpetMMIOWrite(PPDMDEVINS pDevIns, void *pvUser, RTGCPHYS GCPhysAddr, void *pv, unsigned cb);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncPDMBOTHCBDECL(int) hpetMMIORead (PPDMDEVINS pDevIns, void *pvUser, RTGCPHYS GCPhysAddr, void *pv, unsigned cb);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic const bool fHpetLocking = true;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsyncDECLINLINE(int) hpetLock(HpetState* pThis, int rcBusy)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (!fHpetLocking)

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync return PDMCritSectEnter(&pThis->csLock, rcBusy);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncDECLINLINE(void) hpetUnlock(HpetState* pThis)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (!fHpetLocking)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync PDMCritSectLeave(&pThis->csLock);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic uint32_t hpetTimeAfter32(uint64_t a, uint64_t b)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return ((int32_t)(b) - (int32_t)(a) <= 0);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic uint32_t hpetTimeAfter64(uint64_t a, uint64_t b)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return ((int64_t)(b) - (int64_t)(a) <= 0);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic uint64_t hpetTicksToNs(uint64_t value)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return (ASMMultU64ByU32DivByU32(value, HPET_CLK_PERIOD, FS_PER_NS));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic uint64_t nsToHpetTicks(uint64_t u64Value)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return (ASMMultU64ByU32DivByU32(u64Value, FS_PER_NS, HPET_CLK_PERIOD));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic uint64_t hpetGetTicks(HpetState* pThis)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /*

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return nsToHpetTicks(TMTimerGet(pThis->aTimers[0].CTX_SUFF(pTimer)) +

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->u64HpetOffset);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsyncstatic uint64_t hpetUpdateMasked(uint64_t u64NewValue,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint64_t u64OldValue,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint64_t u64Mask)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64NewValue &= u64Mask;

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync u64NewValue |= (u64OldValue & ~u64Mask);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return u64NewValue;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsyncstatic bool hpetBitJustSet(uint64_t u64OldValue,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint64_t u64NewValue,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint64_t u64Mask)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

2e5aced57476316542e80047953840c7b4887337vboxsync return (!(u64OldValue & u64Mask) && !!(u64NewValue & u64Mask));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsyncstatic bool hpetBitJustCleared(uint64_t u64OldValue,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint64_t u64NewValue,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint64_t u64Mask)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync return (!!(u64OldValue & u64Mask) && !(u64NewValue & u64Mask));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncDECLINLINE(uint64_t) hpetComputeDiff(HpetTimer* pTimer,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Now)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (pTimer->u64Config & HPET_TN_32BIT)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t u32Diff;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u32Diff = (uint32_t)pTimer->u64Cmp - (uint32_t)u64Now;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u32Diff = ((int32_t)u32Diff > 0) ? u32Diff : (uint32_t)0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return (uint64_t)u32Diff;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync } else {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Diff;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64Diff = pTimer->u64Cmp - u64Now;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64Diff = ((int64_t)u64Diff > 0) ? u64Diff : (uint64_t)0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return u64Diff;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic void hpetAdjustComparator(HpetTimer* pTimer,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Now)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Period = pTimer->u64Period;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if ((pTimer->u64Config & HPET_TN_PERIODIC) && (u64Period != 0))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* While loop is suboptimal */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (pTimer->u64Config & HPET_TN_32BIT)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync while (hpetTimeAfter32(u64Now, pTimer->u64Cmp))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u64Cmp = (uint32_t)(pTimer->u64Cmp + u64Period);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync else

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync while (hpetTimeAfter64(u64Now, pTimer->u64Cmp))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u64Cmp += u64Period;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic void hpetProgramTimer(HpetTimer *pTimer)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Diff;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t u32TillWrap;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Ticks = hpetGetTicks(pTimer->CTX_SUFF(pHpet));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* no wrapping on new timers */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u8Wrap = 0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetAdjustComparator(pTimer, u64Ticks);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64Diff = hpetComputeDiff(pTimer, u64Ticks);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Spec says in one-shot 32-bit mode, generate an interrupt when

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if ((pTimer->u64Config & HPET_TN_32BIT) && !(pTimer->u64Config & HPET_TN_PERIODIC))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u32TillWrap = 0xffffffff - (uint32_t)u64Ticks;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (u32TillWrap < (uint32_t)u64Diff)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64Diff = u32TillWrap;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u8Wrap = 1;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Avoid killing VM with interrupts */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#if 1

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* @todo: HACK, rethink, may have negative impact on the guest */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (u64Diff == 0)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64Diff = 100000; /* 1 millisecond */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#endif

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log4(("HPET: next IRQ in %lld ticks (%lld ns)\n", u64Diff, hpetTicksToNs(u64Diff)));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync TMTimerSetNano(pTimer->CTX_SUFF(pTimer), hpetTicksToNs(u64Diff));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic uint32_t getTimerIrq(struct HpetTimer *pTimer)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /*

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if ((pTimer->u8TimerNumber <= 1) &&

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync (pTimer->CTX_SUFF(pHpet)->u64HpetConfig & HPET_CFG_LEGACY))

af5224eb6b6676bc892a3f5abeb21f602547d31cvboxsync return (pTimer->u8TimerNumber == 0) ? 0 : 8;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync else

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return (pTimer->u64Config & HPET_TN_INT_ROUTE_MASK) >> HPET_TN_INT_ROUTE_SHIFT;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsyncstatic int hpetTimerRegRead32(HpetState* pThis,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t iTimerNo,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t iTimerReg,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t * pValue)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetTimer *pTimer;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (iTimerNo >= HPET_NUM_TIMERS)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync LogRel(("HPET: using timer above configured range: %d\n", iTimerNo));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer = &pThis->aTimers[iTimerNo];

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync switch (iTimerReg)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_CFG:

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log(("read HPET_TN_CFG on %d\n", pTimer->u8TimerNumber));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync *pValue = (uint32_t)(pTimer->u64Config);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_CFG + 4:

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log(("read HPET_TN_CFG+4 on %d\n", pTimer->u8TimerNumber));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync *pValue = (uint32_t)(pTimer->u64Config >> 32);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_CMP:

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log(("read HPET_TN_CMP on %d, cmp=%llx\n", pTimer->u8TimerNumber, pTimer->u64Cmp));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync *pValue = (uint32_t)(pTimer->u64Cmp);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_CMP + 4:

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log(("read HPET_TN_CMP+4 on %d, cmp=%llx\n", pTimer->u8TimerNumber, pTimer->u64Cmp));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync *pValue = (uint32_t)(pTimer->u64Cmp >> 32);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_ROUTE:

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log(("read HPET_TN_ROUTE on %d\n", pTimer->u8TimerNumber));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync *pValue = (uint32_t)(pTimer->u64Fsb >> 32);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync default:

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync LogRel(("invalid HPET register read %d on %d\n", iTimerReg, pTimer->u8TimerNumber));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsyncstatic int hpetConfigRegRead32(HpetState* pThis,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t iIndex,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t *pValue)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync switch (iIndex)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_ID:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("read HPET_ID\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync *pValue = (uint32_t)(pThis->u64Capabilities);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_PERIOD:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("read HPET_PERIOD\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync *pValue = (uint32_t)(pThis->u64Capabilities >> 32);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_CFG:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("read HPET_CFG\n"));

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync *pValue = (uint32_t)(pThis->u64HpetConfig);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_CFG + 4:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("read of HPET_CFG + 4\n"));

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync *pValue = (uint32_t)(pThis->u64HpetConfig >> 32);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_COUNTER:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_COUNTER + 4:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Ticks;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("read HPET_COUNTER\n"));

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync if (pThis->u64HpetConfig & HPET_CFG_ENABLE)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64Ticks = hpetGetTicks(pThis);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync else

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64Ticks = pThis->u64HpetCounter;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /** @todo: is it correct? */

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync *pValue = (iIndex == HPET_COUNTER) ? (uint32_t)u64Ticks : (uint32_t)(u64Ticks >> 32);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_STATUS:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("read HPET_STATUS\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync *pValue = (uint32_t)(pThis->u64Isr);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync default:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("invalid HPET register read: %x\n", iIndex));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsyncstatic int hpetTimerRegWrite32(HpetState* pThis,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t iTimerNo,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t iTimerReg,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t iNewValue)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetTimer * pTimer;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t iOldValue = 0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t u32Temp;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (iTimerNo >= HPET_NUM_TIMERS)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync LogRel(("HPET: using timer above configured range: %d\n", iTimerNo));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer = &pThis->aTimers[iTimerNo];

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetTimerRegRead32(pThis, iTimerNo, iTimerReg, &u32Temp);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync iOldValue = u32Temp;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync switch (iTimerReg)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_CFG:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log(("write HPET_TN_CFG: %d\n", iTimerNo));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (iNewValue & HPET_TN_32BIT)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u64Cmp = (uint32_t)pTimer->u64Cmp;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u64Period = (uint32_t)pTimer->u64Period;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

ff03d550549cfd2458dcac64202de635eb8d07cdvboxsync if ((iNewValue & HPET_TN_INT_TYPE) == HPET_TIMER_TYPE_LEVEL)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync LogRel(("level-triggered config not yet supported\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Assert(false);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync /** We only care about lower 32-bits so far */

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync pTimer->u64Config =

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync hpetUpdateMasked(iNewValue, iOldValue, HPET_TN_CFG_WRITE_MASK);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_CFG + 4: /* Interrupt capabilities */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("write HPET_TN_CFG + 4, useless\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_CMP: /* lower bits of comparator register */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log(("write HPET_TN_CMP on %d: %x\n", iTimerNo, iNewValue));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (pTimer->u64Config & HPET_TN_32BIT)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync iNewValue = (uint32_t)iNewValue;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync if (pTimer->u64Config & HPET_TN_SETVAL)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync /* HPET_TN_SETVAL allows to adjust comparator w/o updating period, and it's cleared on access */

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync if (pTimer->u64Config & HPET_TN_32BIT)

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync pTimer->u64Config &= ~HPET_TN_SETVAL;

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync } else if (pTimer->u64Config & HPET_TN_PERIODIC)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync iNewValue &= (pTimer->u64Config & HPET_TN_32BIT ? ~0U : ~0ULL) >> 1;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u64Period = (pTimer->u64Period & 0xffffffff00000000ULL)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync | iNewValue;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync pTimer->u64Cmp = (pTimer->u64Cmp & 0xffffffff00000000ULL)

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync | iNewValue;

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log2(("after HPET_TN_CMP cmp=%llx per=%llx\n", pTimer->u64Cmp, pTimer->u64Period));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync if (pThis->u64HpetConfig & HPET_CFG_ENABLE)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetProgramTimer(pTimer);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync case HPET_TN_CMP + 4: /* upper bits of comparator register */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log(("write HPET_TN_CMP + 4 on %d: %x\n", iTimerNo, iNewValue));

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync if (pTimer->u64Config & HPET_TN_32BIT)

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync break;

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync if (pTimer->u64Config & HPET_TN_SETVAL)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync /* HPET_TN_SETVAL allows to adjust comparator w/o updating period, and it's cleared on access */

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync pTimer->u64Config &= ~HPET_TN_SETVAL;

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync } else if (pTimer->u64Config & HPET_TN_PERIODIC)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync pTimer->u64Period = (pTimer->u64Period & 0xffffffffULL)

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync | ((uint64_t)iNewValue << 32);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync pTimer->u64Cmp = (pTimer->u64Cmp & 0xffffffffULL)

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync | ((uint64_t)iNewValue << 32);

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync Log2(("after HPET_TN_CMP+4 cmp=%llx per=%llx\n", pTimer->u64Cmp, pTimer->u64Period));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync if (pThis->u64HpetConfig & HPET_CFG_ENABLE)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetProgramTimer(pTimer);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_ROUTE:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("write HPET_TN_ROUTE\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_TN_ROUTE + 4:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("write HPET_TN_ROUTE + 4\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync default:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync LogRel(("invalid timer register write: %d\n", iTimerReg));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Assert(false);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic int hpetLegacyMode(HpetState* pThis,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync bool fActivate)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc = VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#ifndef IN_RING3

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Don't do anything complicated outside of R3 */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = VINF_IOM_HC_MMIO_WRITE;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#else /* IN_RING3 */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (pThis->pHpetHlpR3)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = pThis->pHpetHlpR3->pfnSetLegacyMode(pThis->pDevInsR3, fActivate);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#endif

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsyncstatic int hpetConfigRegWrite32(HpetState* pThis,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t iIndex,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync uint32_t iNewValue)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc = VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync switch (iIndex)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_ID:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_ID + 4:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("write HPET_ID, useless\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_CFG:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t i, iOldValue;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("write HPET_CFG: %x\n", iNewValue));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync iOldValue = (uint32_t)(pThis->u64HpetConfig);

3614117c1132a61599e6190939e775cafe549411vboxsync

034f0367d3b0431c6346b1a3af3abb435ee50d4evboxsync /*

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync if (hpetBitJustSet(iOldValue, iNewValue, HPET_CFG_LEGACY))

3614117c1132a61599e6190939e775cafe549411vboxsync {

3614117c1132a61599e6190939e775cafe549411vboxsync rc = hpetLegacyMode(pThis, true);

3614117c1132a61599e6190939e775cafe549411vboxsync }

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync else if (hpetBitJustCleared(iOldValue, iNewValue, HPET_CFG_LEGACY))

3614117c1132a61599e6190939e775cafe549411vboxsync {

3614117c1132a61599e6190939e775cafe549411vboxsync rc = hpetLegacyMode(pThis, false);

3614117c1132a61599e6190939e775cafe549411vboxsync }

3614117c1132a61599e6190939e775cafe549411vboxsync if (rc != VINF_SUCCESS)

3614117c1132a61599e6190939e775cafe549411vboxsync return rc;

3614117c1132a61599e6190939e775cafe549411vboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync pThis->u64HpetConfig = hpetUpdateMasked(iNewValue, iOldValue, HPET_CFG_WRITE_MASK);

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync if (hpetBitJustSet(iOldValue, iNewValue, HPET_CFG_ENABLE))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Enable main counter and interrupt generation. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->u64HpetOffset = hpetTicksToNs(pThis->u64HpetCounter)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync - TMTimerGet(pThis->aTimers[0].CTX_SUFF(pTimer));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync for (i = 0; i < HPET_NUM_TIMERS; i++)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (pThis->aTimers[i].u64Cmp != ~0ULL)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetProgramTimer(&pThis->aTimers[i]);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync else if (hpetBitJustCleared(iOldValue, iNewValue, HPET_CFG_ENABLE))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Halt main counter and disable interrupt generation. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->u64HpetCounter = hpetGetTicks(pThis);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync for (i = 0; i < HPET_NUM_TIMERS; i++)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync TMTimerStop(pThis->aTimers[i].CTX_SUFF(pTimer));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_CFG + 4:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("write HPET_CFG + 4: %x\n", iNewValue));

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync pThis->u64HpetConfig = hpetUpdateMasked((uint64_t)iNewValue << 32,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync pThis->u64HpetConfig,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync 0xffffffff00000000ULL);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_STATUS:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("write HPET_STATUS: %x\n", iNewValue));

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync // clear ISR for all set bits in iNewValue, see p. 14 of HPET spec

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync pThis->u64Isr &= ~((uint64_t)iNewValue);

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync break;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync }

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync case HPET_STATUS + 4:

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync {

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync Log(("write HPET_STATUS + 4: %x\n", iNewValue));

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if (iNewValue != 0)

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync LogRel(("Writing HPET_STATUS + 4 with non-zero, ignored\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_COUNTER:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->u64HpetCounter = (pThis->u64HpetCounter & 0xffffffff00000000ULL) | iNewValue;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("write HPET_COUNTER: %#x -> %llx\n",

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync iNewValue, pThis->u64HpetCounter));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case HPET_COUNTER + 4:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->u64HpetCounter = (pThis->u64HpetCounter & 0xffffffffULL)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync | (((uint64_t)iNewValue) << 32);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("write HPET_COUNTER + 4: %#x -> %llx\n",

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync iNewValue, pThis->u64HpetCounter));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync default:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync LogRel(("invalid HPET config write: %x\n", iIndex));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncPDMBOTHCBDECL(int) hpetMMIORead(PPDMDEVINS pDevIns,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync void * pvUser,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync RTGCPHYS GCPhysAddr,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync void * pv,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync unsigned cb)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState * pThis = PDMINS_2_DATA(pDevIns, HpetState*);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc = VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t iIndex = (uint32_t)(GCPhysAddr - HPET_BASE);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync LogFlow(("hpetMMIORead: %llx (%x)\n", (uint64_t)GCPhysAddr, iIndex));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync rc = hpetLock(pThis, VINF_IOM_HC_MMIO_READ);

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync if (RT_UNLIKELY(rc != VINF_SUCCESS))

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync switch (cb)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case 1:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case 2:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("Narrow read: %d\n", cb));

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync rc = VERR_INTERNAL_ERROR;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case 4:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if ((iIndex >= 0x100) && (iIndex < 0x400))

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetTimerRegRead32(pThis, (iIndex - 0x100) / 0x20, (iIndex - 0x100) % 0x20, (uint32_t*)pv);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync else

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetConfigRegRead32(pThis, iIndex, (uint32_t*)pv);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync case 8:

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync {

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync union {

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync uint32_t u32[2];

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync uint64_t u64;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync } value;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync /* Unaligned accesses not allowed */

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if (iIndex % 8 != 0)

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync {

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync AssertMsgFailed(("Unaligned HPET read access\n"));

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync rc = VERR_INTERNAL_ERROR;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync break;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync }

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync // for 8-byte accesses we just split them, happens under lock anyway

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if ((iIndex >= 0x100) && (iIndex < 0x400))

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync {

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync uint32_t iTimer = (iIndex - 0x100) / 0x20;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync uint32_t iTimerReg = (iIndex - 0x100) % 0x20;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetTimerRegRead32(pThis, iTimer, iTimerReg, &value.u32[0]);

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if (RT_UNLIKELY(rc != VINF_SUCCESS))

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync break;

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetTimerRegRead32(pThis, iTimer, iTimerReg + 4, &value.u32[1]);

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync }

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync else

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync {

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetConfigRegRead32(pThis, iIndex, &value.u32[0]);

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if (RT_UNLIKELY(rc != VINF_SUCCESS))

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync break;

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetConfigRegRead32(pThis, iIndex+4, &value.u32[1]);

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync }

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if (rc == VINF_SUCCESS)

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync *(uint64_t*)pv = value.u64;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync break;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync default:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync AssertReleaseMsgFailed(("cb=%d\n", cb)); /* for now we assume simple accesses. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = VERR_INTERNAL_ERROR;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetUnlock(pThis);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncPDMBOTHCBDECL(int) hpetMMIOWrite(PPDMDEVINS pDevIns,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync void * pvUser,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync RTGCPHYS GCPhysAddr,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync void * pv,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync unsigned cb)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState*);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc = VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t iIndex = (uint32_t)(GCPhysAddr - HPET_BASE);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync LogFlow(("hpetMMIOWrite: %llx (%x) <- %x\n",

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync (uint64_t)GCPhysAddr, iIndex, *(uint32_t*)pv));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync rc = hpetLock(pThis, VINF_IOM_HC_MMIO_WRITE);

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync if (RT_UNLIKELY(rc != VINF_SUCCESS))

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync switch (cb)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case 1:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case 2:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log(("Narrow write: %d\n", cb));

36fbf6dcd3e6b2e5891456b730577ff0eb355c9fvboxsync rc = VERR_INTERNAL_ERROR;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync case 4:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if ((iIndex >= 0x100) && (iIndex < 0x400))

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetTimerRegWrite32(pThis,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync (iIndex - 0x100) / 0x20,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync (iIndex - 0x100) % 0x20,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync *(uint32_t*)pv);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync else

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetConfigRegWrite32(pThis, iIndex, *(uint32_t*)pv);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync break;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync case 8:

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync {

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync union {

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync uint32_t u32[2];

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync uint64_t u64;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync } value;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync /* Unaligned accesses not allowed */

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if (iIndex % 8 != 0)

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync {

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync AssertMsgFailed(("Unaligned HPET write access\n"));

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync rc = VERR_INTERNAL_ERROR;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync break;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync }

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync value.u64 = *(uint64_t*)pv;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync // for 8-byte accesses we just split them, happens under lock anyway

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if ((iIndex >= 0x100) && (iIndex < 0x400))

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync {

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync uint32_t iTimer = (iIndex - 0x100) / 0x20;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync uint32_t iTimerReg = (iIndex - 0x100) % 0x20;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetTimerRegWrite32(pThis, iTimer, iTimerReg, value.u32[0]);

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if (RT_UNLIKELY(rc != VINF_SUCCESS))

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync break;

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetTimerRegWrite32(pThis, iTimer, iTimerReg + 4, value.u32[1]);

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync }

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync else

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync {

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetConfigRegWrite32(pThis, iIndex, value.u32[0]);

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync if (RT_UNLIKELY(rc != VINF_SUCCESS))

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync break;

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync rc = hpetConfigRegWrite32(pThis, iIndex+4, value.u32[1]);

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync }

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync break;

ac6445a70a26cb69d08734f1d9dbc171cec86cd8vboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync default:

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync AssertReleaseMsgFailed(("cb=%d\n", cb)); /* for now we assume simple accesses. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = VERR_INTERNAL_ERROR;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetUnlock(pThis);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#ifdef IN_RING3

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic int hpetSaveTimer(HpetTimer *pTimer,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PSSMHANDLE pSSM)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync TMR3TimerSave(pTimer->pTimerR3, pSSM);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU8 (pSSM, pTimer->u8Wrap);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU64 (pSSM, pTimer->u64Config);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU64 (pSSM, pTimer->u64Cmp);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU64 (pSSM, pTimer->u64Fsb);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU64 (pSSM, pTimer->u64Period);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic int hpetLoadTimer(HpetTimer *pTimer,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PSSMHANDLE pSSM)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync TMR3TimerLoad(pTimer->pTimerR3, pSSM);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3GetU8(pSSM, &pTimer->u8Wrap);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3GetU64(pSSM, &pTimer->u64Config);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3GetU64(pSSM, &pTimer->u64Cmp);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3GetU64(pSSM, &pTimer->u64Fsb);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3GetU64(pSSM, &pTimer->u64Period);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic DECLCALLBACK(int) hpetLiveExec(PPDMDEVINS pDevIns, PSSMHANDLE pSSM, uint32_t uPass)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState *);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU8(pSSM, HPET_NUM_TIMERS);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SSM_DONT_CALL_AGAIN;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic DECLCALLBACK(int) hpetSaveExec(PPDMDEVINS pDevIns,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PSSMHANDLE pSSM)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState *);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t iTimer;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* The config. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetLiveExec(pDevIns, pSSM, SSM_PASS_FINAL);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync for (iTimer = 0; iTimer < HPET_NUM_TIMERS; iTimer++)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = hpetSaveTimer(&pThis->aTimers[iTimer], pSSM);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync AssertRCReturn(rc, rc);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU64(pSSM, pThis->u64HpetOffset);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU64(pSSM, pThis->u64Capabilities);

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync SSMR3PutU64(pSSM, pThis->u64HpetConfig);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU64(pSSM, pThis->u64Isr);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3PutU64(pSSM, pThis->u64HpetCounter);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic DECLCALLBACK(int) hpetLoadExec(PPDMDEVINS pDevIns,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PSSMHANDLE pSSM,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t uVersion,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t uPass)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState *);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t iTimer;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (uVersion == HPET_SAVED_STATE_VERSION_EMPTY)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (uVersion != HPET_SAVED_STATE_VERSION)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VERR_SSM_UNSUPPORTED_DATA_UNIT_VERSION;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint8_t u8NumTimers;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = SSMR3GetU8(pSSM, &u8NumTimers); AssertRCReturn(rc, rc);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (u8NumTimers != HPET_NUM_TIMERS)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return SSMR3SetCfgError(pSSM, RT_SRC_POS, N_("Config mismatch - wrong number of timers: saved=%#x config=%#x"), u8NumTimers, HPET_NUM_TIMERS);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (uPass != SSM_PASS_FINAL)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync for (iTimer = 0; iTimer < HPET_NUM_TIMERS; iTimer++)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = hpetLoadTimer(&pThis->aTimers[iTimer], pSSM);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync AssertRCReturn(rc, rc);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3GetU64(pSSM, &pThis->u64HpetOffset);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3GetU64(pSSM, &pThis->u64Capabilities);

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync SSMR3GetU64(pSSM, &pThis->u64HpetConfig);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3GetU64(pSSM, &pThis->u64Isr);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync SSMR3GetU64(pSSM, &pThis->u64HpetCounter);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsyncstatic void hpetIrqUpdate(struct HpetTimer *pTimer)

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync{

af5224eb6b6676bc892a3f5abeb21f602547d31cvboxsync uint32_t irq = getTimerIrq(pTimer);

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync HpetState* pThis = pTimer->CTX_SUFF(pHpet);

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync /** @todo: is it correct? */

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync if (!!(pTimer->u64Config & HPET_TN_ENABLE) &&

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync !!(pThis->u64HpetConfig & HPET_CFG_ENABLE))

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync {

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync Log4(("HPET: raising IRQ %d\n", irq));

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync /* ISR bits are only set in level-triggered mode */

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync if ((pTimer->u64Config & HPET_TN_INT_TYPE) == HPET_TIMER_TYPE_LEVEL)

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync pThis->u64Isr |= (uint64_t)(1 << pTimer->u8TimerNumber);

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync /* We trigger flip/flop in edge-triggered mode and do nothing in level-triggered mode yet */

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync if ((pTimer->u64Config & HPET_TN_INT_TYPE) == HPET_TIMER_TYPE_EDGE)

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync pThis->pHpetHlpR3->pfnSetIrq(pThis->CTX_SUFF(pDevIns), irq, PDM_IRQ_LEVEL_FLIP_FLOP);

af5224eb6b6676bc892a3f5abeb21f602547d31cvboxsync else

af5224eb6b6676bc892a3f5abeb21f602547d31cvboxsync Assert(false);

9b7ab382b3f9667e8847020e1e58f7143c4d2334vboxsync /* @todo: implement IRQs in level-triggered mode */

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync }

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync}

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic DECLCALLBACK(void) hpetTimer(PPDMDEVINS pDevIns,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PTMTIMER pTmTimer,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync void * pvUser)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState *);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetTimer *pTimer = (HpetTimer *)pvUser;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Period = pTimer->u64Period;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64CurTick = hpetGetTicks(pThis);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint64_t u64Diff;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (pTimer == NULL)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync /* Lock in R3 must either block or succeed */

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync rc = hpetLock(pThis, VERR_IGNORED);

5045ab9ca39fa0b301f4020b7a072406eb0ecea2vboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync AssertLogRelRCReturnVoid(rc);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if ((pTimer->u64Config & HPET_TN_PERIODIC) && (u64Period != 0))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetAdjustComparator(pTimer, u64CurTick);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64Diff = hpetComputeDiff(pTimer, u64CurTick);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Log4(("HPET: periodical: next in %lld\n", hpetTicksToNs(u64Diff)));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync TMTimerSetNano(pTmTimer, hpetTicksToNs(u64Diff));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync else if ((pTimer->u64Config & HPET_TN_32BIT) &&

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync !(pTimer->u64Config & HPET_TN_PERIODIC))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (pTimer->u8Wrap)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync u64Diff = hpetComputeDiff(pTimer, u64CurTick);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync TMTimerSetNano(pTmTimer, hpetTicksToNs(u64Diff));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u8Wrap = 0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Should it really be under lock, does it really matter? */

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync hpetIrqUpdate(pTimer);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetUnlock(pThis);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic DECLCALLBACK(void) hpetRelocate(PPDMDEVINS pDevIns, RTGCINTPTR offDelta)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState *);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync unsigned i;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync LogFlow(("hpetRelocate:\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pDevInsRC = PDMDEVINS_2_RCPTR(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pHpetHlpRC = pThis->pHpetHlpR3->pfnGetRCHelpers(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync for (i = 0; i < RT_ELEMENTS(pThis->aTimers); i++)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetTimer *pTm = &pThis->aTimers[i];

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (pTm->pTimerR3)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTm->pTimerRC = TMTimerRCPtr(pTm->pTimerR3);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTm->pHpetRC = PDMINS_2_DATA_RCPTR(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic DECLCALLBACK(void) hpetReset(PPDMDEVINS pDevIns)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState *);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync unsigned i;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync LogFlow(("hpetReset:\n"));

3614117c1132a61599e6190939e775cafe549411vboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync pThis->u64HpetConfig = 0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync for (i = 0; i < HPET_NUM_TIMERS; i++)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetTimer *pTimer = &pThis->aTimers[i];

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u8TimerNumber = i;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u64Cmp = ~0ULL;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* capable of periodic operations and 64-bits */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u64Config = HPET_TN_PERIODIC_CAP | HPET_TN_SIZE_CAP;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* We can do all IRQs */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t u32RoutingCap = 0xffffffff;

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync pTimer->u64Config |= ((uint64_t)u32RoutingCap) << 32;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u64Period = 0ULL;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pTimer->u8Wrap = 0;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->u64HpetCounter = 0ULL;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->u64HpetOffset = 0ULL;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* 64-bit main counter; 3 timers supported; LegacyReplacementRoute. */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t u32Vendor = 0x8086;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync uint32_t u32Caps =

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync (1 << 15) /* LEG_RT_CAP, LegacyReplacementRoute capable */ |

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync (1 << 13) /* COUNTER_SIZE_CAP, main counter is 64-bit capable */ |

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync ((HPET_NUM_TIMERS-1) << 8) /* NUM_TIM_CAP, number of timers -1 */ |

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync 1 /* REV_ID, revision, must not be 0 */;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->u64Capabilities = (u32Vendor << 16) | u32Caps;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->u64Capabilities |= ((uint64_t)(HPET_CLK_PERIOD) << 32);

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync /* Notify PIT/RTC devices */

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync hpetLegacyMode(pThis, false);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic int hpetInit(PPDMDEVINS pDevIns)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync unsigned i;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState *);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync memset(pThis, 0, sizeof(*pThis));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pDevInsR3 = pDevIns;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pDevInsR0 = PDMDEVINS_2_R0PTR(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pDevInsRC = PDMDEVINS_2_RCPTR(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync for (i = 0; i < HPET_NUM_TIMERS; i++)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetTimer *timer = &pThis->aTimers[i];

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync timer->pHpetR3 = pThis;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync timer->pHpetR0 = PDMINS_2_DATA_R0PTR(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync timer->pHpetRC = PDMINS_2_DATA_RCPTR(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = PDMDevHlpTMTimerCreate(pDevIns, TMCLOCK_VIRTUAL_SYNC, hpetTimer, timer,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync TMTIMER_FLAGS_DEFAULT_CRIT_SECT, "HPET Timer",

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync &pThis->aTimers[i].pTimerR3);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->aTimers[i].pTimerRC = TMTimerRCPtr(pThis->aTimers[i].pTimerR3);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->aTimers[i].pTimerR0 = TMTimerR0Ptr(pThis->aTimers[i].pTimerR3);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetReset(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic DECLCALLBACK(void) hpetInfo(PPDMDEVINS pDevIns, PCDBGFINFOHLP pHlp, const char *pszArgs)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState *);

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync int i;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pHlp->pfnPrintf(pHlp,

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync "HPET status:\n"

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync " config = %016RX64\n"

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync " offset = %016RX64 counter = %016RX64 isr = %016RX64\n"

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync " legacy mode is %s\n",

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync pThis->u64HpetConfig,

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync pThis->u64HpetOffset, pThis->u64HpetCounter, pThis->u64Isr,

762a68c2bb3ccde807330e3d1cb05f8b244a5f72vboxsync !!(pThis->u64HpetConfig & HPET_CFG_LEGACY) ? "on" : "off");

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync pHlp->pfnPrintf(pHlp,

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync "Timers:\n");

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync for (i = 0; i < HPET_NUM_TIMERS; i++)

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync {

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync pHlp->pfnPrintf(pHlp, " %d: comparator=%016RX64 period(hidden)=%016RX64 cfg=%016RX64\n",

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync pThis->aTimers[i].u8TimerNumber,

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync pThis->aTimers[i].u64Cmp,

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync pThis->aTimers[i].u64Period,

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync pThis->aTimers[i].u64Config);

23603ed361f22874964e3a841add2c58ec2bb1eavboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncstatic DECLCALLBACK(int) hpetConstruct(PPDMDEVINS pDevIns, int iInstance, PCFGMNODE pCfg)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetState *pThis = PDMINS_2_DATA(pDevIns, HpetState *);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync int rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync bool fRCEnabled = false;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync bool fR0Enabled = false;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PDMHPETREG HpetReg;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Only one HPET device now */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync Assert(iInstance == 0);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /*

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (!CFGMR3AreValuesValid(pCfg, "GCEnabled\0" "R0Enabled\0"))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VERR_PDM_DEVINS_UNKNOWN_CFG_VALUES;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Query configuration. */

ff03d550549cfd2458dcac64202de635eb8d07cdvboxsync#if 1

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = CFGMR3QueryBoolDef(pCfg, "GCEnabled", &fRCEnabled, true);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return PDMDEV_SET_ERROR(pDevIns, rc,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync N_("Configuration error: Querying \"GCEnabled\" as a bool failed"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = CFGMR3QueryBoolDef(pCfg, "R0Enabled", &fR0Enabled, true);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return PDMDEV_SET_ERROR(pDevIns, rc,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync N_("Configuration error: failed to read R0Enabled as boolean"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync#endif

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Initialize the device state */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = hpetInit(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pDevInsR3 = pDevIns;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pDevInsR0 = PDMDEVINS_2_R0PTR(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pDevInsRC = PDMDEVINS_2_RCPTR(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /*

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync HpetReg.u32Version = PDM_HPETREG_VERSION;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = PDMDevHlpHPETRegister(pDevIns, &HpetReg, &pThis->pHpetHlpR3);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync AssertMsgRC(rc, ("Cannot HPETRegister: %Rrc\n", rc));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync /*

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync rc = PDMDevHlpCritSectInit(pDevIns, &pThis->csLock, RT_SRC_POS, "HPET");

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync if (RT_FAILURE(rc))

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync return PDMDEV_SET_ERROR(pDevIns, rc, N_("HPET cannot initialize critical section"));

9540eeb13face31ddc1c5f15338556fe46f18a77vboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /*

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = PDMDevHlpMMIORegister(pDevIns, HPET_BASE, 0x1000, pThis,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetMMIOWrite, hpetMMIORead, NULL, "HPET Memory");

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync AssertMsgRC(rc, ("Cannot register MMIO: %Rrc\n", rc));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (fRCEnabled)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = PDMDevHlpMMIORegisterRC(pDevIns, HPET_BASE, 0x1000, 0,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync "hpetMMIOWrite", "hpetMMIORead", NULL);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pHpetHlpRC = pThis->pHpetHlpR3->pfnGetRCHelpers(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (!pThis->pHpetHlpRC)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync AssertReleaseMsgFailed(("cannot get RC helper\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VERR_INTERNAL_ERROR;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (fR0Enabled)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = PDMDevHlpMMIORegisterR0(pDevIns, HPET_BASE, 0x1000, 0,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync "hpetMMIOWrite", "hpetMMIORead", NULL);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync pThis->pHpetHlpR0 = pThis->pHpetHlpR3->pfnGetR0Helpers(pDevIns);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (!pThis->pHpetHlpR0)

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync {

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync AssertReleaseMsgFailed(("cannot get R0 helper\n"));

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VERR_INTERNAL_ERROR;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync }

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* Register SSM callbacks */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync rc = PDMDevHlpSSMRegister3(pDevIns, HPET_SAVED_STATE_VERSION, sizeof(*pThis), hpetLiveExec, hpetSaveExec, hpetLoadExec);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync if (RT_FAILURE(rc))

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return rc;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /**

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PDMDevHlpDBGFInfoRegister(pDevIns, "hpet", "Display HPET status. (no arguments)", hpetInfo);

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync return VINF_SUCCESS;

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync}

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsyncconst PDMDEVREG g_DeviceHPET =

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync{

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* u32Version */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PDM_DEVREG_VERSION,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* szName */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync "hpet",

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* szRCMod */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync "VBoxDDGC.gc",

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* szR0Mod */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync "VBoxDDR0.r0",

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* pszDescription */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync " High Precision Event Timer (HPET) Device",

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* fFlags */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PDM_DEVREG_FLAGS_HOST_BITS_DEFAULT | PDM_DEVREG_FLAGS_GUEST_BITS_32_64 | PDM_DEVREG_FLAGS_PAE36 | PDM_DEVREG_FLAGS_RC | PDM_DEVREG_FLAGS_R0,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* fClass */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync PDM_DEVREG_CLASS_PIT,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* cMaxInstances */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync 1,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* cbInstance */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync sizeof(HpetState),

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* pfnConstruct */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetConstruct,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* pfnDestruct */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync NULL,

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync /* pfnRelocate */

016096e367cd20c3d3c3fd9a6650b55935c2e31dvboxsync hpetRelocate,