private void lv_sv_l_r_q(bool left, bool save)
{
var vt = Instruction.VT5 | (Instruction.VT1 << 5);
var m = (vt >> 2) & 7;
var i = (vt >> 0) & 3;
var dir = (vt & 32) != 0;
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldarg_0); // CpuThreadState
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, m);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, i);
MipsMethodEmiter.LoadGPR_Unsigned(RS);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, Instruction.IMM14 * 4);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Add);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, dir ? 1 : 0);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, save ? 1 : 0);
}
if (left)
{
MipsMethodEmiter.CallMethod(this.GetType(), "_lvl_svl_q");
}
else
{
MipsMethodEmiter.CallMethod(this.GetType(), "_lvr_svr_q");
}
}
/*
* if (enabled && prefix.enabled) {
* foreach (i, value; src) {
* if (prefix.mask(i)) continue;
*
* switch (prefix.saturation(i)) {
* case 1: value = clamp!(float)(value, 0.0, 1.0); break;
* case 3: value = clamp!(float)(value, -1.0, 1.0); break;
* default: break;
* }
*
* dst[i] = value;
* }
* prefix.enabled = false;
* } else {
* foreach (i, value; src) *dst[i] = value;
* }
*/
private void VfpuSave_Register(uint Register, int Index, uint VectorSize, VfpuPrefix Prefix, Action Action, bool Debug = false)
{
CheckPrefixUsage(ref Prefix);
_VfpuLoadVectorWithIndexPointer(Register, (uint)Index, VectorSize, Debug);
{
Action();
if (Prefix.Enabled)
{
if (!Prefix.DestinationMask(Index))
{
float Min = 0, Max = 0;
bool DoClamp = false;
switch (Prefix.DestinationSaturation(Index))
{
case 1: DoClamp = true; Min = 0.0f; Max = 1.0f; break;
case 3: DoClamp = true; Min = -1.0f; Max = 1.0f; break;
default: break;
}
if (DoClamp)
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_R4, Min);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_R4, Max);
MipsMethodEmiter.CallMethod(typeof(MathFloat), "Clamp");
}
}
}
}
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Stind_R4);
}
public void ceil_w_s()
{
MipsMethodEmiter.SaveFPR_I(FD, () =>
{
MipsMethodEmiter.LoadFPR(FS);
MipsMethodEmiter.CallMethod(typeof(MathFloat), "Ceil");
});
}
public void rotrv()
{
MipsMethodEmiter.SaveGPR(RD, () =>
{
MipsMethodEmiter.LoadGPR_Unsigned(RT);
MipsMethodEmiter.LoadGPR_Unsigned(RS);
MipsMethodEmiter.CallMethod(this.GetType(), "_rotr");
});
}
public void rotr()
{
MipsMethodEmiter.SaveGPR(RD, () =>
{
MipsMethodEmiter.LoadGPR_Unsigned(RT);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, Instruction.POS);
MipsMethodEmiter.CallMethod(this.GetType(), "_rotr");
});
//$rd = ROTR($rt, $ps);
}
// OP_V_INTERNAL_IN_N!(1, "1.0f / sqrt(v)");
public void vrsq()
{
VectorOperationSaveVd((Index, Load) =>
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_R4, 1.0f);
Load(1);
MipsMethodEmiter.CallMethod(typeof(MathFloat), "Sqrt");
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Div);
});
}
/*
* if (enabled && prefix.enabled) {
* foreach (i, ref value; dst) {
* // Constant.
* if (prefix.constant(i)) {
* final switch (prefix.index(i)) {
* case 0: value = prefix.absolute(i) ? (3.0f ) : (0.0f); break;
* case 1: value = prefix.absolute(i) ? (1.0f / 3.0f) : (1.0f); break;
* case 2: value = prefix.absolute(i) ? (1.0f / 4.0f) : (2.0f); break;
* case 3: value = prefix.absolute(i) ? (1.0f / 6.0f) : (0.5f); break;
* }
* }
* // Value
* else {
* value = *src[prefix.index(i)];
* }
*
* if (prefix.absolute(i)) value = abs(value);
* if (prefix.negate (i)) value = -value;
* }
* prefix.enabled = false;
* } else {
* foreach (n, ref value; dst) value = *src[n];
* }
*/
private void VfpuLoad_Register(uint Register, int Index, uint VectorSize, ref VfpuPrefix Prefix, bool Debug = false)
{
//Console.Error.WriteLine("{0:X}", PC);
CheckPrefixUsage(ref Prefix);
//Console.Error.WriteLine("PREFIX [1]!" + Index);
if (Prefix.Enabled)
{
//Console.Error.WriteLine("PREFIX [2]!" + Index);
Prefix.UsedPC = PC;
Prefix.UsedCount++;
// Constant.
if (Prefix.SourceConstant(Index))
{
float Value = 0.0f;
switch (Prefix.SourceIndex(Index))
{
case 0: Value = Prefix.SourceAbsolute(Index) ? (3.0f) : (0.0f); break;
case 1: Value = Prefix.SourceAbsolute(Index) ? (1.0f / 3.0f) : (1.0f); break;
case 2: Value = Prefix.SourceAbsolute(Index) ? (1.0f / 4.0f) : (2.0f); break;
case 3: Value = Prefix.SourceAbsolute(Index) ? (1.0f / 6.0f) : (0.5f); break;
default: throw(new InvalidOperationException());
}
//Console.Error.WriteLine("VALUE:: " + Value);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_R4, Value);
}
// Value.
else
{
_VfpuLoadVectorWithIndexPointer(Register, (uint)Prefix.SourceIndex(Index), VectorSize, Debug);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldind_R4);
}
if (Prefix.SourceAbsolute(Index))
{
//MipsMethodEmiter.ILGenerator.Emit(OpCodes);
MipsMethodEmiter.CallMethod(typeof(MathFloat), "Abs");
}
if (Prefix.SourceNegate(Index))
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Neg);
}
}
else
{
_VfpuLoadVectorWithIndexPointer(Register, (uint)Index, VectorSize, Debug);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldind_R4);
}
}
/// <summary>
/// ID("mtv", VM("010010:00:111:rt:0:0000000:0:vd"), "%t, %zs", ADDR_TYPE_NONE, INSTR_TYPE_PSP),
/// </summary>
public void mtv()
{
/*
* Console.Error.WriteLine("MTV:{0}", Instruction.VD);
* _VfpuLoadVectorWithIndexPointer(Instruction.VD, 0, 1);
* MipsMethodEmiter.LoadGPR_Signed(Instruction.RT);
* MipsMethodEmiter.CallMethod(typeof(MathFloat), "ReinterpretIntAsFloat");
* MipsMethodEmiter.ILGenerator.Emit(OpCodes.Stind_R4);
*/
VectorOperationSaveVd(1, (Index, Load) =>
{
MipsMethodEmiter.LoadGPR_Signed(RT);
MipsMethodEmiter.CallMethod(typeof(MathFloat), "ReinterpretIntAsFloat");
});
}
// ROTate
public void vrot()
{
var VectorSize = Instruction.ONE_TWO;
uint imm5 = Instruction.IMM5;
if (VectorSize == 1)
{
throw(new NotImplementedException());
}
//uint imm5 = instruction.IMM5;
int SinIndex = (int)((imm5 >> 2) & 3);
int CosIndex = (int)((imm5 >> 0) & 3);
bool NegateSin = ((imm5 & 16) != 0);
foreach (var Index in XRange(VectorSize))
{
Save_VD(Index, VectorSize, () =>
{
if (SinIndex == CosIndex)
{
// Angle [-1, +1]
Load_VS(0, 1); // Angle
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_R4, (float)(Math.PI / 2.0f));
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Mul);
MipsMethodEmiter.CallMethod(typeof(MathFloat), "Sin");
if (NegateSin)
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Neg);
}
}
else
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_R4, (float)(0.0f));
}
});
}
if (SinIndex != CosIndex)
{
Save_VD(SinIndex, VectorSize, () =>
{
// Angle [-1, +1]
Load_VS(0, 1); // Angle
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_R4, (float)(Math.PI / 2.0f));
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Mul);
MipsMethodEmiter.CallMethod(typeof(MathFloat), "Sin");
if (NegateSin)
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Neg);
}
});
}
Save_VD(CosIndex, VectorSize, () =>
{
// Angle [-1, +1]
Load_VS(0, 1); // Angle
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_R4, (float)(Math.PI / 2.0f));
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Mul);
MipsMethodEmiter.CallMethod(typeof(MathFloat), "Cos");
});
}
private Action<CpuThreadState> CreateDelegateForMethodInfo(MethodInfo MethodInfo, HlePspFunctionAttribute HlePspFunctionAttribute)
{
var MipsMethodEmiter = new MipsMethodEmiter(CpuProcessor, 0);
int GprIndex = 4;
int FprIndex = 0;
var NotImplementedAttribute = (HlePspNotImplementedAttribute)MethodInfo.GetCustomAttributes(typeof(HlePspNotImplementedAttribute), true).FirstOrDefault();
bool NotImplementedFunc = (NotImplementedAttribute != null) ? NotImplementedAttribute.Notice : false;
bool SkipLog = HlePspFunctionAttribute.SkipLog;
var SafeILGenerator = MipsMethodEmiter.SafeILGenerator;
SafeILGenerator.Comment("HleModuleHost.CreateDelegateForMethodInfo(" + MethodInfo + ", " + HlePspFunctionAttribute + ")");
var ParamInfoList = new List<ParamInfo>();
Action CallAction = () =>
{
SafeILGenerator.LoadArgument0CpuThreadState();
SafeILGenerator.LoadField(typeof(CpuThreadState).GetField("ModuleObject"));
SafeILGenerator.CastClass(this.GetType());
foreach (var ParameterInfo in MethodInfo.GetParameters())
{
var ParameterType = ParameterInfo.ParameterType;
// The CpuThreadState
if (ParameterType == typeof(CpuThreadState))
{
SafeILGenerator.LoadArgument0CpuThreadState();
}
// A stringz
else if (ParameterType == typeof(string))
{
ParamInfoList.Add(new ParamInfo()
{
ParameterName = ParameterInfo.Name,
RegisterType = ParamInfo.RegisterTypeEnum.Gpr,
RegisterIndex = GprIndex,
ParameterType = ParameterType,
});
SafeILGenerator.LoadArgument0CpuThreadState();
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex);
SafeILGenerator.Call(typeof(HleModuleHost).GetMethod("StringFromAddress"));
GprIndex++;
}
// A pointer or ref/out
else if (ParameterType.IsPointer || ParameterType.IsByRef)
{
ParamInfoList.Add(new ParamInfo()
{
ParameterName = ParameterInfo.Name,
RegisterType = ParamInfo.RegisterTypeEnum.Gpr,
RegisterIndex = GprIndex,
ParameterType = typeof(uint),
});
MipsMethodEmiter._getmemptr(() =>
{
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex);
}, Safe: true, ErrorDescription: "Invalid Pointer for Argument '" + ParameterType.Name + " " + ParameterInfo.Name + "'");
GprIndex++;
}
/*
// An array
else if (ParameterType.IsArray)
{
ParamInfoList.Add(new ParamInfo()
{
ParameterName = ParameterInfo.Name,
RegisterType = ParamInfo.RegisterTypeEnum.Gpr,
RegisterIndex = GprIndex,
ParameterType = typeof(uint),
});
// Pointer
MipsMethodEmiter._getmemptr(() =>
{
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex);
}, Safe: true, ErrorDescription: "Invalid Pointer for Argument '" + ParameterType.Name + " " + ParameterInfo.Name + "'");
GprIndex++;
// Array
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex);
GprIndex++;
MipsMethodEmiter.CallMethod(HleModuleHost.PointerLengthToArrat);
}
*/
// A long type
else if (ParameterType == typeof(long) || ParameterType == typeof(ulong))
{
while (GprIndex % 2 != 0) GprIndex++;
ParamInfoList.Add(new ParamInfo()
{
ParameterName = ParameterInfo.Name,
RegisterType = ParamInfo.RegisterTypeEnum.Gpr,
RegisterIndex = GprIndex,
ParameterType = ParameterType,
});
MipsMethodEmiter.LoadGPRLong_Signed(GprIndex + 0);
/*
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex + 0);
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex + 1);
SafeILGenerator.Push((int)32);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Shl);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Or);
*/
GprIndex += 2;
}
// A float register.
else if (ParameterType == typeof(float))
{
ParamInfoList.Add(new ParamInfo()
{
ParameterName = ParameterInfo.Name,
RegisterType = ParamInfo.RegisterTypeEnum.Fpr,
RegisterIndex = FprIndex,
ParameterType = ParameterType,
});
MipsMethodEmiter.LoadFPR(FprIndex);
FprIndex++;
}
// Test
else if (ParameterType == typeof(PspPointer))
{
ParamInfoList.Add(new ParamInfo()
{
ParameterName = ParameterInfo.Name,
RegisterType = ParamInfo.RegisterTypeEnum.Gpr,
RegisterIndex = GprIndex,
ParameterType = ParameterType,
});
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex);
MipsMethodEmiter.CallMethod(typeof(PspPointer).GetMethod("op_Implicit", new[] { typeof(uint) }));
GprIndex++;
}
// An integer register
else
{
ParamInfoList.Add(new ParamInfo()
{
ParameterName = ParameterInfo.Name,
RegisterType = ParamInfo.RegisterTypeEnum.Gpr,
RegisterIndex = GprIndex,
ParameterType = ParameterType,
});
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex);
GprIndex++;
}
//MipsMethodEmiter.ILGenerator.Emit(OpCodes.ld
}
SafeILGenerator.Call(MethodInfo);
};
if (MethodInfo.ReturnType == typeof(void))
{
CallAction();
}
else if (MethodInfo.ReturnType == typeof(long))
{
MipsMethodEmiter.SaveGPRLong(2, CallAction);
}
else if (MethodInfo.ReturnType == typeof(float))
{
MipsMethodEmiter.SaveFPR(0, CallAction);
}
else
{
MipsMethodEmiter.SaveGPR(2, CallAction);
}
var Delegate = MipsMethodEmiter.CreateDelegate();
return (CpuThreadState) =>
{
bool Trace = (!SkipLog && CpuThreadState.CpuProcessor.PspConfig.DebugSyscalls);
bool NotImplemented = NotImplementedFunc && CpuThreadState.CpuProcessor.PspConfig.DebugNotImplemented;
if (Trace && (MethodInfo.DeclaringType.Name == "Kernel_Library")) Trace = false;
if (NotImplemented)
{
Trace = true;
ConsoleUtils.SaveRestoreConsoleState(() =>
{
Console.ForegroundColor = ConsoleColor.Yellow;
Console.WriteLine(
"Not implemented {0}.{1}",
MethodInfo.DeclaringType.Name, MethodInfo.Name
);
});
}
var Out = Console.Out;
if (NotImplemented)
{
Out = Console.Error;
}
if (Trace)
{
if (ThreadManager.Current != null)
{
Out.Write(
"Thread({0}:'{1}') : RA(0x{2:X})",
ThreadManager.Current.Id,
ThreadManager.Current.Name,
ThreadManager.Current.CpuThreadState.RA
);
}
else
{
Out.Write("NoThread:");
}
Out.Write(" : {0}.{1}", MethodInfo.DeclaringType.Name, MethodInfo.Name);
Out.Write("(");
int Count = 0;
foreach (var ParamInfo in ParamInfoList)
{
if (Count > 0) Out.Write(", ");
Out.Write("{0}:", ParamInfo.ParameterName);
switch (ParamInfo.RegisterType)
{
case HleModuleHost.ParamInfo.RegisterTypeEnum.Fpr:
case HleModuleHost.ParamInfo.RegisterTypeEnum.Gpr:
uint Int4 = (uint)CpuThreadState.GPR[ParamInfo.RegisterIndex];
uint Float4 = (uint)CpuThreadState.FPR[ParamInfo.RegisterIndex];
Out.Write("{0}", ToNormalizedTypeString(ParamInfo.ParameterType, CpuThreadState, Int4, Float4));
break;
default:
throw (new NotImplementedException());
}
Count++;
}
Out.Write(")");
//Console.WriteLine("");
}
CpuThreadState.ModuleObject = this;
try
{
Delegate(CpuThreadState);
}
catch (MemoryPartitionNoMemoryException)
{
CpuThreadState.GPR[2] = (int)SceKernelErrors.ERROR_ERRNO_NO_MEMORY;
}
catch (SceKernelException SceKernelException)
{
CpuThreadState.GPR[2] = (int)SceKernelException.SceKernelError;
}
catch (SceKernelSelfStopUnloadModuleException SceKernelSelfStopUnloadModuleException)
{
throw (SceKernelSelfStopUnloadModuleException);
}
#if !DO_NOT_PROPAGATE_EXCEPTIONS
catch (Exception Exception)
{
throw (new Exception(
String.Format("ERROR calling {0}.{1}!", MethodInfo.DeclaringType.Name, MethodInfo.Name),
Exception
));
}
#endif
finally
{
if (Trace)
{
Out.WriteLine(" : {0}", ToNormalizedTypeString(MethodInfo.ReturnType, CpuThreadState, (uint)CpuThreadState.GPR[2], (float)CpuThreadState.FPR[0]));
Out.WriteLine("");
}
}
};
}
