Fifth rework and it finally works, damn quaternions