Update run_robot to fix bug in initialization