hacking a lot of code for acc14

collision checking while sampling, added time to every vertex and
trajectory to check collisions
more hacks

iteration now returns rewired vertices
start writing double integrator with drift
wip on double integrator?

i think it is correct
added dubins_velocity.h

(x,y,\theta, velocity) dubins model