@jay_s_uk Ok. It seems that it is working for me right now.
The most importat thing was to tune H param and find the lowest value where stall is not detected then tune S parameter to the value which work when real crash happend at the end of Z axis.
Thanks a lot for your help 🙂