First commit with integration beetwen arduino, servo and sonar sensor