Create Servo.cpp

Initial Servo class implementation.
Also a test commit.