Add some math helpers, finish up 2d vectors