Changed getDistance() to match datasheet

Changed getDistance() to match datasheet
added drive servos to interface with ping sensor