Z Axis Control for Avoidance

Wait… nevermind. EDIT you have a Diode… I had linked to a previous post of mine suggesting, but obviously (now that I realize you have a diode) this will not apply to you.