Since you called it a Servo, and then talked about steppers later, I assume you are actually using a true servo for your Z?

Can you share make/model of the servo? Does it have a built in encoder?
Details of wiring from Arduino to servo?