Work on collision-aware differentialrobot