Avoidance collision done!
Right now, we need to pass the target point to each robot through and
additional LCM channel.