Closed Masterzhoujun closed 5 years ago
why update state_server.state_cov use: MatrixXd state_cov_fixed = (state_server.state_cov + state_server.state_cov.transpose()) / 2.0; state_server.state_cov = state_cov_fixed; any reference paper for this? THX
It is just a trick to ensure the covariance matrix is symmetric. =)
why update state_server.state_cov use: MatrixXd state_cov_fixed = (state_server.state_cov + state_server.state_cov.transpose()) / 2.0; state_server.state_cov = state_cov_fixed; any reference paper for this? THX