Size optimizations and re-enabled manual override on B servo