z_drive: updated angle changes
z_drive: limited inital thrusts