needle case. not working as expected yet
Merge branch 'moving_sensor' of github.com:dementrock/trajopt into moving_sensor

Conflicts:
	src/bsp/bsp_planner.hpp
toy