Adds usbservo skeleton
Adds CS for USB
Cleans c and python