TAZ 5 nozzle autolevel

i am having issues with layer shift on taz 5 after using NOZZLE_TO_PROBE leveling on my TAZ 5. the firmware i am using is one i made. https://github.com/knightdb/taz-trial-2…was wondering if someone with more experience would be able to check out my coding and see if i am missing something or if a fan setting is off.