公开/公告号CN112556558A
专利类型发明专利
公开/公告日2021-03-26
原文格式PDF
申请/专利权人 无锡黎曼机器人科技有限公司;
申请/专利号CN202011377972.4
申请日2020-11-30
分类号G01B7/004(20060101);G01B11/00(20060101);
代理机构32325 常州唯思百得知识产权代理事务所(普通合伙);
代理人金辉
地址 214000 江苏省无锡市惠山区惠山经济开发区堰新路311号1号楼0501室
入库时间 2023-06-19 10:24:22
技术领域
本发明涉及机器视觉领域,尤其涉及一种基于激光雷达和室内GPS系统的飞机大尺寸测量系统及方法。
背景技术
随着我国先进制造技术的发展,数字化测量技术已经广泛地应用在航天、航空、船舶制造等领域。尤其是数字化大尺寸测量系统已经逐渐应用到飞机大尺寸工件的加工和装配过程中,其利用数字化测量系统的高精度测量提升飞机的装配精度。
数字化大尺寸测量技术目前主要分为接触式测量和非接触式测量,接触式测量主要包括激光跟踪仪和室内GPS测量,非接触式测量主要包括电子经纬仪测量系统、数字近景工业测量系统、激光雷达测量系统。对飞机大构件表面进行测量时,首选的应该是激光雷达这种非接触式测量方式,因为激光雷达能够快速准确的进行大范围的测量,但是激光雷达的缺点在于激光雷达的水平和竖直角度测量范围都有限制,需要频繁的进行转站操作,这样会引入由于转站带来的累计误差。此外目前测量系统一般都需要占据大量的空间,而且不具备机动性。对于飞机制造装配车间而言,可移动的测量系统对于飞机大构件测量是迫切需要的。
发明内容
本发明的目的是克服现有技术存在的缺陷,提供一种基于激光雷达和室内GPS系统的飞机大尺寸测量系统及方法,该系统和方法以室内GPS系统的全局坐标系作为全局坐标系,将激光雷达在多个站位的测量数据全部转换到全局坐标系中,减少了由于转站而产生的累计误差,同时由于使用AGV小车加机器人的方式携带激光雷达进行扫描,测量灵活,满足飞机制造装配车间对于空间的要求。
实现本发明目的的技术方案是:一种基于激光雷达和室内GPS系统的飞机大尺寸测量系统,包括安装有机器人的AGV小车、夹持在机器人机械手臂末端的激光雷达和标准坐标系参考板以及室内GPS系统;所述室内GPS系统建立有全局坐标系Q;所述室内GPS系统监测标准坐标系参考板在室内GPS系统建立的全局坐标系Q下的位姿。
优选地,飞机大尺寸测量系统工作时所述激光雷达和标准坐标系参考板之间的相对位姿保持不变。
优选地,所述激光雷达可建立一个激光雷达坐标系L。
优选地,所述标准坐标系参考板上布置有三个球形接收器;三个所述球形接收器的球心可建立一个标准参考坐标系S。
优选地,三个所述球形接收器的连线呈直角,且直角两端处的球形接收器到直角处球形接收器的距离不同。
优选地,所述室内GPS系统包括IGPS发射器、分别布置于室内和标准坐标系参考板上的球形接收器及中央处理器;所述IGPS发射器布置在室内空间的多个位置处。
一种基于激光雷达和室内GPS系统的飞机大尺寸测量方法,包括上述基于激光雷达和室内GPS系统的飞机大尺寸测量系统;还包括以下步骤:
步骤一:室内GPS系统标定,室内GPS系统标定各个IGPS发射器之间的关系,建立飞机大尺寸测量系统的全局坐标系Q;
步骤二:通过激光雷达坐标系L和标准参考坐标系S标定来确定激光雷达坐标系L相对于标准参考坐标系S之间的位姿关系
步骤三:AGV小车携带激光雷达扫描飞机构件进行数据采集,激光雷达在多个站位扫描得到点云数据,随后将点云数据转换到标准参考坐标系S中;
步骤四:实时识别标准参考坐标系S在全局坐标系Q中的位姿;
步骤五:将采集到的点云数据全部转换到全局坐标系Q下
步骤六:通过中央处理器对点云数据进行处理,即可完成对飞机大构件的测量。
优选地,所述步骤二中
优选地,所述
以A、B、C三点建立的标准参考坐标系S相对于全局坐标系Q的位姿关系
其中p=(x
优选地,所述
假设有两个点组p
其中p
根据质心重合的假设,我们有:
然后令:
最后构件最小二乘函数求解:
SVD分解算法流程为:
(1)根据p
(2)计算3×3矩阵
其中p
(3)对H进行SVD分解
H=USV
(4)计算X=VU
(5)计算X的行列式det(X)
若det(X)=1,R=X;若det(X)=-1,算法失败;在得到旋转矩阵R之后,平移矩阵t可以通过如下公式计算:
至此求出
采用上述技术方案后,本发明具有以下积极的效果:
(1)本发明以室内GPS系统的全局坐标系作为全局坐标系,将激光雷达在多个站位的测量数据全部转换到全局坐标系中,减少了由于转站而产生的累计误差,同时由于使用AGV小车加机器人的方式携带激光雷达进行扫描,测量灵活,对于室内空间的要求不大,满足飞机制造装配车间对于空间的要求。
(2)本发明激光雷达坐标系和标准参考系的标定是本系统的关键部分,本系统在工作时激光雷达坐标系和标准参考坐标系之间的相对位姿关系是保持不变的,因此只需要通过一次标定即可,当系统在后续开始工作时,激光雷达将数据转换到标准参考坐标系下,然后根据当前标准参考坐标系与室内测量坐标的相对位姿关系将点云数据实时从标准参考坐标系转换到测量坐标下即可。
(3)本发明室内GPS系统是一种接触式测量系统,这种测量系统在空间中布置IGPS发射器,可以检测到球形接收器在室内GPS系统中的三维坐标,而且不存在挡光或者角度限制的问题。
(4)本发明避免了现有技术通过在大构件上布置蛙跳球,工作量大、标定繁琐、精度不高等问题;而本方案需要标定的少、测量效率高、实时性强。
附图说明
为了使本发明的内容更容易被清楚地理解,下面根据具体实施例并结合附图,对本发明作进一步详细的说明,其中
图1为本发明的系统整体布局图;
图2为本发明的球形接收器在标准坐标系参考板上的分布图;
图3为本发明的坐标系关系图;
图4为本发明的测量流程图。
附图中标号为:AGV小车10、标准坐标系参考板20、球形接收器21、连接杆22、室内GPS系统30、IGPS发射器31、激光雷达40。
具体实施方式
(实施例1)
见图1至图3,本发明包括安装有机器人的AGV小车10、夹持在机器人机械手臂末端的激光雷达40和标准坐标系参考板20以及室内GPS系统30;具体地标准坐标系参考板20通过平行于地面的连接板22固定在机器人机械手臂末端,激光雷达40则直接固定在连接板22与机器人机械手臂连接处的下端;所述室内GPS系统30建立有全局坐标系Q;所述室内GPS系统30监测标准坐标系参考板20在室内GPS系统30建立的全局坐标系Q下的位姿。
本实施例中更具体地,飞机大尺寸测量系统工作时所述激光雷达40和标准坐标系参考板20之间的相对位姿保持不变。
所述激光雷达40可建立一个激光雷达坐标系L。
所述标准坐标系参考板20上布置有三个球形接收器21;三个所述球形接收器21的球心可建立一个标准参考坐标系S。
三个所述球形接收器21的连线呈直角,且直角两端处的球形接收器21到直角处(即原点)球形接收器21的距离不同,这样可以识别原点,方便区分X轴和Y轴,从而建立一个固定的标准参考坐标系S。
所述室内GPS系统30包括IGPS发射器31、分别布置于室内和标准坐标系参考板20上的球形接收器21及中央处理器;所述IGPS发射器31布置在室内空间的多个位置处,具体的布置点需满足标准坐标系参考板20上的球形接收器21能接收到两个以上IGPS发射器31的信号,这样就可以将标准坐标系参考板20上的球形接收器21的坐标位置解算出来。
(实施例2)
见图4,一种基于激光雷达和室内GPS系统的飞机大尺寸测量方法,包括实施例1所述的基于激光雷达和室内GPS系统的飞机大尺寸测量系统;还包括以下步骤:
步骤一:室内GPS系统30标定,室内GPS系统30标定各个IGPS发射器31之间的关系,建立飞机大尺寸测量系统的全局坐标系Q;本系统中室内GPS系统30标定采用商业化软件进行标定;
步骤二:通过激光雷达坐标系L和标准参考坐标系S标定来确定激光雷达坐标系L相对于标准参考坐标系S之间的位姿关系
步骤三:AGV小车10携带激光雷达40扫描飞机构件进行数据采集,激光雷达40在多个站位扫描得到点云数据,随后将点云数据转换到标准参考坐标系S中;
步骤四:实时识别标准参考坐标系S在全局坐标系Q中的位姿;
步骤五:将采集到的点云数据全部转换到全局坐标系Q下
步骤六:通过中央处理器对点云数据进行处理,即可完成对飞机大构件的测量;
其中求解
设三个球形接收器21在全局坐标系Q下的坐标分别为(x
以A、B、C三点建立的标准参考坐标系S相对于全局坐标系的位姿关系
其中p=(x
求解
假设有两个点组p
其中p
根据质心重合的假设,我们有:
然后令:
最后构件最小二乘函数求解:
SVD算法已经很成熟了,详细推导就不再赘述了。
SVD算法流程为:
(1)根据p
(2)计算3×3矩阵
其中p
(3)对H进行SVD分解
H=USV
(4)计算X=VU
(5)计算X的行列式det(X)
若det(X)=1,R=X;若det(X)=-1,算法失败;在得到旋转矩阵R之后,平移矩阵T可以通过如下公式计算:
至此求出
以上所述的具体实施例,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
机译: 使用室内gps系统的三维测量系统和缩放方法
机译: 使用室内gps系统的三维测量系统和缩放方法
机译: 基于地面激光雷达点云的室内3D模型提取方法