Debug/fixing colli avo control crashing

Jianfeng Gaorequested to merge
debug/fixing_colli_avo_control_crashing into master

aligning with recent changes in skills/control

Merge request reports