def stop(): AffineDemo.stop(params)
def run2(): params['with_velocity']=True HRP4.SetConfig(robot,traj_mod.q_vect[:,params['T']]) AffineDemo.start(params)