Added basic control FSM transition loop. Shifted to new BipedHopper class to encapsulate control & updates