Hi

Have you wired the printer for the BL touch (taken out the Z axis limit switch) or for the normal setup (no BL touch).

If you are digging into customizing your own firmware, go for the latest version and roll your own. It will take a bit of time, but at least you will have all the latest features.

Bob