Debugging radial plan
Merge branch 'adam_PID' of https://github.com/cedricpradalier/ros_kf_stack into adam_PID

Conflicts:
	sim_tasks/tasks/TaskGoTo.cpp
	sim_tasks_cfg/cfg/TaskGoTo.cfg