Added vector datatype (supports up to 3 dimensions).
Change to vector interface on nav's end.
Forgot to update bezier curve code to handle vectors.
Prettifying
Merge branch 'develop' into test

Merge vector changes into test branch.