I just created a library for doing vector/matrix math. I whipped it up in about 2 hours.
Just take a look at it and tell me what you think! oh and you can use it too if you want.
(oh I had to change the extension to .cpp because the board doesn't like .cs files from C#)
Attachment 8287