该项目主要用来计算多相机的车辆定位算法,主要代码在pose_estimation_3d2d.cpp,
运行命令为./pose_estimation_3d2d,
该项目数据为华润装载机采集的数据,使用的相机为前视相机与后视相机,通过前视相机采集的
反光标志特征点像素坐标以及后视相机采集的特征点像素坐标,然后与地图中的3d点坐标投影到2d
中的投影坐标进行求差,迭代优化使差最小化;
其中的难点在于,不同的相机内参以及相机到车体的外参不一样,所以导致高斯牛顿法的雅克比矩阵需要
重新求解;
解决思路:
原有解决方法为,将雅克比矩阵分为两部分,一部分为相机坐标系下的坐标(X、Y、Z)转化为像素坐标(U、V),然后由U、V分别对x、y、z求偏导得到的2行3列的雅克比矩阵;
另一部分为世界坐标系的点转换到相机坐标系,计算旋转之后点的坐标相对于(旋转、平移)的导数,扰动量为旋转平移矩阵,即旋转平移矩阵的稍微变化;即可以得到3行6列的雅克比矩阵;
将这两部分雅克比矩阵相乘即可以得到2行6列的雅克比矩阵;
创新点:
将上述方法中的基准坐标系为相机坐标系转换为整车坐标系,
从而将世界坐标系转换到整车坐标系的坐标相对于(旋转、平移)的导数的雅克比矩阵不变,
从而只需要修改第一部分,不过由于从整车坐标系转换为像素坐标,还需要为K*RT*P,所以需要将
外参矩阵进行计算从而来进行求偏导得到雅克比矩阵,具体计算在代码中;
没有合适的资源?快使用搜索试试~ 我知道了~
通过直线向量来迭代优化相机外参,可以用来求解相机与激光雷达外参,也可以用来求解相机与车身外参
共43个文件
cmake:9个
txt:4个
make:4个
需积分: 5 0 下载量 65 浏览量
2023-06-20
16:02:13
上传
评论 1
收藏 141.58MB ZIP 举报
温馨提示
数据为激光雷达与相机数据,采用地面上平行的三条直线来进行相机旋转外参求解,
资源推荐
资源详情
资源评论
收起资源包目录
相机直线迭代优化外参_平行直线_相机与激光雷达测试_2.zip (43个子文件)
相机直线迭代优化外参_平行直线_相机与激光雷达测试_2
cloud_lidar.pcd 192.27MB
pose_estimation_3d2d.cpp 25KB
CMakeLists.txt 1KB
.vscode
c_cpp_properties.json 483B
settings.json 332B
cmake
FindG2O.cmake 3KB
cloud_car.pcd 145.13MB
build
CMakeFiles
Makefile2 4KB
feature_tests.c 688B
CMakeDirectoryInformation.cmake 830B
cmake.check_cache 85B
pose_estimation_3d2d.dir
CXX.includecache 21KB
link.txt 2KB
depend.internal 8KB
depend.make 16KB
flags.make 279B
DependInfo.cmake 956B
cmake_clean.cmake 310B
build.make 9KB
pose_estimation_3d2d.cpp.o 70KB
progress.make 43B
3.14.2
CompilerIdC
CMakeCCompilerId.c 20KB
tmp
a.out 8KB
CMakeDetermineCompilerABI_CXX.bin 8KB
CMakeCXXCompiler.cmake 5KB
CMakeSystem.cmake 402B
CMakeCCompiler.cmake 2KB
CMakeDetermineCompilerABI_C.bin 8KB
CompilerIdCXX
tmp
CMakeCXXCompilerId.cpp 19KB
a.out 8KB
feature_tests.cxx 10KB
CMakeTmp
feature_tests.bin 12KB
Makefile.cmake 8KB
progress.marks 2B
CMakeOutput.log 71KB
TargetDirectories.txt 484B
cmake_install.cmake 2KB
Makefile 6KB
pose_estimation_3d2d 59KB
CMakeCache.txt 17KB
218.jpg 520KB
README.md 2KB
218_convert_calib.jpg_03.jpg 489KB
共 43 条
- 1
资源评论
LKJLKJPOI
- 粉丝: 12
- 资源: 33
上传资源 快速赚钱
- 我的内容管理 展开
- 我的资源 快来上传第一个资源
- 我的收益 登录查看自己的收益
- 我的积分 登录查看自己的积分
- 我的C币 登录后查看C币余额
- 我的收藏
- 我的下载
- 下载帮助
最新资源
- 目标检测-手机屏幕表面缺陷检测数据集-1200张图-+对应VOC-COCO-YOLO三种格式标签+数据集划分脚本
- 「天若有情 」深情版--天下万般兵刃 唯有过往伤人最深.mp3
- 123456daWDdwD
- 用友U810.1数据库字典-只需要1积分
- 基于opencv和numpy的customtkinter图像处理工具
- 最新1.8JDK的PostgreSQL JDBC 驱动包
- stlink驱动+J-Link驱动+ST-LINK utility工具
- 项目实战-Python基于KMeans算法进行文本聚类项目实战.zip
- 弹幕视频网站 java源代码毕业设计毕业论文
- 多用户博客个人网站java源代码毕业设计毕业论文
资源上传下载、课程学习等过程中有任何疑问或建议,欢迎提出宝贵意见哦~我们会及时处理!
点击此处反馈
安全验证
文档复制为VIP权益,开通VIP直接复制
信息提交成功