基于单目视觉的钻车姿态测量方法
基本信息
申请号 | CN201210052435.1 | 申请日 | - |
公开(公告)号 | CN103292807B | 公开(公告)日 | 2016-04-20 |
申请公布号 | CN103292807B | 申请公布日 | 2016-04-20 |
分类号 | G01C21/10(2006.01)I;G01C11/00(2006.01)I | 分类 | 测量;测试; |
发明人 | 余意;杨平;李逊 | 申请(专利权)人 | 江苏中科百易矿业科技有限公司 |
代理机构 | 江阴市同盛专利事务所(普通合伙) | 代理人 | 唐纫兰;曾丹 |
地址 | 214434 江苏省无锡市江阴市澄江中路159号A1008 | ||
法律状态 | - |
摘要
摘要 | 本发明涉及一种基于单目视觉的钻车姿态测量方法,利用摄像机采集光点图像,利用矿用工业计算机处理该光点图像,以光点的图像坐标作为特征点,利用摄像机内参数和公知的正交迭代方法求解P4P问题,计算出光点矩形相对于摄像机的姿态,并结合光点矩形相对于钻车的姿态、摄像机相对于辅助平台的姿态、辅助平台相对于地理坐标系的姿态,通过坐标变换计算出钻车相对于地理坐标系的姿态。本发明能够对钻车姿态进行非接触式测量,避免钻车电磁信号对姿态传感器的干扰,所使用的测量方法算法成熟,可靠性高,测量精度高。 |
