Revert "Changing so servo isn't setup until after increment command is executed.  Testing a possible bug"

This reverts commit 3e9e8454aa17144e5913a9bdff242107f7fa3d79.