Simple vector class implementation.

It can currently calculate waypoints.