Obstacle Avoidance PH G1G2 (with shape preservation technics)