Added Jan's Ultrasonic Sensor Fixes to BrickPi.py

Updated Jan's Ultrasonic Sensor Fixes to BrickPi.py