2018-02-25 20:14:58 -05:00
|
|
|
using ChocolArm64.Events;
|
2018-02-04 18:08:20 -05:00
|
|
|
using System;
|
2018-03-13 20:24:17 -04:00
|
|
|
using System.Diagnostics;
|
2018-09-19 11:16:20 -04:00
|
|
|
using System.Runtime.CompilerServices;
|
2018-05-11 19:10:27 -04:00
|
|
|
using System.Runtime.Intrinsics;
|
2018-02-04 18:08:20 -05:00
|
|
|
|
|
|
|
namespace ChocolArm64.State
|
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
public class CpuThreadState
|
2018-02-04 18:08:20 -05:00
|
|
|
{
|
2018-02-06 10:15:08 -05:00
|
|
|
internal const int ErgSizeLog2 = 4;
|
|
|
|
internal const int DczSizeLog2 = 4;
|
|
|
|
|
2018-09-19 11:16:20 -04:00
|
|
|
private const int MinInstForCheck = 4000000;
|
|
|
|
|
2018-05-26 16:49:21 -04:00
|
|
|
public bool Thumb;
|
|
|
|
|
2018-02-04 18:08:20 -05:00
|
|
|
public ulong X0, X1, X2, X3, X4, X5, X6, X7,
|
|
|
|
X8, X9, X10, X11, X12, X13, X14, X15,
|
|
|
|
X16, X17, X18, X19, X20, X21, X22, X23,
|
|
|
|
X24, X25, X26, X27, X28, X29, X30, X31;
|
|
|
|
|
2018-05-11 19:10:27 -04:00
|
|
|
public Vector128<float> V0, V1, V2, V3, V4, V5, V6, V7,
|
|
|
|
V8, V9, V10, V11, V12, V13, V14, V15,
|
|
|
|
V16, V17, V18, V19, V20, V21, V22, V23,
|
|
|
|
V24, V25, V26, V27, V28, V29, V30, V31;
|
2018-02-04 18:08:20 -05:00
|
|
|
|
|
|
|
public bool Overflow;
|
|
|
|
public bool Carry;
|
|
|
|
public bool Zero;
|
|
|
|
public bool Negative;
|
|
|
|
|
2019-01-24 20:59:53 -05:00
|
|
|
public bool IsAarch32;
|
|
|
|
|
|
|
|
public int ElrHyp;
|
|
|
|
|
2018-03-12 00:04:52 -04:00
|
|
|
public bool Running { get; set; }
|
2018-09-18 19:36:43 -04:00
|
|
|
public int Core { get; set; }
|
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
private bool _interrupted;
|
2018-03-12 00:04:52 -04:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
private int _syncCount;
|
2018-09-19 11:16:20 -04:00
|
|
|
|
2018-02-06 10:15:08 -05:00
|
|
|
public long TpidrEl0 { get; set; }
|
|
|
|
public long Tpidr { get; set; }
|
2018-02-04 18:08:20 -05:00
|
|
|
|
2018-02-06 10:15:08 -05:00
|
|
|
public int Fpcr { get; set; }
|
|
|
|
public int Fpsr { get; set; }
|
2018-02-04 18:08:20 -05:00
|
|
|
|
2018-06-26 00:09:32 -04:00
|
|
|
public int Psr
|
|
|
|
{
|
|
|
|
get
|
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
return (Negative ? (int)PState.N : 0) |
|
|
|
|
(Zero ? (int)PState.Z : 0) |
|
|
|
|
(Carry ? (int)PState.C : 0) |
|
|
|
|
(Overflow ? (int)PState.V : 0);
|
2018-06-26 00:09:32 -04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2018-02-06 10:15:08 -05:00
|
|
|
public uint CtrEl0 => 0x8444c004;
|
|
|
|
public uint DczidEl0 => 0x00000004;
|
2018-02-04 18:08:20 -05:00
|
|
|
|
2018-03-13 20:24:17 -04:00
|
|
|
public ulong CntfrqEl0 { get; set; }
|
|
|
|
public ulong CntpctEl0
|
|
|
|
{
|
|
|
|
get
|
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
double ticks = _tickCounter.ElapsedTicks * _hostTickFreq;
|
2018-02-11 22:37:20 -05:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
return (ulong)(ticks * CntfrqEl0);
|
2018-03-13 20:24:17 -04:00
|
|
|
}
|
|
|
|
}
|
2018-02-04 18:08:20 -05:00
|
|
|
|
2018-11-01 00:22:09 -04:00
|
|
|
public event EventHandler<EventArgs> Interrupt;
|
2018-10-30 21:43:02 -04:00
|
|
|
public event EventHandler<InstExceptionEventArgs> Break;
|
|
|
|
public event EventHandler<InstExceptionEventArgs> SvcCall;
|
|
|
|
public event EventHandler<InstUndefinedEventArgs> Undefined;
|
2018-02-10 08:24:16 -05:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
private static Stopwatch _tickCounter;
|
2018-03-13 20:24:17 -04:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
private static double _hostTickFreq;
|
2018-03-13 20:24:17 -04:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
static CpuThreadState()
|
2018-03-13 20:24:17 -04:00
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
_hostTickFreq = 1.0 / Stopwatch.Frequency;
|
2018-03-13 20:24:17 -04:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
_tickCounter = new Stopwatch();
|
2018-03-13 20:24:17 -04:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
_tickCounter.Start();
|
2018-03-13 20:24:17 -04:00
|
|
|
}
|
|
|
|
|
2018-09-19 11:16:20 -04:00
|
|
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
2018-10-30 21:43:02 -04:00
|
|
|
internal bool Synchronize(int bbWeight)
|
2018-08-16 19:47:36 -04:00
|
|
|
{
|
2018-09-19 11:16:20 -04:00
|
|
|
//Firing a interrupt frequently is expensive, so we only
|
|
|
|
//do it after a given number of instructions has executed.
|
2018-10-30 21:43:02 -04:00
|
|
|
_syncCount += bbWeight;
|
2018-09-18 19:36:43 -04:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
if (_syncCount >= MinInstForCheck)
|
2018-09-19 11:16:20 -04:00
|
|
|
{
|
|
|
|
CheckInterrupt();
|
2018-09-18 19:36:43 -04:00
|
|
|
}
|
|
|
|
|
2018-08-16 19:47:36 -04:00
|
|
|
return Running;
|
|
|
|
}
|
|
|
|
|
2018-09-18 19:36:43 -04:00
|
|
|
internal void RequestInterrupt()
|
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
_interrupted = true;
|
2018-09-18 19:36:43 -04:00
|
|
|
}
|
|
|
|
|
2018-09-19 11:16:20 -04:00
|
|
|
[MethodImpl(MethodImplOptions.NoInlining)]
|
|
|
|
private void CheckInterrupt()
|
2018-09-18 19:36:43 -04:00
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
_syncCount = 0;
|
2018-09-19 11:16:20 -04:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
if (_interrupted)
|
2018-09-19 11:16:20 -04:00
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
_interrupted = false;
|
2018-09-19 11:16:20 -04:00
|
|
|
|
|
|
|
Interrupt?.Invoke(this, EventArgs.Empty);
|
|
|
|
}
|
2018-09-18 19:36:43 -04:00
|
|
|
}
|
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
internal void OnBreak(long position, int imm)
|
2018-02-10 08:24:16 -05:00
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
Break?.Invoke(this, new InstExceptionEventArgs(position, imm));
|
2018-02-10 08:24:16 -05:00
|
|
|
}
|
2018-02-04 18:08:20 -05:00
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
internal void OnSvcCall(long position, int imm)
|
2018-02-04 18:08:20 -05:00
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
SvcCall?.Invoke(this, new InstExceptionEventArgs(position, imm));
|
2018-02-04 18:08:20 -05:00
|
|
|
}
|
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
internal void OnUndefined(long position, int rawOpCode)
|
2018-02-04 18:08:20 -05:00
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
Undefined?.Invoke(this, new InstUndefinedEventArgs(position, rawOpCode));
|
2018-02-04 18:08:20 -05:00
|
|
|
}
|
2018-10-23 10:12:45 -04:00
|
|
|
|
2019-01-24 20:59:53 -05:00
|
|
|
internal ExecutionMode GetExecutionMode()
|
|
|
|
{
|
|
|
|
if (!IsAarch32)
|
|
|
|
{
|
|
|
|
return ExecutionMode.Aarch64;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
return Thumb ? ExecutionMode.Aarch32Thumb : ExecutionMode.Aarch32Arm;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
internal bool GetFpcrFlag(Fpcr flag)
|
2018-10-23 10:12:45 -04:00
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
return (Fpcr & (1 << (int)flag)) != 0;
|
2018-10-23 10:12:45 -04:00
|
|
|
}
|
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
internal void SetFpsrFlag(Fpsr flag)
|
2018-10-23 10:12:45 -04:00
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
Fpsr |= 1 << (int)flag;
|
2018-10-23 10:12:45 -04:00
|
|
|
}
|
|
|
|
|
2018-10-30 21:43:02 -04:00
|
|
|
internal RoundMode FPRoundingMode()
|
2018-10-23 10:12:45 -04:00
|
|
|
{
|
2018-10-30 21:43:02 -04:00
|
|
|
return (RoundMode)((Fpcr >> (int)State.Fpcr.RMode) & 3);
|
2018-10-23 10:12:45 -04:00
|
|
|
}
|
2018-02-04 18:08:20 -05:00
|
|
|
}
|
2018-10-23 10:12:45 -04:00
|
|
|
}
|