Increase the dive height. It's the H parameter in the M558 command.