Initial version of servo controller code added
1. Added serial comms code
2. Using arduino for controlling servos