Moved test program to header folder.
Corrected type in for loops for maths::Vector.