mavros_apriltag_tracking icon indicating copy to clipboard operation
mavros_apriltag_tracking copied to clipboard

`lhs.cols() == rhs.rows() && "invalid matrix product" && "if you wanted a coeff-wise or a dot product use the respective explicit functions"' failed.

Open Areswangin opened this issue 4 years ago • 4 comments

something wrong happened in kf_tracker_node at the beginning everthing was right until the camera saw the AprilTag the WARN is: WARN [ekf2] accel id changed, resetting IMU bias [ WARN] [1608694132.622066666, 91.300000000]: Filter is not initialized. Requires a measurement first. [ WARN] [1608694134.356203831, 92.300000000]: Filter is not initialized. Requires a measurement first. [ WARN] [1608694135.969268538, 93.300000000]: Filter is not initialized. Requires a measurement first. [ WARN] [1608694137.616753039, 94.300000000]: Filter is not initialized. Requires a measurement first. [ WARN] [1608694139.297956798, 95.300000000]: Filter is not initialized. Requires a measurement first. [WARN] [1608694140.634558, 96.148000]: No valid local pose TF for the required tag 0 [ INFO] [1608694140.642055454, 96.152000000]: KF state estimate is initialized. kf_tracker_node: /usr/include/eigen3/Eigen/src/Core/Product.h:97: Eigen::Product<Lhs, Rhs, Option>::Product(const Lhs&, const Rhs&) [with _Lhs = Eigen::Matrix<double, -1, -1>; _Rhs = Eigen::Matrix<double, -1, 1>; int Option = 0; Eigen::Product<Lhs, Rhs, Option>::Lhs = Eigen::Matrix<double, -1, -1>; Eigen::Product<Lhs, Rhs, Option>::Rhs = Eigen::Matrix<double, -1, 1>]: Assertion `lhs.cols() == rhs.rows() && "invalid matrix product" && "if you wanted a coeff-wise or a dot product use the respective explicit functions"' failed. [WARN] [1608694140.743216, 96.204000]: No valid local pose TF for the required tag 0 [WARN] [1608694140.908896, 96.270000]: No valid local pose TF for the required tag 0 [WARN] [1608694141.108050, 96.374000]: No valid local pose TF for the required tag 0 After that all the WARN was the same: No valid local pose TF for the required tag 0 My Eigen version is 3.3.4. Is there anything wrong with eigen?

Areswangin avatar Dec 23 '20 04:12 Areswangin

@Areswangin The docker installation should work fine as described in the instructions. Are you using the docker installation method, or you are doing it manually?

mzahana avatar Dec 23 '20 13:12 mzahana

@mzahana I didn't use docker. Instead, I followed the Normal installation to install and use it. My system is Ubuntu18.04 + Ros melodic.

Areswangin avatar Dec 23 '20 13:12 Areswangin

Try replacing line 268 with:

kf_state_pred_.x(0,0)= z_meas_.z(0) ; kf_state_pred_.x(1,0)= z_meas_.z(1) ; kf_state_pred_.x(2,0)= z_meas_.z(2) ;

FrankvVeelen avatar Jan 21 '22 15:01 FrankvVeelen

Hi. I used docker. I am also getting this message. The drone is not taking off.

souravsanyal06 avatar Feb 14 '23 19:02 souravsanyal06