Updated Sonar Mapping

Sonar indexing from left, clockwise to back, starting at 0
Fixed connection issue

Fixed redundancy checks causing connection issues. Updated simulator
sonar mapping
Initial Commit
Updated sonar return indexing