Changes done Group Meeting #3

Adding Interface Code for Servo and Sonar