Defensive mechanism code added

Added code for a servo that can be controller by the right trigger and
button on the secondary controller