442 lines
15 KiB
C#
442 lines
15 KiB
C#
//============================================================================
|
||
// 作者：liuwenbo
|
||
// 日期：2026-03-24-2026-03-25
|
||
//============================================================================
|
||
|
||
using System;
|
||
using System.Collections.Generic;
|
||
using System.Collections.ObjectModel;
|
||
using Antmicro.Renode.Core;
|
||
using Antmicro.Renode.Core.Structure.Registers;
|
||
using Antmicro.Renode.Logging;
|
||
using Antmicro.Renode.Peripherals.Bus;
|
||
using Antmicro.Renode.Time;
|
||
using Antmicro.Renode.Peripherals;
|
||
using Antmicro.Renode.Peripherals.Timers;
|
||
using Antmicro.Renode.Peripherals.IRQControllers;
|
||
|
||
namespace Antmicro.Renode.Peripherals.Timers
|
||
{
|
||
public class LC3233_TaskTimer : BasicDoubleWordPeripheral, IKnownSize
|
||
{
|
||
public LC3233_TaskTimer(IMachine machine) : base(machine)
|
||
{
|
||
this.machine = machine;
|
||
|
||
DefineRegisters();
|
||
Reset();
|
||
|
||
this.Log(LogLevel.Info, "LC3233 定时器已初始化 @ 0x80000000");
|
||
this.Log(LogLevel.Info, " 周期: 250ms (4Hz), 用于VxWorks任务调度");
|
||
}
|
||
|
||
private void ScheduleNextTick()
|
||
{
|
||
if(timerScheduled || (timerCtrl & TIMER_CTRL_T0_EN) == 0)
|
||
{
|
||
return;
|
||
}
|
||
|
||
timerScheduled = true;
|
||
var generation = timerGeneration;
|
||
machine.ScheduleAction(TimeInterval.FromMilliseconds(250), _ =>
|
||
{
|
||
timerScheduled = false;
|
||
|
||
if(generation != timerGeneration || (timerCtrl & TIMER_CTRL_T0_EN) == 0)
|
||
{
|
||
return;
|
||
}
|
||
|
||
OnTimerExpired();
|
||
});
|
||
}
|
||
|
||
private void OnTimerExpired()
|
||
{
|
||
timerExpiredCount++;
|
||
|
||
//isPending = true;
|
||
|
||
this.Log(LogLevel.Info, "========== 定时器溢出 #{0} ==========", timerExpiredCount);
|
||
this.Log(LogLevel.Info, "准备触发中断线4...");
|
||
|
||
IRQ.Set(true);
|
||
|
||
this.Log(LogLevel.Info, "已调用 IRQ.Set(true)，信号应发送到 lc3233IntCtrl@4");
|
||
|
||
machine.ScheduleAction(TimeInterval.FromMicroseconds(1),
|
||
_ => {
|
||
IRQ.Set(false);
|
||
this.Log(LogLevel.Debug, "中断脉冲结束");
|
||
});
|
||
|
||
|
||
if ((timerCtrl & TIMER_CTRL_T0_LOEN) != 0)
|
||
{
|
||
timer0Cntr = timer0Reld;
|
||
ScheduleNextTick();
|
||
}
|
||
}
|
||
|
||
private void DefineRegisters()
|
||
{
|
||
|
||
Registers.TimerCtrl.Define(this)
|
||
.WithValueField(0, 32, name: "timer_ctrl",
|
||
writeCallback: (_, val) =>
|
||
{
|
||
timerCtrl = (uint)val;
|
||
|
||
// Bit 0: Timer0 Enable
|
||
bool t0Enable = (val & TIMER_CTRL_T0_EN) != 0;
|
||
if(!t0Enable)
|
||
{
|
||
timerGeneration++;
|
||
timerScheduled = false;
|
||
}
|
||
else
|
||
{
|
||
timerGeneration++;
|
||
timerScheduled = false;
|
||
ScheduleNextTick();
|
||
}
|
||
|
||
this.Log(LogLevel.Info, "TIMER_CTRL 写入: 0x{0:X8}", val);
|
||
this.Log(LogLevel.Info, " Timer0 Enable: {0}", t0Enable);
|
||
this.Log(LogLevel.Info, " Auto Reload: {0}", (val & TIMER_CTRL_T0_LOEN) != 0);
|
||
},
|
||
valueProviderCallback: _ => timerCtrl);
|
||
|
||
Registers.Timer0Cntr.Define(this)
|
||
.WithValueField(0, 32, name: "timer0_cntr",
|
||
writeCallback: (_, val) =>
|
||
{
|
||
timer0Cntr = (uint)val;
|
||
this.Log(LogLevel.Debug, "TIMER0_CNTR 写入: 0x{0:X8}", val);
|
||
},
|
||
valueProviderCallback: _ => timer0Cntr);
|
||
|
||
Registers.Timer0Reld.Define(this)
|
||
.WithValueField(0, 32, name: "timer0_reld",
|
||
writeCallback: (_, val) =>
|
||
{
|
||
timer0Reld = (uint)val;
|
||
this.Log(LogLevel.Debug, "TIMER0_RELD 写入: 0x{0:X8}", val);
|
||
},
|
||
valueProviderCallback: _ => timer0Reld);
|
||
|
||
Registers.Timer0DivFreq.Define(this)
|
||
.WithValueField(0, 32, name: "timer0_divfreq",
|
||
writeCallback: (_, val) =>
|
||
{
|
||
timer0DivFreq = (uint)val;
|
||
this.Log(LogLevel.Debug, "TIMER0_DIVFREQ 写入: 0x{0:X8}", val);
|
||
},
|
||
valueProviderCallback: _ => timer0DivFreq);
|
||
|
||
Registers.Timer0DfReld.Define(this)
|
||
.WithValueField(0, 32, name: "timer0_df_reld",
|
||
writeCallback: (_, val) =>
|
||
{
|
||
timer0DfReld = (uint)val;
|
||
this.Log(LogLevel.Debug, "TIMER0_DF_RELD 写入: 0x{0:X8}", val);
|
||
},
|
||
valueProviderCallback: _ => timer0DfReld);
|
||
}
|
||
|
||
public override void Reset()
|
||
{
|
||
base.Reset();
|
||
timerCtrl = TIMER_CTRL_T0_EN | TIMER_CTRL_T0_LOEN;
|
||
timer0Cntr = 0;
|
||
timer0Reld = 0;
|
||
timer0DivFreq = 0;
|
||
timer0DfReld = 0;
|
||
isPending = false;
|
||
timerExpiredCount = 0;
|
||
timerGeneration++;
|
||
timerScheduled = false;
|
||
ScheduleNextTick();
|
||
}
|
||
|
||
public long Size => 0x100;
|
||
|
||
|
||
public GPIO IRQ { get; } = new GPIO();
|
||
|
||
|
||
private enum Registers
|
||
{
|
||
TimerCtrl = 0x00,
|
||
Timer0Cntr = 0x04,
|
||
Timer0Reld = 0x08,
|
||
WdgCntr = 0x0C,
|
||
Timer1Cntr = 0x10,
|
||
Timer1Reld = 0x14,
|
||
Timer0DivFreq = 0x18,
|
||
Timer0DfReld = 0x1C,
|
||
}
|
||
|
||
private const uint TIMER_CTRL_T0_EN = 0x00000001;
|
||
private const uint TIMER_CTRL_T0_LOEN = 0x00000002;
|
||
private const uint TIMER_CTRL_T0_RSTA = 0x00000004;
|
||
|
||
|
||
private readonly IMachine machine;
|
||
private uint timerCtrl;
|
||
private uint timer0Cntr;
|
||
private uint timer0Reld;
|
||
private uint timer0DivFreq;
|
||
private uint timer0DfReld;
|
||
private bool isPending;
|
||
private bool timerScheduled;
|
||
private ulong timerGeneration;
|
||
private ulong timerExpiredCount;
|
||
}
|
||
}
|
||
|
||
namespace Antmicro.Renode.Peripherals.IRQControllers
|
||
{
|
||
|
||
public class LC3233_InterruptController : BasicDoubleWordPeripheral, IKnownSize, INumberedGPIOOutput, IGPIOReceiver
|
||
{
|
||
|
||
public LC3233_InterruptController(IMachine machine) : base(machine)
|
||
{
|
||
this.machine = machine;
|
||
|
||
|
||
connections = new Dictionary<int, IGPIO>();
|
||
for (int i = 0; i <= 15; i++)
|
||
{
|
||
connections[i] = new GPIO();
|
||
}
|
||
|
||
Connections = new ReadOnlyDictionary<int, IGPIO>(connections);
|
||
DefineRegisters();
|
||
Reset();
|
||
|
||
this.Log(LogLevel.Info, "LC3233 中断控制器已初始化 @ 0x80020000");
|
||
this.Log(LogLevel.Info, " 管理15个中断源 (1-15)");
|
||
}
|
||
|
||
|
||
|
||
/// <summary>
|
||
/// 定义寄存器映射
|
||
/// </summary>
|
||
private void DefineRegisters()
|
||
{
|
||
|
||
// Registers.IntMaskPriority.Define(this)
|
||
// .WithValueField(0, 32, name: "int_mask_priority",
|
||
// writeCallback: (_, val) =>
|
||
// {
|
||
// intMaskPriority = (uint)val;
|
||
// this.Log(LogLevel.Info, "INT_MASK_PRIORITY 写入: 0x{0:X8}", val);
|
||
// this.Log(LogLevel.Info, " 临时兼容: IRQ4 强制视为使能");
|
||
|
||
|
||
// for (int i = 1; i <= 15; i++)
|
||
// {
|
||
// if ((val & (uint)(1 << i)) != 0)
|
||
// {
|
||
// this.Log(LogLevel.Debug, " 中断 {0} 已使能", i);
|
||
// }
|
||
// }
|
||
|
||
// UpdateInterrupts();
|
||
// },
|
||
// valueProviderCallback: _ => intMaskPriority);
|
||
|
||
|
||
// Registers.IntFTP.Define(this)
|
||
// .WithValueField(0, 32, name: "int_f_t_p",
|
||
// writeCallback: (_, val) =>
|
||
// {
|
||
|
||
// intFTP |= (uint)val;
|
||
// this.Log(LogLevel.Debug, "INT_F_T_P 写入: 0x{0:X8}, 当前值: 0x{1:X8}", val, intFTP);
|
||
// UpdateInterrupts();
|
||
// },
|
||
// valueProviderCallback: _ => intFTP);
|
||
|
||
|
||
// Registers.IntForce.Define(this)
|
||
// .WithValueField(0, 32, FieldMode.Write, name: "int_force",
|
||
// writeCallback: (_, val) =>
|
||
// {
|
||
// this.Log(LogLevel.Info, "INT_FORCE 写入: 0x{0:X8}", val);
|
||
|
||
|
||
// intFTP |= (uint)val;
|
||
|
||
// UpdateInterrupts();
|
||
// });
|
||
|
||
|
||
// Registers.IntClr.Define(this)
|
||
// .WithValueField(0, 32, FieldMode.Write, name: "int_clr",
|
||
// writeCallback: (_, val) =>
|
||
// {
|
||
// this.Log(LogLevel.Debug, "INT_CLR 写入: 0x{0:X8}", val);
|
||
|
||
|
||
// intFTP &= ~(uint)val;
|
||
|
||
// UpdateInterrupts();
|
||
// });
|
||
}
|
||
|
||
|
||
public void OnGPIO(int irq, bool value)
|
||
{
|
||
|
||
if (irq < 0 || irq > 15)
|
||
{
|
||
this.Log(LogLevel.Error, "无效的中断号: {0}", irq);
|
||
return;
|
||
}
|
||
|
||
if(value)
|
||
{
|
||
this.Log(LogLevel.Info, "*** 中断控制器接收到信号 IRQ{0}: {1} ***", irq, value ? "拉高" : "拉低");
|
||
|
||
// 自动使能中断
|
||
intMaskPriority |= (uint)(1 << irq);
|
||
this.Log(LogLevel.Info, "自动使能中断 {0}: INT_MASK_PRIORITY = 0x{1:X8}",
|
||
irq, intMaskPriority);
|
||
|
||
//设置挂起寄存器
|
||
intFTP |= (uint)(1 << irq);
|
||
this.Log(LogLevel.Info, "设置挂起位: INT_F_T_P = 0x{0:X8}", intFTP);
|
||
|
||
UpdateInterrupts();
|
||
|
||
}
|
||
|
||
else
|
||
{
|
||
|
||
}
|
||
|
||
//this.Log(LogLevel.Info, "调用 UpdateInterrupts() 检查是否转发到CPU...");
|
||
//UpdateInterrupts();
|
||
|
||
// if (irq < 0 || irq > 15)
|
||
// {
|
||
// this.Log(LogLevel.Error, "无效的中断号: {0}", irq);
|
||
// return;
|
||
// }
|
||
|
||
// this.Log(LogLevel.Info, "*** 中断控制器接收到信号 IRQ{0}: {1} ***", irq, value ? "拉高" : "拉低");
|
||
|
||
// if (value)
|
||
// {
|
||
|
||
// intFTP |= (uint)(1 << irq);
|
||
// this.Log(LogLevel.Info, "设置挂起位: INT_F_T_P = 0x{0:X8}", intFTP);
|
||
// }
|
||
// else
|
||
// {
|
||
|
||
// }
|
||
|
||
// this.Log(LogLevel.Info, "调用 UpdateInterrupts() 检查是否转发到CPU...");
|
||
// UpdateInterrupts();
|
||
}
|
||
|
||
private void UpdateInterrupts()
|
||
{
|
||
this.Log(LogLevel.Info, "调用 UpdateInterrupts() 检查是否转发到CPU...");
|
||
this.Log(LogLevel.Debug, "UpdateInterrupts: MASK=0x{0:X8}, PENDING=0x{1:X8}",
|
||
intMaskPriority, intFTP);
|
||
|
||
|
||
for (int i = 15; i > 0; i--)
|
||
{
|
||
//bool masked = ((intMaskPriority & (uint)(1 << i)) != 0) || (forceEnableIRQ4 && i == 4);
|
||
bool masked = ((intMaskPriority & (uint)(1 << i)) != 0);
|
||
bool pending = (intFTP & (uint)(1 << i)) != 0;
|
||
|
||
if (i == 5)
|
||
{
|
||
this.Log(LogLevel.Info, "IRQ{0} 状态检查: masked={1}, pending={2}", i, masked, pending);
|
||
}
|
||
|
||
if (i == 4)
|
||
{
|
||
this.Log(LogLevel.Info, "IRQ{0} 状态检查: masked={1}, pending={2}", i, masked, pending);
|
||
}
|
||
|
||
if (masked && pending)
|
||
{
|
||
|
||
if (Connections.TryGetValue(i, out var gpio))
|
||
{
|
||
gpio.Set(true);
|
||
this.Log(LogLevel.Info, "===> 转发中断 {0} 到MIC@{0} (CPU中断线{0})", i);
|
||
|
||
|
||
var localI = i;
|
||
machine.ScheduleAction(TimeInterval.FromMicroseconds(1),
|
||
_ => {
|
||
if (Connections.TryGetValue(localI, out var g))
|
||
{
|
||
g.Set(false);
|
||
machine.ScheduleAction(TimeInterval.FromMicroseconds(10),
|
||
_ => {
|
||
|
||
intFTP &= ~(uint)(1 << localI);
|
||
this.Log(LogLevel.Info, "*** 10us 安全期已过，自动清除中断 {0} 的挂起位 ***", localI);
|
||
UpdateInterrupts();
|
||
|
||
});
|
||
|
||
}
|
||
});
|
||
|
||
}
|
||
else
|
||
{
|
||
this.Log(LogLevel.Warning, "中断 {0} 无法转发: 连接未找到!", i);
|
||
}
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
|
||
public override void Reset()
|
||
{
|
||
base.Reset();
|
||
intMaskPriority = 0;
|
||
intFTP = 0;
|
||
intClr = 0;
|
||
}
|
||
|
||
public long Size => 0x10;
|
||
|
||
public IReadOnlyDictionary<int, IGPIO> Connections { get; }
|
||
|
||
|
||
private readonly IMachine machine;
|
||
private readonly Dictionary<int, IGPIO> connections;
|
||
private readonly Dictionary<IGPIO, int> gpioToIrqMap; // 字段声明
|
||
private readonly bool forceEnableIRQ4 = true;
|
||
private uint intMaskPriority;
|
||
private uint intFTP;
|
||
private uint intClr;
|
||
|
||
// 寄存器定义
|
||
private enum Registers
|
||
{
|
||
IntMaskPriority = 0x00,
|
||
IntFTP = 0x04,
|
||
IntForce = 0x08,
|
||
IntClr = 0x0C,
|
||
}
|
||
}
|
||
}
|