Barrier Collisions Correction

[Robots] Collision correction correctly functions.