How to save the trajectory of rovio?

[InkSpade]

I have successfully run the system, but i cannot find the pose.txt of rovio. Can anyone help me?

[InkSpade]

The only way i find is:
In Rovio_Node.hpp, define an ofstream class, and then save the eight data (timestamp, xyz of p, xyzw of q) on the posture of sending IMU to the .txt file under the path you set. code show as below:
o_pose << ros::Time(mpFilter_->safe_.t_) << " " << imuOutput_.WrWB()(0) << " " << imuOutput_.WrWB()(1) << " " << imuOutput_.WrWB()(2) << " "
<< imuOutput_.qBW().x() << " " << imuOutput_.qBW().y()<< " " << imuOutput_.qBW().z() << " " << -imuOutput_.qBW().w() << std::endl;