61 lines
1.8 KiB
Markdown
61 lines
1.8 KiB
Markdown
|
||
|
||
# ORB-SLAM3 -UESTC
|
||
|
||
概述：基于ORB-SLAM3调整的专用版本。`Workspace`目录下的ORB-SLAM3的核心部分源自
|
||
|
||
## 一、基本操作
|
||
|
||
### 1.1 代码的编译和运行
|
||
|
||
代码的编译和运行参考文档`Workspace/README.md`
|
||
|
||
## 二、数据的接入与部署
|
||
|
||
### 2.1 单目摄像头加入IMU数据实时接入
|
||
|
||
由于ORB-SLAM3采用的是读取图片和csv文件的方式运行，不适用于小车的实际实时接入数据。所以，我们需要对原本的读取代码进行改进，并且对我们使用的IMU实现一个读取器。伪代码如下：
|
||
|
||
```c++
|
||
// 单目摄像头+IMU接入ORB-SLAM3伪代码
|
||
|
||
int main(){
|
||
// 创建IMU数据读取器
|
||
IMUReader imuReader("/dev/ttyUSB0");
|
||
// 创建ORB_SLAM3定位系统
|
||
ORB_SLAM3::System SLAM(argv[1],argv[2],ORB_SLAM3::System::IMU_MONOCULAR, true);
|
||
// 默认30fps帧率
|
||
int fps = 30;
|
||
// 初始化摄像头
|
||
cv::VideoCapture cap = cv::VideoCapture(0);
|
||
cap.set(cv::CAP_PROP_FRAME_WIDTH, 640);
|
||
cap.set(cv::CAP_PROP_FRAME_HEIGHT, 480);
|
||
// 清空IMU内部缓存，等待1fps的时间用于填充数据
|
||
imuReader.clear();
|
||
delay_ms(1000 / fps);
|
||
while(true){
|
||
Mat frame;
|
||
// 通过Opencv从摄像头读取视频帧
|
||
cap >> frame;
|
||
// 获取当前系统的时间戳
|
||
tframe = get_systemTick();
|
||
// imuReader从串口读取数据
|
||
IMUData vImuMeas;
|
||
int statsu = imuReader(vImuMeas);
|
||
// 清空IMUReader内部缓存, imuReader内部线程继续读取新的数据
|
||
imuReader.clear();
|
||
// 如果读取IMU状态正确
|
||
if(status){
|
||
// 视觉+IMU VSLAM
|
||
SLAM.TrackMonocular(frame,tframe,vImuMeas);
|
||
}else{
|
||
// 纯视觉 VSLAM
|
||
SLAM.TrackMonocular(frame,tframe);
|
||
}
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
```
|
||
|