change command to moving to level instead of target angle and simplify isFinished