利索能及
我要发布
收藏
专利号: 2020108803795
申请人: 河海大学
专利类型:发明专利
专利状态:已下证
更新日期:2026-06-16
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种贴纸式的物体空间定位系统,其特征在于:包括数字图像处理模块、目标位姿变化识别模块、坐标系维度转换模块;

其中,数字图像处理模块,用于利用OpenCV的findContours函数来获取连通域的外轮廓点的集合,采用Canny边缘检测算法从图像中提取各个色块,并依据色块大小的同一性,用范围排除法对图像色块进行去除噪声,清理外点,从而得以较为准确的提取出图像中的每个色块;

目标位姿变化识别模块,用于通过数字处理模块中所提取的色块确定目标位置及朝向,并根据上下帧时间差及目标在相应时间内的位移,计算瞬时速度、加速度、角速度等数据信息;

坐标系维度转换模块,用于通过标定棋盘格并通过矩阵变换求解得到内参、畸变参数、外参参数,从而通过矩阵变换将二维坐标系转换至三维坐标系,并最终得到在三维坐标系下,目标的朝向、运行轨迹、位置、瞬时速度、加速度、角速度情况。

2.一种基于权利要求1所述的贴纸式的物体空间定位系统的定位方法,其特征在于:具体包含如下步骤;

步骤1,数字图像处理:利用OpenCV的findContours函数来获取连通域的外轮廓点的集合,采用Canny边缘检测算法从图像中提取各个色块,并依据色块大小的同一性,用范围排除法对图像色块进行去除噪声,清理外点,从而得以较为准确的提取出图像中的每个色块;

步骤2,目标位姿变化识别与识别:在目标对应的色块聚类内,检索两点间距离最大的两点,即对应色块贴纸底边两个黑色色块,作两点的中垂线,则得到目标朝向;将两黑点的中点作为目标定位点,根据上下连续帧的图像即可通过计算得到目标的运行轨迹、位置、瞬时速度、加速度、角速度等数据信息;

步骤3,坐标系转换:具体如下:

步骤3.1,将图像的二维坐标系转换为三维坐标系;

步骤3.2,对图像中的特征点如棋盘格角点进行检测,得到棋盘格角点的像素坐标值,根据已知的棋盘格大小和世界坐标系原点,计算得到标定板角点的物理坐标值。根据物理坐标值和像素坐标值的关系,求解相机内参矩阵,最后求解每张图片对应的相机外参矩阵,计算畸变参数,并利用L-M算法对上述参数进行优化,其中L-M具体为Levenberg-Marquardt;

通过从图像坐标系中的点坐标乘以内参、畸变参数、外参之后,得到世界坐标系下点的

2维位置;具体计算公式如下:

其中,左项为世界坐标系中的物体坐标,zc为相机到平面的距离,T-1为外参矩阵,K-1为内参矩阵与畸变矩阵的乘积,最右项为图像坐标,即可将目标坐标系转换至三维坐标系;

在三维坐标系下,根据上下两帧的时间差以及目标在相应时间内所移动的位移,根据公式 公式即可得到在三维坐标系下,各个目标的朝向、运行轨迹、位置、瞬时速度、加速度、角速度信息。