Improved servo command.
Servos are given PID when turned on.