mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-16 08:38:26 +00:00
emulation: ticktimer: add msleep support
Signed-off-by: Sean Cross <sean@xobs.io>
This commit is contained in:
parent
d8733a437c
commit
e3dbf1e9d4
1 changed files with 70 additions and 6 deletions
|
|
@ -24,6 +24,7 @@ namespace Antmicro.Renode.Peripherals.Timers
|
||||||
public TickTimer(Machine machine, ulong periodInMs) : base(machine)
|
public TickTimer(Machine machine, ulong periodInMs) : base(machine)
|
||||||
{
|
{
|
||||||
machine.ClockSource.AddClockEntry(new ClockEntry(periodInMs, ClockEntry.FrequencyToRatio(this, 1000), OnTick, this, "TickTimer"));
|
machine.ClockSource.AddClockEntry(new ClockEntry(periodInMs, ClockEntry.FrequencyToRatio(this, 1000), OnTick, this, "TickTimer"));
|
||||||
|
this.IRQ = new GPIO();
|
||||||
DefineRegisters();
|
DefineRegisters();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -32,23 +33,37 @@ namespace Antmicro.Renode.Peripherals.Timers
|
||||||
base.Reset();
|
base.Reset();
|
||||||
tickValue = 0;
|
tickValue = 0;
|
||||||
paused = true;
|
paused = true;
|
||||||
|
msleepTarget = 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
private void OnTick()
|
private void OnTick()
|
||||||
{
|
{
|
||||||
if (!paused) {
|
if (!paused)
|
||||||
Interlocked.Increment(ref tickValue);
|
{
|
||||||
|
this.irqStatus = Interlocked.Increment(ref tickValue) >= (long)this.msleepTarget;
|
||||||
|
this.UpdateInterrupts();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
public long Size { get { return 0x20; }}
|
private void UpdateInterrupts()
|
||||||
|
{
|
||||||
|
if (this.irqStatus && this.irqEnabled.Value)
|
||||||
|
{
|
||||||
|
this.irqPending.Value = true;
|
||||||
|
}
|
||||||
|
this.Log(LogLevel.Noisy, "Setting IRQ: {0}", irqPending.Value);
|
||||||
|
IRQ.Set(irqPending.Value && irqEnabled.Value);
|
||||||
|
}
|
||||||
|
|
||||||
|
public long Size { get { return 0x20; } }
|
||||||
|
|
||||||
private void DefineRegisters()
|
private void DefineRegisters()
|
||||||
{
|
{
|
||||||
Registers.Control.Define32(this)
|
Registers.Control.Define32(this)
|
||||||
.WithValueField(0, 32, name: "CONTROL", writeCallback: (_, val) =>
|
.WithValueField(0, 32, name: "CONTROL", writeCallback: (_, val) =>
|
||||||
{
|
{
|
||||||
if ((val & 1) != 0) {
|
if ((val & 1) != 0)
|
||||||
|
{
|
||||||
tickValue = 0;
|
tickValue = 0;
|
||||||
}
|
}
|
||||||
paused = (val & 2) != 0;
|
paused = (val & 2) != 0;
|
||||||
|
|
@ -58,26 +73,75 @@ namespace Antmicro.Renode.Peripherals.Timers
|
||||||
Registers.Time1.Define32(this)
|
Registers.Time1.Define32(this)
|
||||||
.WithValueField(0, 32, FieldMode.Read, name: "Time1", valueProviderCallback: _ =>
|
.WithValueField(0, 32, FieldMode.Read, name: "Time1", valueProviderCallback: _ =>
|
||||||
{
|
{
|
||||||
return (uint) (tickValue >> 32);
|
return (uint)(tickValue >> 32);
|
||||||
})
|
})
|
||||||
;
|
;
|
||||||
|
|
||||||
Registers.Time0.Define32(this)
|
Registers.Time0.Define32(this)
|
||||||
.WithValueField(0, 32, FieldMode.Read, name: "Time0", valueProviderCallback: _ =>
|
.WithValueField(0, 32, FieldMode.Read, name: "Time0", valueProviderCallback: _ =>
|
||||||
{
|
{
|
||||||
return (uint) (tickValue >> 0);
|
return (uint)(tickValue >> 0);
|
||||||
})
|
})
|
||||||
;
|
;
|
||||||
|
|
||||||
|
Registers.MsleepTarget1.Define32(this)
|
||||||
|
.WithValueField(0, 32, name: "MsleepTarget1", writeCallback: (_, value) =>
|
||||||
|
{
|
||||||
|
this.msleepTarget = (this.msleepTarget & 0x00000000ffffffff) | (value << 32);
|
||||||
|
this.Log(LogLevel.Noisy, "Setting sleep target 1: {0}, sleep target now: {1}", value, this.msleepTarget);
|
||||||
|
},
|
||||||
|
valueProviderCallback: _ =>
|
||||||
|
{
|
||||||
|
return (uint)(this.msleepTarget >> 32);
|
||||||
|
})
|
||||||
|
;
|
||||||
|
|
||||||
|
Registers.MsleepTarget0.Define32(this)
|
||||||
|
.WithValueField(0, 32, name: "MsleepTarget0",
|
||||||
|
writeCallback: (_, value) =>
|
||||||
|
{
|
||||||
|
this.msleepTarget = (this.msleepTarget & 0xffffffff00000000) | (value & 0xffffffff);
|
||||||
|
this.Log(LogLevel.Noisy, "Setting sleep target 0: {0}, sleep target now: {1}", value, this.msleepTarget);
|
||||||
|
},
|
||||||
|
valueProviderCallback: _ =>
|
||||||
|
{
|
||||||
|
return (uint)(this.msleepTarget >> 0);
|
||||||
|
})
|
||||||
|
;
|
||||||
|
|
||||||
|
Registers.EventStatus.Define32(this)
|
||||||
|
.WithFlag(0, FieldMode.Read, name: "EV_STATUS", valueProviderCallback: _ => irqStatus)
|
||||||
|
;
|
||||||
|
|
||||||
|
Registers.EventPending.Define32(this)
|
||||||
|
.WithFlag(0, out irqPending, FieldMode.Read | FieldMode.WriteOneToClear, name: "EV_PENDING", changeCallback: (_, __) => UpdateInterrupts())
|
||||||
|
;
|
||||||
|
|
||||||
|
Registers.EventEnable.Define32(this)
|
||||||
|
.WithFlag(0, out irqEnabled, name: "EV_ENABLE", changeCallback: (_, __) => UpdateInterrupts())
|
||||||
|
;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
private IFlagRegisterField irqEnabled;
|
||||||
|
private IFlagRegisterField irqPending;
|
||||||
|
private bool irqStatus;
|
||||||
|
|
||||||
bool paused;
|
bool paused;
|
||||||
long tickValue;
|
long tickValue;
|
||||||
|
ulong msleepTarget;
|
||||||
|
public GPIO IRQ { get; private set; }
|
||||||
|
|
||||||
private enum Registers
|
private enum Registers
|
||||||
{
|
{
|
||||||
Control = 0x00,
|
Control = 0x00,
|
||||||
Time1 = 0x04,
|
Time1 = 0x04,
|
||||||
Time0 = 0x08,
|
Time0 = 0x08,
|
||||||
|
MsleepTarget1 = 0x0c,
|
||||||
|
MsleepTarget0 = 0x10,
|
||||||
|
EventStatus = 0x14,
|
||||||
|
EventPending = 0x18,
|
||||||
|
EventEnable = 0x1c,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue