Corrections on the algo
- add correction for the right and left ultrasonic sensor