22 const double* fullCalibrated,
const double* fullCalibratedCovariance,
26 constexpr
size_t kMeasurementSize = decltype(
N)::
value;
29 calibrated{fullCalibrated};
32 kMeasurementSize,
true>::MeasurementCovariance calibratedCovariance{
33 fullCalibratedCovariance};
36 projector.template topLeftCorner<kMeasurementSize, eBoundSize>().eval();
38 return (
H * predictedCovariance *
H.transpose() + calibratedCovariance)