Z Axis going to wrong position consistently