Fixed sonar positions in the mapper, completed successful test of sonar's in hallway.