Waypoints fixed.
Collision in sublevel1 prepared