no output from ethzasl_sensor_fusion #28
Comments
|
After some research we discovered that our Problem is that the init function is never called and the the variable initialized_ is never set to true. |
|
Usually we trigger the filter initialization using dynamic reconfigure or a service call. Do you see the init-checkbox in dynamic reconfigure? |
|
Thank for the hint, the init is done and we get an output. |
|
please verify if the MAV is switched on and the parameters are correctly set in the dynamic reconfigure gui: Best, From: pelicanunimd [[email protected]] Thank for the hint, the init is done and we get an output. — |
|
Thanks for ur answer. We have set all parameters like described in the tutorial. |
|
I read your previous post too fast - it is not ekf_state_in but ekf_state_out you need to map to hl_state_input (ekf_state_in is the update the filter sends to the HL controller for state integration, it is ok if the accs and gyros are zero in this message). See the sample rxgraph here: hope this helps. Best, From: pelicanunimd [[email protected]] Thanks for ur answer. We have set all parameters like described in the tutorial. — |
|
We already have mappped ekf_state_out to hl_state_input (see our qt_graph which is attached to our first post). You have any more hints, whats the reason for our problem? |
|
Hey again, With the setup of the camera we got an further issue. The reason is, that our axis are alinged different to your description. So we rotated the axis of our Kinect causing the x Axis to be inverted. But after this the z-axis is inverted also. |
|
the rotation and translation between camera and IMU is captured in the q_ic and p_ic parameters in the yaml file respectively. If it is easier for you, you can express the rotation between the two sensors as a rotation matrix and convert it (e.g. with MATLAB) to a quaternion. There is no need to have the setup look exactly like ours. Best, From: pelicanunimd [[email protected]] Hey again, With the setup of the camera we got an further issue. The reason is, that our axis are alinged different to your description. So we rotated the axis of our Kinect causing the x Axis to be inverted. But after this the z-axis is inverted also. — |
|
Hey again, we got a woking setup with a camera bound upward. But our camera is aktually looking sideways (directed to positive y). Setup 1 is the working setup for the camera looking sideways. There we rotated the camera and IMU for 270 degrees around the x - axis, so its bound upward. Setup 1: init/p_ci/x: 0.0 initialization of world w.r.t. vision In this setup we want the camera to look forward. For this we further rotated camera and IMU for 90 degrees around the z - axis. So we got the following setup: Setup 2: init/p_ci/x: 0.0 initialization of world w.r.t. vision Our Questions are: 1.) Did we transformation right for the described setups? 2.) When they're right, why were recieving just NAN Errors? Best |
Hello,
we got an disturbing problem here. We've set up ethzasl_ptam and asctec_mav_framework to use it on our pelican with ethzasl_sensor_fusion.
ptam and mav_framework delivere the expected data on the outputs (/vslam/pose, /fcu/ekf_state_out) and we also mapped the inputs for the sensor_fusion on these outputs.
Everything looks to be fine and there are no errors but the sensor_fusion dont deliver any data on the output. Neither on /fcu/ekf_state_in nor on /ssf_core/pose. Echo call stays empty. We also configured the parameter files like described in the tutorial.
Can anybody tell us whats the problem?
We attached our rqt_graph.
The text was updated successfully, but these errors were encountered: