Added documentation; seperated analog and digital servo; fixed bug