public void ceil_w_s()
{
MipsMethodEmiter.SaveFPR_I(FD, () =>
{
MipsMethodEmiter.LoadFPR(FS);
MipsMethodEmiter.CallMethod(typeof(MathFloat), "Ceil");
});
}
// Move (from/to) float point registers (reinterpreted)
public void mfc1()
{
MipsMethodEmiter.SaveGPR(RT, () =>
{
MipsMethodEmiter.LoadFPR(FS);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Call, typeof(MathFloat).GetMethod("ReinterpretFloatAsInt"));
});
}
/// <summary>
/// Convert FS register (stored as an int) to float and stores the result on FD.
/// </summary>
public void cvt_s_w()
{
MipsMethodEmiter.SaveFPR(FD, () =>
{
MipsMethodEmiter.LoadFPR(FS);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Call, typeof(MathFloat).GetMethod("ReinterpretFloatAsInt"));
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Conv_R4);
});
}
private void _comp(int fc02, int fc3)
{
bool fc_unordererd = ((fc02 & 1) != 0);
bool fc_equal = ((fc02 & 2) != 0);
bool fc_less = ((fc02 & 4) != 0);
bool fc_inv_qnan = (fc3 != 0); // @TODO? -- Only used for detecting invalid operations?
//throw(new NotImplementedException());
//MipsMethodEmiter.SaveFCR31_C(() =>
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldarg_0);
MipsMethodEmiter.LoadFPR(FS);
MipsMethodEmiter.LoadFPR(FT);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, fc_unordererd ? 1 : 0);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, fc_equal ? 1 : 0);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, fc_less ? 1 : 0);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, fc_inv_qnan ? 1 : 0);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Call, typeof(CpuEmiter).GetMethod("_comp_impl"));
}
//);
}
private Action<CpuThreadState> CreateDelegateForMethodInfo(MethodInfo MethodInfo, HlePspFunctionAttribute HlePspFunctionAttribute)
{
var MipsMethodEmiter = new MipsMethodEmiter(HleState.MipsEmiter, HleState.CpuProcessor);
int GprIndex = 4;
int FprIndex = 0;
var NotImplementedAttribute = (HlePspNotImplementedAttribute)MethodInfo.GetCustomAttributes(typeof(HlePspNotImplementedAttribute), true).FirstOrDefault();
bool NotImplemented = (NotImplementedAttribute != null) ? NotImplementedAttribute.Notice : false;
bool SkipLog = HlePspFunctionAttribute.SkipLog;
var ParamInfoList = new List<ParamInfo>();
Action CallAction = () =>
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldarg_0);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldfld, typeof(CpuThreadState).GetField("ModuleObject"));
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Castclass, this.GetType());
foreach (var ParameterInfo in MethodInfo.GetParameters())
{
var ParameterType = ParameterInfo.ParameterType;
// The CpuThreadState
if (ParameterType == typeof(CpuThreadState))
{
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldarg_0);
}
// A stringz
else if (ParameterType == typeof(string))
{
ParamInfoList.Add(new ParamInfo()
{
ParameterName = ParameterInfo.Name,
RegisterType = ParamInfo.RegisterTypeEnum.Gpr,
RegisterIndex = GprIndex,
ParameterType = ParameterType,
});
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldarg_0);
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Call, typeof(HleModuleHost).GetMethod("StringFromAddress"));
GprIndex++;
}
// A pointer
else if (ParameterType.IsPointer)
{
ParamInfoList.Add(new ParamInfo()
{
ParameterName = ParameterInfo.Name,
RegisterType = ParamInfo.RegisterTypeEnum.Gpr,
RegisterIndex = GprIndex,
ParameterType = typeof(uint),
});
MipsMethodEmiter._getmemptr(() =>
{
MipsMethodEmiter.LoadGPR_Unsigned(GprIndex);
}, Safe: true);
GprIndex++;
}
// 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);
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Ldc_I4, 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++;
}
// 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
}
MipsMethodEmiter.ILGenerator.Emit(OpCodes.Call, MethodInfo);
};
if (MethodInfo.ReturnType == typeof(void))
{
CallAction();
}
else if (MethodInfo.ReturnType == typeof(long))
{
MipsMethodEmiter.SaveGPRLong(2, CallAction);
}
else
{
MipsMethodEmiter.SaveGPR(2, CallAction);
}
var Delegate = MipsMethodEmiter.CreateDelegate();
return (CpuThreadState) =>
{
bool Trace = (!SkipLog && CpuThreadState.CpuProcessor.PspConfig.DebugSyscalls);
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 (HleState.ThreadManager.Current != null)
{
Out.Write(
"Thread({0}:'{1}') : RA(0x{2:X})",
HleState.ThreadManager.Current.Id,
HleState.ThreadManager.Current.Name,
HleState.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 (SceKernelException SceKernelException)
{
CpuThreadState.GPR[2] = (int)SceKernelException.SceKernelError;
}
catch (SceKernelSelfStopUnloadModuleException SceKernelSelfStopUnloadModuleException)
{
throw (SceKernelSelfStopUnloadModuleException);
}
catch (Exception Exception)
{
throw (new Exception(
String.Format("ERROR calling {0}.{1}!", MethodInfo.DeclaringType.Name, MethodInfo.Name),
Exception
));
}
finally
{
if (Trace)
{
Out.WriteLine(" : {0}", ToNormalizedTypeString(MethodInfo.ReturnType, CpuThreadState, (uint)CpuThreadState.GPR[2], (float)CpuThreadState.FPR[0]));
Out.WriteLine("");
}
}
};
}
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("");
}
}
};
}
