fuck c++
minor changes, checking collision of timed trajectories, etc.
minor changes in rrts.h
Merge branch 'master' of https://github.com/pratikac/smpl

Conflicts:
	src/test_main.cpp