Read the flight modes APM has.
Uhmm I thought it was not possible. It's a long time I don't use MAVROS, so I'm not the best person to guide you.
You can try reading the altitude of the copter and go up until you reach desired one.
The best is to ask in the MAVROS gitter channel, you'll find devs there.