Skip to content

Commit 6d3d046

Browse files
committed
use eigen methods
Signed-off-by: Yutaka Kondo <yutaka.kondo@youtalk.jp>
1 parent 0249d15 commit 6d3d046

File tree

1 file changed

+1
-1
lines changed

1 file changed

+1
-1
lines changed

common/autoware_kalman_filter/src/kalman_filter.cpp

+1-1
Original file line numberDiff line numberDiff line change
@@ -130,7 +130,7 @@ bool KalmanFilter::update(
130130
const Eigen::MatrixXd PCT = P_ * C.transpose();
131131
const Eigen::MatrixXd K = PCT * ((R + C * PCT).inverse());
132132

133-
if (isnan(K.array()).any() || isinf(K.array()).any()) {
133+
if (K.array().isNaN().any() || K.array().isInf().any()) {
134134
return false;
135135
}
136136

0 commit comments

Comments
 (0)