Implemenented more math functionality and started on a vector 3 which is
going to be SSE accelerated