changes to pwm sonar code and cleanup

tilt compensation for sonar added, cleaned up static prototypes in gps
and imu