more accurately stops on target uses current z target when moving to edge loses unnecessary auto_yaw.set_mode ensure A and B are different