Added sampling from goal region for BITStar. Added BITStar for cartpole, but need to tune SQP. Plotting for cartpole works.
Merge branch 'master' of https://github.com/chrisdxie/rrtstar_and_trajopt

Conflicts:
	other_things/optcontrol/cartpoleV2/cartpole_sqp.cpp