void State_Machine_Reset(unsigned char ASL) { MIP50xAPIxRESET(ASL); Bezet_In_5B(ASL,On); Bezet_In_6(ASL,On); Bezet_In_7(ASL,On); Bezet_Weerstand(ASL,Off); Enable_Track(ASL,Off); // decouple track as default that no trains start running Exe_Cmd_Ret(ASL,0); // Return with command execution ready internal ACT_ST_MCHN[ASL].State_Machine_Switch = Idle; // State Machine Main Switch M10(ASL, Off); // Disable MIP50 }
/* Calculate the inverse of a 3x3 matrix http://en.wikipedia.org/wiki/Invertible_matrix */ void x3f_3x3_inverse(double *a, double *ainv) { double A, B, C, D, E, F, G, H, I; double det; A = +(M11(a)*M22(a)-M12(a)*M21(a)); B = -(M10(a)*M22(a)-M12(a)*M20(a)); C = +(M10(a)*M21(a)-M11(a)*M20(a)); D = -(M01(a)*M22(a)-M02(a)*M21(a)); E = +(M00(a)*M22(a)-M02(a)*M20(a)); F = -(M00(a)*M21(a)-M01(a)*M20(a)); G = +(M01(a)*M12(a)-M02(a)*M11(a)); H = -(M00(a)*M12(a)-M02(a)*M10(a)); I = +(M00(a)*M11(a)-M01(a)*M10(a)); det = M00(a)*A + M01(a)*B + M02(a)*C; M00(ainv) = A/det; M01(ainv) = D/det; M02(ainv) = G/det; M10(ainv) = B/det; M11(ainv) = E/det; M12(ainv) = H/det; M20(ainv) = C/det; M21(ainv) = F/det; M22(ainv) = I/det; }
/* Multiply a 3x3 matrix with a 3x3 matrix, giving a 3x3 matrix */ void x3f_3x3_3x3_mul(double *a, double *b, double *c) { M00(c) = M00(a)*M00(b) + M01(a)*M10(b) + M02(a)*M20(b); M01(c) = M00(a)*M01(b) + M01(a)*M11(b) + M02(a)*M21(b); M02(c) = M00(a)*M02(b) + M01(a)*M12(b) + M02(a)*M22(b); M10(c) = M10(a)*M00(b) + M11(a)*M10(b) + M12(a)*M20(b); M11(c) = M10(a)*M01(b) + M11(a)*M11(b) + M12(a)*M21(b); M12(c) = M10(a)*M02(b) + M11(a)*M12(b) + M12(a)*M22(b); M20(c) = M20(a)*M00(b) + M21(a)*M10(b) + M22(a)*M20(b); M21(c) = M20(a)*M01(b) + M21(a)*M11(b) + M22(a)*M21(b); M22(c) = M20(a)*M02(b) + M21(a)*M12(b) + M22(a)*M22(b); }
void x3f_AdobeRGB_to_XYZ(double *a) { M00(a) = 0.57667; M01(a) = 0.18556; M02(a) = 0.18823; M10(a) = 0.29737; M11(a) = 0.62736; M12(a) = 0.07529; M20(a) = 0.02703; M21(a) = 0.07069; M22(a) = 0.99134; }
/* Multiply a scalar with a 3x3 matrix, giving a 3x3 matrix */ void x3f_scalar_3x3_mul(double a, double *b, double *c) { M00(c) = a*M00(b); M01(c) = a*M01(b); M02(c) = a*M02(b); M10(c) = a*M10(b); M11(c) = a*M11(b); M12(c) = a*M12(b); M20(c) = a*M20(b); M21(c) = a*M21(b); M22(c) = a*M22(b); }
/* http://www.brucelindbloom.com/index.html?Eqn_ChromAdapt.html */ void x3f_Bradford_D50_to_D65(double *a) { M00(a) = +0.9555766 ; M01(a) = -0.0230393; M02(a) = +0.0631636; M10(a) = -0.0282895 ; M11(a) = +1.0099416; M12(a) = +0.0210077; M20(a) = +0.0122982 ; M21(a) = -0.0204830; M22(a) = +1.3299098; }
void x3f_Bradford_D65_to_D50(double *a) { M00(a) = +1.0478112 ; M01(a) = +0.0228866; M02(a) = -0.0501270; M10(a) = +0.0295424 ; M11(a) = +0.9904844; M12(a) = -0.0170491; M20(a) = -0.0092345 ; M21(a) = +0.0150436; M22(a) = +0.7521316; }
void x3f_sRGB_to_XYZ(double *a) { M00(a) = 0.4124; M01(a) = 0.3576; M02(a) = 0.1805; M10(a) = 0.2126; M11(a) = 0.7152; M12(a) = 0.0722; M20(a) = 0.0193; M21(a) = 0.1192; M22(a) = 0.9505; }
/* http://en.wikipedia.org/wiki/CIE_1931_color_space */ void x3f_CIERGB_to_XYZ(double *a) { M00(a) = 0.49 ; M01(a) = 0.31 ; M02(a) = 0.20 ; M10(a) = 0.17697 ; M11(a) = 0.81240 ; M12(a) = 0.01063 ; M20(a) = 0.00 ; M21(a) = 0.01 ; M22(a) = 0.99 ; }
void State_Machine_Update(unsigned char ASL) //ASL = Active_Struct_Level, BOTTOM(0) or TOP(1) { switch (ACT_ST_MCHN[ASL].State_Machine_Switch) { case Fy_Reset : MIP50xAPIxRESET(ASL); Bezet_In_5B(ASL,On); Bezet_In_6(ASL,On); Bezet_In_7(ASL,On); Bezet_Weerstand(ASL,Off); Enable_Track(ASL,Off); // decouple track as default that no trains start running Exe_Cmd_Ret(ASL,0); // Return with command execution ready internal ACT_ST_MCHN[ASL].State_Machine_Switch = Idle; // State Machine Main Switch M10(ASL, Off); // Disable MIP50 Target_Ready(ASL); break; case Idle : switch (ACT_ST_MCHN[ASL].Execute_Command = Exe_Cmd_(ASL)) { case Nopp : break; // no command received (No Opperation Pending ;-) case Assert_Track : Enable_Track(ASL,On); Bezet_Weerstand(ASL, Off); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; case Deassert_Track : Enable_Track(ASL,Off); Bezet_Weerstand(ASL, On); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; case MIP50_Enable : M10(ASL, On); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; case MIP50_Disable : M10(ASL, Off); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; case Stop_Fiddle_Yard_Now : State_Machine_Reset(ASL); Fiddle_Yard_Reset(ASL); // Let C# now Reset is executed Target_Ready(ASL); break; case Bezet_In_5B_Switch_On : Bezet_In_5B(ASL,On); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; case Bezet_In_5B_Switch_Off : Bezet_In_5B(ASL,Off); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; case Bezet_In_6_Switch_On : Bezet_In_6(ASL,On); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; case Bezet_In_6_Switch_Off : Bezet_In_6(ASL,Off); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; case Bezet_In_7_Switch_On : Bezet_In_7(ASL,On); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; case Bezet_In_7_Switch_Off : Bezet_In_7(ASL,Off); Exe_Cmd_Ret(ASL,0); Target_Ready(ASL); break; default : break; } break; default : break; } Var_Out_Programm(ASL); }
/* http://en.wikipedia.org/wiki/SRGB */ void x3f_XYZ_to_sRGB(double *a) { M00(a) = +3.2406; M01(a) = -1.5372; M02(a) = -0.4986; M10(a) = -0.9689; M11(a) = +1.8758; M12(a) = +0.0415; M20(a) = +0.0557; M21(a) = -0.2040; M22(a) = +1.0570; }
void x3f_ProPhotoRGB_to_XYZ(double *a) { M00(a) = 0.7977; M01(a) = 0.1352; M02(a) = 0.0313; M10(a) = 0.2880; M11(a) = 0.7119; M12(a) = 0.0001; M20(a) = 0.0000; M21(a) = 0.0000; M22(a) = 0.8249; }
/* http://www.adobe.com/digitalimag/pdfs/AdobeRGB1998.pdf */ void x3f_XYZ_to_AdobeRGB(double *a) { M00(a) = +2.04159; M01(a) = -0.56501; M02(a) = -0.34473; M10(a) = -0.96924; M11(a) = +1.87597; M12(a) = +0.04156; M20(a) = +0.01344; M21(a) = -0.11836; M22(a) = +1.01517; }
/* http://en.wikipedia.org/wiki/ProPhoto_RGB_color_space */ void x3f_XYZ_to_ProPhotoRGB(double *a) { M00(a) = +1.3460; M01(a) = -0.2556; M02(a) = -0.0511; M10(a) = -0.5446; M11(a) = +1.5082; M12(a) = +0.0205; M20(a) = +0.0000; M21(a) = +0.0000; M22(a) = +1.2123; }
/* Print a 3x3 matrix */ void x3f_3x3_print(x3f_verbosity_t level, double *a) { x3f_printf(level, "%10g %10g %10g\n", M00(a), M01(a), M02(a)); x3f_printf(level, "%10g %10g %10g\n", M10(a), M11(a), M12(a)); x3f_printf(level, "%10g %10g %10g\n", M20(a), M21(a), M22(a)); }
void x3f_3x3_ones(double *a) { M00(a) = 1.0; M01(a) = 1.0; M02(a) = 1.0; M10(a) = 1.0; M11(a) = 1.0; M12(a) = 1.0; M20(a) = 1.0; M21(a) = 1.0; M22(a) = 1.0; }
void x3f_3x3_identity(double *a) { M00(a) = 1.0; M01(a) = 0.0; M02(a) = 0.0; M10(a) = 0.0; M11(a) = 1.0; M12(a) = 0.0; M20(a) = 0.0; M21(a) = 0.0; M22(a) = 1.0; }
/* Convert a 3x1 matrix to a 3x3 diagonal matrix */ void x3f_3x3_diag(double *a, double *b) { M00(b) = M0(a); M01(b) = 0.0; M02(b) = 0.0; M10(b) = 0.0; M11(b) = M1(a); M12(b) = 0.0; M20(b) = 0.0; M21(b) = 0.0; M22(b) = M2(a); }