Rotation.cpp

#include "Rotation.h"

#include <stdexcept>
#include <cmath>

void rotatePointND(const float* point, int dimensions, const float* angles, float* rotatedPoint) {
	if (dimensions < 2) {
		throw std::invalid_argument("Dimensions must be at least 2.");
	}

	// Copy the input point to the output rotatedPoint array
	std::memcpy(rotatedPoint, point, dimensions * sizeof(float));

	for (int i = 0; i < dimensions; ++i) {
		int j = (i + 1) % dimensions; // Wrap around for the last dimension
		float x = rotatedPoint[i];
		float y = rotatedPoint[j];

		float sina = std::sinf(angles[i]);
		float cosa = std::cosf(angles[i]);

		rotatedPoint[i] = x * cosa - y * sina;
		rotatedPoint[j] = x * sina + y * cosa;
	}
}

void rotateTesseractVertices(const float* tesseractVertices, int vertexCount, int dimensions, const float* angles, float* rotatedVertices) {
	for (int i = 0; i < vertexCount; ++i) {
		rotatePointND(&tesseractVertices[i * dimensions], dimensions, angles, &rotatedVertices[i * dimensions]);
	}
}