Modified Initialize process and added sonar (not done)