Lidar ST VL53L1X Holybro is not working during Automission plan

I am using Lidar ST VL53L1X from holybro with ardupilot firmware, this lidar is set facing down detecting altitude. It is working when position mode or loiter mode, meaning drone will automatically going up when detecting elevated ground level when flying it with the position/loiter mode. But when I use it with automission plan mode, lidar is not working, i mean it doesnt react when detecting low ground level.(mission plan is at 4m altitude in all waypoints but1 waypoint, it got much higher ground level in which the drone should automatically up to maintain the 4m altitude). Please help on how to fix this.

also please let me know what is the best rangefinder with ardupilot firmware with auto mission mode.