Fix some schoolboy errors
Tune servo limits
Fix up servo to port mappings