cleaned velociy_controller branch, change to identification_tools branch