working on getting biped to walk a few steps, adding in some balancing code