Servo

Added code for servo and solenoid