Improved gait a bit, added torso orientation parameter, removed hip extension torque
Signed-off-by: Darpa Tech 3 <darpa3@DARPATECH3.(none)>