Work on collision-aware differentialrobot
RCIS::DifferentialRobot is now collision-aware