HKUST-Aerial-Robotics / VINS-Fusion

An optimization-based multi-sensor state estimator
GNU General Public License v3.0
3.42k stars 1.37k forks source link

the global optimization thread doesn`t work properly #3

Open AIgithub22 opened 5 years ago

AIgithub22 commented 5 years ago

I test vins-fusion with my own device (global shutter camera + imu + gps(RTK) put those together but not hardware synchronized) and set estimate_td to 1, online estimate time offset between camera and imu. it seems that the global optimization thread doesn`t work properly, at most time the global optimized path overlay exactly with the vio odometry path, however the gps(RTK) path was not overlay with those two path. And sometimes the global optimized path jumps for a short distance and ran off very fast , but the gps and vio path still works fine. I could sent my rosbag to you if you are interested. img_1262

pjrambo commented 5 years ago

I test vins-fusion with my own device (global shutter camera + imu + gps(RTK) put those together but not hardware synchronized) and set estimate_td to 1, online estimate time offset between camera and imu. it seems that the global optimization thread doesn`t work properly, at most time the global optimized path overlay exactly with the vio odometry path, however the gps(RTK) path was not overlay with those two path. And sometimes the global optimized path jumps for a short distance and ran off very fast , but the gps and vio path still works fine. I could sent my rosbag to you if you are interested. img_1262

According to your description, I guess the unsynchronized (imu+camera) and GPS may cause that problem. If your gps timestamp has a big time delay, at the beginning the estimator can not get the corresponding gps data, so your vio path may be same with the global path. Once the first time the estimator get the gps data, because of the unsynchronized data, it may optimize vio data with wrong gps data, which may lead to the issue as you said. If this is not the reason for your case, you may send me your bag and config file. You can send it to jpanai@connect.ust.hk or just attach the link below.

zjlooojoe commented 5 years ago

Can you tell me where the dataset you get?Because I want to use imu+camera+gps too,but I cant find a good dataset.KITTI has the three,but the rate of imu is same with gps and camera.Maybe the kitti's unsynchronized data is what I want?

HpyZhai commented 5 years ago

I have the same problem as you. Did you solve it?

zjlooojoe commented 5 years ago

https://github.com/HKUST-Aerial-Robotics/VINS-Fusion/issues/39 Do you mean that?

------------------ 原始邮件 ------------------ 发件人: "HpyZhai"notifications@github.com; 发送时间: 2019年5月10日(星期五) 下午3:55 收件人: "HKUST-Aerial-Robotics/VINS-Fusion"VINS-Fusion@noreply.github.com; 抄送: "logee."378760906@qq.com; "Comment"comment@noreply.github.com; 主题: Re: [HKUST-Aerial-Robotics/VINS-Fusion] the global optimizationthread doesn`t work properly (#3)

I have the same problem as you. Did you solve it?

— You are receiving this because you commented. Reply to this email directly, view it on GitHub, or mute the thread.

HpyZhai commented 5 years ago

No, I mean the fusion path is very similar to the vio odometry path. The reason is that my gps timestamp is not the same as the vio corresponding timestamp. So the gps position constrain can't work. The code in line 160,in the globalOpt.cpp causes the problem.

yichengethanli commented 2 years ago

I test vins-fusion with my own device (global shutter camera + imu + gps(RTK) put those together but not hardware synchronized) and set estimate_td to 1, online estimate time offset between camera and imu. it seems that the global optimization thread doesn`t work properly, at most time the global optimized path overlay exactly with the vio odometry path, however the gps(RTK) path was not overlay with those two path. And sometimes the global optimized path jumps for a short distance and ran off very fast , but the gps and vio path still works fine. I could sent my rosbag to you if you are interested. img_1262

Hi, I am currently working on a similar project that I would like to fuse GNSS/RTK data with VIO. Im quite interested in your experiment and wonder if I can take a look at your dataset. Could you send your rosbag dataset? My email is lyc0732@hotmail.com. Please feel free to contact me. Thanks.