Working kicker and pick-up state machine

Tested wind-up, kick, pick-up lowering and raising
Merge branch 'master' of https://github.com/bobwolff68/FRCTeam1967