|
|
@@ -0,0 +1,185 @@
|
|
|
+
|
|
|
+#include <string.h>
|
|
|
+#include "rubiks.h"
|
|
|
+
|
|
|
+void rubik_applyX(t_rubiks *rubiks, char move[3])
|
|
|
+{
|
|
|
+ char tmpMatrix[3][3];
|
|
|
+
|
|
|
+ memcpy(tmpMatrix, rubiks->grid[3], sizeof(tmpMatrix));
|
|
|
+ memcpy(rubiks->grid[3], rubiks->grid[5], sizeof(tmpMatrix));
|
|
|
+ memcpy(rubiks->grid[5], rubiks->grid[1], sizeof(tmpMatrix));
|
|
|
+ memcpy(rubiks->grid[1], rubiks->grid[0], sizeof(tmpMatrix));
|
|
|
+ memcpy(rubiks->grid[0], tmpMatrix, sizeof(tmpMatrix));
|
|
|
+ memcpy(tmpMatrix, rubiks->grid[2], sizeof(tmpMatrix));
|
|
|
+ rubiks->grid[2][0][0] = tmpMatrix[0][2];
|
|
|
+ rubiks->grid[2][0][1] = tmpMatrix[1][2];
|
|
|
+ rubiks->grid[2][0][2] = tmpMatrix[2][2];
|
|
|
+ rubiks->grid[2][1][0] = tmpMatrix[0][1];
|
|
|
+ rubiks->grid[2][1][1] = tmpMatrix[1][1];
|
|
|
+ rubiks->grid[2][1][2] = tmpMatrix[2][1];
|
|
|
+ rubiks->grid[2][2][0] = tmpMatrix[0][0];
|
|
|
+ rubiks->grid[2][2][1] = tmpMatrix[1][0];
|
|
|
+ rubiks->grid[2][2][2] = tmpMatrix[2][0];
|
|
|
+ memcpy(tmpMatrix, rubiks->grid[4], sizeof(tmpMatrix));
|
|
|
+ rubiks->grid[4][0][0] = tmpMatrix[2][0];
|
|
|
+ rubiks->grid[4][1][0] = tmpMatrix[2][1];
|
|
|
+ rubiks->grid[4][2][0] = tmpMatrix[2][2];
|
|
|
+ rubiks->grid[4][0][1] = tmpMatrix[1][0];
|
|
|
+ rubiks->grid[4][1][1] = tmpMatrix[1][1];
|
|
|
+ rubiks->grid[4][2][1] = tmpMatrix[1][2];
|
|
|
+ rubiks->grid[4][0][2] = tmpMatrix[0][0];
|
|
|
+ rubiks->grid[4][1][2] = tmpMatrix[0][1];
|
|
|
+ rubiks->grid[4][2][2] = tmpMatrix[0][2];
|
|
|
+ memcpy(tmpMatrix, rubiks->grid[3], sizeof(tmpMatrix));
|
|
|
+ rubiks->grid[3][0][0] = tmpMatrix[2][2];
|
|
|
+ rubiks->grid[3][1][0] = tmpMatrix[1][2];
|
|
|
+ rubiks->grid[3][2][0] = tmpMatrix[0][2];
|
|
|
+ rubiks->grid[3][0][1] = tmpMatrix[2][1];
|
|
|
+ rubiks->grid[3][1][1] = tmpMatrix[1][1];
|
|
|
+ rubiks->grid[3][2][1] = tmpMatrix[0][1];
|
|
|
+ rubiks->grid[3][0][2] = tmpMatrix[2][0];
|
|
|
+ rubiks->grid[3][1][2] = tmpMatrix[1][0];
|
|
|
+ rubiks->grid[3][2][2] = tmpMatrix[0][0];
|
|
|
+
|
|
|
+ rubik_applyZ(rubiks, (char [3]) { 'Z', move[1], move[2] == '+' ? '-' : '+' });
|
|
|
+
|
|
|
+ memcpy(tmpMatrix, rubiks->grid[0], sizeof(tmpMatrix));
|
|
|
+ memcpy(rubiks->grid[0], rubiks->grid[1], sizeof(tmpMatrix));
|
|
|
+ memcpy(rubiks->grid[1], rubiks->grid[5], sizeof(tmpMatrix));
|
|
|
+ memcpy(rubiks->grid[5], rubiks->grid[3], sizeof(tmpMatrix));
|
|
|
+ memcpy(rubiks->grid[3], tmpMatrix, sizeof(tmpMatrix));
|
|
|
+ memcpy(tmpMatrix, rubiks->grid[2], sizeof(tmpMatrix));
|
|
|
+ rubiks->grid[2][0][0] = tmpMatrix[2][0];
|
|
|
+ rubiks->grid[2][1][0] = tmpMatrix[2][1];
|
|
|
+ rubiks->grid[2][2][0] = tmpMatrix[2][2];
|
|
|
+ rubiks->grid[2][0][1] = tmpMatrix[1][0];
|
|
|
+ rubiks->grid[2][1][1] = tmpMatrix[1][1];
|
|
|
+ rubiks->grid[2][2][1] = tmpMatrix[1][2];
|
|
|
+ rubiks->grid[2][0][2] = tmpMatrix[0][0];
|
|
|
+ rubiks->grid[2][1][2] = tmpMatrix[0][1];
|
|
|
+ rubiks->grid[2][2][2] = tmpMatrix[0][2];
|
|
|
+ memcpy(tmpMatrix, rubiks->grid[4], sizeof(tmpMatrix));
|
|
|
+ rubiks->grid[4][0][0] = tmpMatrix[0][2];
|
|
|
+ rubiks->grid[4][1][0] = tmpMatrix[0][1];
|
|
|
+ rubiks->grid[4][2][0] = tmpMatrix[0][0];
|
|
|
+ rubiks->grid[4][0][1] = tmpMatrix[1][2];
|
|
|
+ rubiks->grid[4][1][1] = tmpMatrix[1][1];
|
|
|
+ rubiks->grid[4][2][1] = tmpMatrix[1][0];
|
|
|
+ rubiks->grid[4][0][2] = tmpMatrix[0][2];
|
|
|
+ rubiks->grid[4][1][2] = tmpMatrix[0][1];
|
|
|
+ rubiks->grid[4][2][2] = tmpMatrix[0][0];
|
|
|
+ memcpy(tmpMatrix, rubiks->grid[5], sizeof(tmpMatrix));
|
|
|
+ rubiks->grid[5][0][0] = tmpMatrix[2][2];
|
|
|
+ rubiks->grid[5][1][0] = tmpMatrix[1][2];
|
|
|
+ rubiks->grid[5][2][0] = tmpMatrix[0][2];
|
|
|
+ rubiks->grid[5][0][1] = tmpMatrix[2][1];
|
|
|
+ rubiks->grid[5][1][1] = tmpMatrix[1][1];
|
|
|
+ rubiks->grid[5][2][1] = tmpMatrix[0][1];
|
|
|
+ rubiks->grid[5][0][2] = tmpMatrix[2][0];
|
|
|
+ rubiks->grid[5][1][2] = tmpMatrix[1][0];
|
|
|
+ rubiks->grid[5][2][2] = tmpMatrix[0][0];
|
|
|
+}
|
|
|
+
|
|
|
+void rubik_applyY(t_rubiks *rubiks, char move[3])
|
|
|
+{
|
|
|
+ /* TODO */
|
|
|
+ (void)rubiks;
|
|
|
+ (void)move;
|
|
|
+}
|
|
|
+
|
|
|
+void rubik_applyZ(t_rubiks *rubiks, char move[3])
|
|
|
+{
|
|
|
+ char tmp;
|
|
|
+ char tmpv[3];
|
|
|
+
|
|
|
+ const char axis = move[1] - '0';
|
|
|
+ if (move[2] == '-')
|
|
|
+ {
|
|
|
+ int i;
|
|
|
+
|
|
|
+ for (i=0; i < 3; ++i)
|
|
|
+ rubik_applyZ(rubiks, (char [3]) { move[0], move[1], '+' });
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (axis == 0)
|
|
|
+ {
|
|
|
+ tmp = rubiks->grid[0][0][0];
|
|
|
+ rubiks->grid[0][0][0] = rubiks->grid[0][0][2];
|
|
|
+ rubiks->grid[0][0][2] = rubiks->grid[0][2][2];
|
|
|
+ rubiks->grid[0][2][2] = rubiks->grid[0][2][0];
|
|
|
+ rubiks->grid[0][2][0] = tmp;
|
|
|
+ tmp = rubiks->grid[0][1][0];
|
|
|
+ rubiks->grid[0][1][0] = rubiks->grid[0][0][1];
|
|
|
+ rubiks->grid[0][0][1] = rubiks->grid[0][1][2];
|
|
|
+ rubiks->grid[0][1][2] = rubiks->grid[0][2][1];
|
|
|
+ rubiks->grid[0][2][1] = tmp;
|
|
|
+
|
|
|
+ memcpy(tmpv, (char[3]) { rubiks->grid[1][0][0], rubiks->grid[1][0][1], rubiks->grid[1][0][2] }, sizeof(tmpv) * 3);
|
|
|
+ rubiks->grid[1][0][0] = rubiks->grid[4][0][2];
|
|
|
+ rubiks->grid[1][0][1] = rubiks->grid[4][1][2];
|
|
|
+ rubiks->grid[1][0][2] = rubiks->grid[4][2][2];
|
|
|
+
|
|
|
+ rubiks->grid[4][0][2] = rubiks->grid[3][2][2];
|
|
|
+ rubiks->grid[4][1][2] = rubiks->grid[3][2][1];
|
|
|
+ rubiks->grid[4][2][2] = rubiks->grid[3][2][0];
|
|
|
+
|
|
|
+ rubiks->grid[3][2][0] = rubiks->grid[2][0][0];
|
|
|
+ rubiks->grid[3][2][1] = rubiks->grid[2][1][0];
|
|
|
+ rubiks->grid[3][2][2] = rubiks->grid[2][2][0];
|
|
|
+
|
|
|
+ rubiks->grid[2][0][0] = tmpv[2];
|
|
|
+ rubiks->grid[2][1][0] = tmpv[1];
|
|
|
+ rubiks->grid[2][2][0] = tmpv[0];
|
|
|
+ }
|
|
|
+ else if (axis == 1)
|
|
|
+ {
|
|
|
+ memcpy(tmpv, (char[3]) { rubiks->grid[1][1][0], rubiks->grid[1][1][1], rubiks->grid[1][1][2] }, sizeof(tmpv) * 3);
|
|
|
+ rubiks->grid[1][1][0] = rubiks->grid[4][0][1];
|
|
|
+ rubiks->grid[1][1][1] = rubiks->grid[4][1][1];
|
|
|
+ rubiks->grid[1][1][2] = rubiks->grid[4][2][1];
|
|
|
+
|
|
|
+ rubiks->grid[4][0][1] = rubiks->grid[3][1][2];
|
|
|
+ rubiks->grid[4][1][1] = rubiks->grid[3][1][1];
|
|
|
+ rubiks->grid[4][2][1] = rubiks->grid[3][1][0];
|
|
|
+
|
|
|
+ rubiks->grid[3][1][0] = rubiks->grid[2][0][1];
|
|
|
+ rubiks->grid[3][1][1] = rubiks->grid[2][1][1];
|
|
|
+ rubiks->grid[3][1][2] = rubiks->grid[2][2][1];
|
|
|
+
|
|
|
+ rubiks->grid[2][0][1] = tmpv[2];
|
|
|
+ rubiks->grid[2][1][1] = tmpv[1];
|
|
|
+ rubiks->grid[2][2][1] = tmpv[0];
|
|
|
+ }
|
|
|
+ else if (axis == 2)
|
|
|
+ {
|
|
|
+ memcpy(tmpv, (char[3]) { rubiks->grid[1][2][0], rubiks->grid[1][2][1], rubiks->grid[1][2][2] }, sizeof(tmpv) * 3);
|
|
|
+ rubiks->grid[1][2][0] = rubiks->grid[4][0][0];
|
|
|
+ rubiks->grid[1][2][1] = rubiks->grid[4][1][0];
|
|
|
+ rubiks->grid[1][2][2] = rubiks->grid[4][2][0];
|
|
|
+
|
|
|
+ rubiks->grid[4][0][0] = rubiks->grid[3][0][2];
|
|
|
+ rubiks->grid[4][1][0] = rubiks->grid[3][0][1];
|
|
|
+ rubiks->grid[4][2][0] = rubiks->grid[3][0][0];
|
|
|
+
|
|
|
+ rubiks->grid[3][0][0] = rubiks->grid[2][0][2];
|
|
|
+ rubiks->grid[3][0][1] = rubiks->grid[2][1][2];
|
|
|
+ rubiks->grid[3][0][2] = rubiks->grid[2][2][2];
|
|
|
+
|
|
|
+ rubiks->grid[2][0][2] = tmpv[2];
|
|
|
+ rubiks->grid[2][1][2] = tmpv[1];
|
|
|
+ rubiks->grid[2][2][2] = tmpv[0];
|
|
|
+
|
|
|
+ tmp = rubiks->grid[5][0][0];
|
|
|
+ rubiks->grid[5][0][0] = rubiks->grid[5][0][2];
|
|
|
+ rubiks->grid[5][0][2] = rubiks->grid[5][2][2];
|
|
|
+ rubiks->grid[5][2][2] = rubiks->grid[5][2][0];
|
|
|
+ rubiks->grid[5][2][0] = tmp;
|
|
|
+ tmp = rubiks->grid[5][1][0];
|
|
|
+ rubiks->grid[5][1][0] = rubiks->grid[5][0][1];
|
|
|
+ rubiks->grid[5][0][1] = rubiks->grid[5][1][2];
|
|
|
+ rubiks->grid[5][1][2] = rubiks->grid[5][2][1];
|
|
|
+ rubiks->grid[5][2][1] = tmp;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|