#include "Vlib.h"
#include <math.h>

VMatrix  *
VRotate(VMatrix * Mt1, int operation, double angle)
{

	VMatrix   m, s;

	VIdentMatrix(&m);

	switch (operation) {
	case XRotation:
		m.m[1][1] = m.m[2][2] = cos(angle);
		m.m[2][1] = sin(angle);
		m.m[1][2] = -m.m[2][1];
		break;
	case YRotation:
		m.m[0][0] = m.m[2][2] = cos(angle);
		m.m[2][0] = sin(angle);
		m.m[0][2] = -m.m[2][0];
		break;
	case ZRotation:
		m.m[0][0] = m.m[1][1] = cos(angle);
		m.m[1][0] = sin(angle);
		m.m[0][1] = -m.m[1][0];
		break;
	}

	s = *Mt1;

	VMatrixMult(&s, &m, Mt1);
	return Mt1;
}

VMatrix  *
VTranslatePoint(VMatrix * Mt, VPoint loc)
{

	Mt->m[0][3] += loc.x;
	Mt->m[1][3] += loc.y;
	Mt->m[2][3] += loc.z;
	return Mt;

}

VMatrix  *
VTranslate(VMatrix * Mt, double x, double y, double z)
{

	Mt->m[0][3] += x;
	Mt->m[1][3] += y;
	Mt->m[2][3] += z;
	return Mt;
}