- isolate servos calculations via #if defined(SERVO)
- evaluating first and last servo number for cycle time saving

git-svn-id: http://multiwii.googlecode.com/svn/trunk/MultiWii_shared@1423 02679b44-d973-9852-f2fa-63770883b36c