Added a Safer return to work zero, Z up to machine zero and move, back down to work zero