I'll check it... However, It would be wise to program this into mach, that if current Z is higher than SAFE z, then do not go to that level...
(E.g. in my case "before" level was +3, target level was +2, and it went down to something lower than +2)
TOmorrow I do some air-tests...