摘要: 本发明公开了一种基于P3P算法的位置参数估计方法,包括以下步骤: 1. 对使用的相机进行标定,得到相机参数; 2. 在相机的当前使用位姿下,对空间中的4个特征点进行成像,并获取这4个特征点的世界坐标及其图像坐标; 3. 将这4个特征点分成两组,以对角位置的两个特征点作为公共特征点,将剩余的2个特征点分别与公共特征点组成两组P3P特征点; 4. 根据每组P3P特征点中特征点的世界坐标和图像坐标,利用P3P算法求解出公共特征点位置参数的一组实数解,获取两组P3P特征点对应的两组实数解; 5. 从两组实数解中选取位置参数相似度最大的两个解并进行校验,最终确定出公共特征点的位置参数。
通过确定唯一解并对唯一解进行校验,本方法提高了位置参数解算的效率和准确性。
| 专利名称 | 一种基于P3P算法的位置参数估计方法 | ||
|---|---|---|---|
| 专利状态 | - | 专利号(申请号) | CN201710220035.X |
| 申请号 | - | 专利申请日期 | 2017-04-06 |
| 专利授权日期 | 2017-07-28 | 专利权届满日 | - |
| 专利所属地 | 中国 | 专利类型 | 发明专利 |
| 发明人 | 徐贵力;谢瑒;程月华;姜斌;郭瑞鹏;陈茂武 | ||
| 权利人 | - | ||
| 专利摘要 | 本发明公开了一种基于P3P算法的位置参数估计方法,包括步骤:对使用的相机进行标定得到相机参数;在相机的当前使用位姿下,对空间中的4个特征点进行成像并获取4个特征点的世界坐标及其图像坐标;将4个特征点分成两组,以对角位置的两个特征点作为公共特征点,将剩余的2个特征点分别与公共特征点组成两组P3P特征点;根据每组P3P特征点中特征点的世界坐标和图像坐标,利用P3P算法求解出公共特征点位置参数的一组实数解,获取两组P3P特征点对应的两组实数解;从两组实数解中选取位置参数相似度最大的两个解并进行校验,最终确定出公共特征点的位置参数。通过确定唯一解并对唯一解进行校验,以提高位置参数解算的效率和准确性。 | ||