Implemented Sonar Sensor and Servo Motor methods

Created class commands for sonar sensor and rc servo motor.