Method and system for collision avoidance

Example implementations involve systems and methods to control the ego vehicle to trace connected plural curved paths, which are calculated as the movement of the vehicle 300 against vertical repulsive force from straight or curved walls, and connected continuously at the joints, and differentiable by position at the joints. Further, the repulsion force 301 acts as deceleration force and lateral force.