Scale x and y when z is truncated
Wait for transform in kalman filter