Added Robot Sonar Scan Logic

Now rotates motor to scan and read sonar readings in real time.
More Work on Real Sonar integrated to localization Procedure