Implemented BIT Star for point robot example
Merge branch 'master' of https://github.com/chrisdxie/rrtstar_and_trajopt

Conflicts:
	other_things/My_BITStar_Impl/point_robot/Edge.h
	other_things/My_BITStar_Impl/point_robot/plot_bitstar.cpp
Minor optimizations
optimized actual cost calls
BITStar for double integrator up and ready to run
Merge branch 'master' into rll3

Conflicts:
	other_things/double_integrator_FORCES/SQP/without_CD/double_integrator_noCD_sqp.cpp
	other_things/double_integrator_FORCES/SQP/without_CD/double_integrator_noCD_sqp.hpp