Write sonar sensor function, returns distance in centimetres
Put calibration in its own method
Change photosensor to sonic in specification