AC_PosControl: 4hz filter on z-axis velocity error