Calibrated Sonar and made some IR code