implemented segment following, and tweaked the constants to be more like the sample app - it's now mostly working!
added vec2 class, code cleanup