#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[2][2];
	rubiks->grid[4][1][2] = tmpMatrix[2][1];
	rubiks->grid[4][2][2] = tmpMatrix[2][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])
{
	char tmpMatrix[3][3];

	memcpy(tmpMatrix, rubiks->grid[5], sizeof(tmpMatrix));
	memcpy(rubiks->grid[5], rubiks->grid[4], sizeof(tmpMatrix));
	memcpy(rubiks->grid[4], rubiks->grid[0], sizeof(tmpMatrix));
	memcpy(rubiks->grid[0], rubiks->grid[2], sizeof(tmpMatrix));
	memcpy(rubiks->grid[2], tmpMatrix, sizeof(tmpMatrix));

	memcpy(tmpMatrix, rubiks->grid[1], sizeof(tmpMatrix));
	rubiks->grid[1][0][0] = tmpMatrix[0][2];
	rubiks->grid[1][0][1] = tmpMatrix[1][2];
	rubiks->grid[1][0][2] = tmpMatrix[2][2];
	rubiks->grid[1][1][0] = tmpMatrix[0][1];
	rubiks->grid[1][1][1] = tmpMatrix[1][1];
	rubiks->grid[1][1][2] = tmpMatrix[2][1];
	rubiks->grid[1][2][0] = tmpMatrix[0][0];
	rubiks->grid[1][2][1] = tmpMatrix[1][0];
	rubiks->grid[1][2][2] = tmpMatrix[2][0];

	memcpy(tmpMatrix, rubiks->grid[3], sizeof(tmpMatrix));
	rubiks->grid[3][0][0] = tmpMatrix[2][0];
	rubiks->grid[3][1][0] = tmpMatrix[2][1];
	rubiks->grid[3][2][0] = tmpMatrix[2][2];
	rubiks->grid[3][0][1] = tmpMatrix[1][0];
	rubiks->grid[3][1][1] = tmpMatrix[1][1];
	rubiks->grid[3][2][1] = tmpMatrix[1][2];
	rubiks->grid[3][0][2] = tmpMatrix[0][0];
	rubiks->grid[3][1][2] = tmpMatrix[0][1];
	rubiks->grid[3][2][2] = tmpMatrix[0][2];

	memcpy(tmpMatrix, rubiks->grid[2], sizeof(tmpMatrix));
	rubiks->grid[2][0][0] = tmpMatrix[2][2];
	rubiks->grid[2][1][0] = tmpMatrix[1][2];
	rubiks->grid[2][2][0] = tmpMatrix[0][2];
	rubiks->grid[2][0][1] = tmpMatrix[2][1];
	rubiks->grid[2][1][1] = tmpMatrix[1][1];
	rubiks->grid[2][2][1] = tmpMatrix[0][1];
	rubiks->grid[2][0][2] = tmpMatrix[2][0];
	rubiks->grid[2][1][2] = tmpMatrix[1][0];
	rubiks->grid[2][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[4], sizeof(tmpMatrix));
	memcpy(rubiks->grid[4], rubiks->grid[5], sizeof(tmpMatrix));
	memcpy(rubiks->grid[5], rubiks->grid[2], sizeof(tmpMatrix));
	memcpy(rubiks->grid[2], tmpMatrix, sizeof(tmpMatrix));

	memcpy(tmpMatrix, rubiks->grid[1], sizeof(tmpMatrix));
	rubiks->grid[1][0][0] = tmpMatrix[2][0];
	rubiks->grid[1][1][0] = tmpMatrix[2][1];
	rubiks->grid[1][2][0] = tmpMatrix[2][2];
	rubiks->grid[1][0][1] = tmpMatrix[1][0];
	rubiks->grid[1][1][1] = tmpMatrix[1][1];
	rubiks->grid[1][2][1] = tmpMatrix[1][2];
	rubiks->grid[1][0][2] = tmpMatrix[0][0];
	rubiks->grid[1][1][2] = tmpMatrix[0][1];
	rubiks->grid[1][2][2] = tmpMatrix[0][2];

	memcpy(tmpMatrix, rubiks->grid[3], sizeof(tmpMatrix));
	rubiks->grid[3][0][0] = tmpMatrix[0][2];
	rubiks->grid[3][1][0] = tmpMatrix[0][1];
	rubiks->grid[3][2][0] = tmpMatrix[0][0];
	rubiks->grid[3][0][1] = tmpMatrix[1][2];
	rubiks->grid[3][1][1] = tmpMatrix[1][1];
	rubiks->grid[3][2][1] = tmpMatrix[1][0];
	rubiks->grid[3][0][2] = tmpMatrix[2][2];
	rubiks->grid[3][1][2] = tmpMatrix[2][1];
	rubiks->grid[3][2][2] = tmpMatrix[2][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_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;
	}
}