added z-axis control and updated xy-movement