Now usig budsan's vector and matrix math library. It is damn awesome.