Servo Code

Updated servo code and added a commented skeleton for new collector
platform slide