In EKF.updateFromReobservedFeatures(): changed conversion of P to
double[][] to use extractSubMatrix() instead of calling toArray then
casting.