KOKIAOKI / 3d_bbs

MIT License
192 stars 30 forks source link

min_rpy and max_rpy setting and result question #36

Open j953302 opened 4 months ago

j953302 commented 4 months ago

Hello, I used my own data and use cpu to test 3d_bbs. And I set the min_rpy and max_rpy in config below: min_rpy: [0.0,-2.0,2.0] max_rpy: [2.5,-1.0,2.2]

However, the result of [roll, pitch, yaw] is out of my setting. It will output: Roll: 2.48698, Pitch: 0.820313, Yaw: -2.1461e-08. The result I get it from below:

tf2::Quaternion temp(q.x(), q.y(), q.z(), q.w()); tf2::Quaternion temp(q.x(), q.y(), q.z(), q.w()); tf2::Matrix3x3 m(temp);

double roll, pitch, yaw; m.getRPY(roll, pitch, yaw);

Is it correct? Thank you.

2024-06-27 15-02-39 的螢幕擷圖

KOKIAOKI commented 4 months ago

Hi! Thank you for trying 3D-BBS.

If I reproduce this problem on my data, I will repot it here.