Fixed servo movement by M280 command