correcting sv>0 in xk at the same time as p_X->proj in kalman so that hat does not go <0