Function lupnt::CalculatePDOP

Function Documentation

double lupnt::CalculatePDOP(const MatXd &covariance_matrix)

Calculate Position Dilution of Precision (PDOP)

Assumes first 3 state elements are position

Parameters:

covariance_matrixState covariance matrix [n_state x n_state]

Returns:

double PDOP value (sqrt of trace of position block)