Added safety measures

If shooter not cocked, intake closes and roller doesnt move. If trying
to cock shooter and high goal not engaged, engage high goal.