z_drive: updated angle changes