I finally got everything working again with rewritten vector, matrix and quaternion classes, even though there is still something strange with the coordinatesystem...
The rest of the evening will go into comments for Doxygen.