@dc42 I dont know why i didn't think about backlash. commented out the extra z movments and perfect!
Thank you.