首页 / 专利分类库 / 测时学 / 一种基于CAN通信的时间戳快速同步的方法及其光学扫描仪

一种基于CAN通信的时间戳快速同步的方法及其光学扫描仪

申请号 CN202110752061.3 申请日 2021-06-29 公开(公告)号 CN113572557B 公开(公告)日 2024-03-19
申请人 武汉中观自动化科技有限公司; 发明人 郑顺义; 李志权; 周泽海; 王晓南; 成剑华; 刘庆龙;
摘要 本 发明 提供了一种基于CAN通信的时间戳快速同步的方法及其光学 扫描仪 ,包括如下步骤:S1.将光学扫描仪置于被测物体相应 位置 ;S2.进行三维激光扫描,分别获取所述光学扫描仪的扫描系统的时间戳以及关节臂的时间戳数据;S3.由CAN通信总线形成数据包,通过CAN通信总线通信时间戳数据来同步所述扫描系统和关节臂的时间戳;S4.同步得到占比数据以进行后续的插值操作。本发明通过CAN通信总线通信时间戳数据来同步所述关节臂和扫描系统的时间戳,将扫描数据统一在关节臂 基座 坐标系 ,完成扫描功能。
权利要求

1.一种基于CAN通信的时间戳快速同步的方法,其特征在于,包括如下步骤:
S1.将光学扫描仪置于被测物体相应位置
S2.进行三维激光扫描,分别获取所述光学扫描仪的扫描系统的时间戳以及关节臂的时间戳数据;
S3.由CAN通信总线形成数据包,通过CAN通信总线通信时间戳数据来同步所述扫描系统和关节臂的时间戳;
所述通过CAN通信总线通信时间戳数据来同步所述扫描系统和关节臂的时间戳的工作过程如下:
通过CAN数据包中的一个计数器进行时间戳同步:
a1.关节臂时间戳计数,循环计数长度为N
关节臂中时间戳的时间戳计数器的有效范围是0,1,2,…,N‑1,0,1,2,…;
a2.扫描系统时间戳计数,循环计数长度为N
扫描系统中时间戳的时间戳计数器的有效范围也是0,1,2,…,N‑1,0,1,2,…;
a3.偏移计数
同时记录在某一的CAN数据包存在起始时间戳和曝光偏移量;
a4.曝光持续时间
分别获取扫描系统帧时间戳序列和关节臂帧时间戳序列,扫描系统以固定曝光时间工作,那么时间戳数值为N的这一帧数据同步得到对应关节臂的关键帧是数值上与N最接近的前后两帧数据;
定义扫描系统帧的数据在关节臂的前后两关键帧时间范围内的精确占比为K,关节臂前后两关键帧分别为KeyFrameTime1,KeyFrameTime2,曝光时间为ShutterTime,曝光偏移量为Offset,扫描系统帧时间戳为ScannerFrameTime,上述提及的所有时间的单位都是ms,那么精确占比
S4.同步得到占比数据以进行后续的插值操作。
2.根据权利要求1所述的基于CAN通信的时间戳快速同步的方法,其特征在于,同步过程中的查找策略为:
b1.如果关节臂端的输出帧率高于扫描系统输出帧率的情况下,则使用扫描系统数据为同步原始端,关节臂端数据为同步目的端,
b2.如果扫描系统的输出帧率高于关节臂端输出帧率的情况下,则使用关节臂端数据为同步原始端,扫描系统数据为同步目的端。
3.根据权利要求2所述的基于CAN通信的时间戳快速同步的方法,其特征在于,同步过程中还包括回环检测,进行阈值处理:
如果当前同步的帧数据中包含时间戳大于N‑m的数据,其中数值m根据关节臂和扫描系统较低的帧率决定;
如果关节臂关键帧的时间戳KeyFrameTime2绝对数值小于时间戳KeyFrameTime1,那么需要对时间戳KeyFrameTime2进行+N处理,同样的,如果扫描系统帧的时间戳ScannerFrameTime绝对数值小于关节臂关键帧的时间戳KeyFrameTime1,也需要对时间戳ScannerFrameTime进行+N处理。
4.一种采用如权利要求1至3任一项所述的基于CAN通信的时间戳快速同步的方法的光学扫描仪,其特征在于,所述光学扫描仪包括测量模和通信模块;
所述测量模块包括若干关节臂、若干活动关节和扫描系统,各关节臂顺次排列设置,相邻的关节臂之间通过活动关节相互连接,首端的关节臂一端连接在固定基座上,末端的关节臂一端通过活动关节连接有扫描系统,扫描系统用于测量被测物体和扫描系统之间的距离;
所述通信模块为CAN通信总线,用于与所述关节臂和扫描系统通信连接,通过CAN通信总线通信时间戳数据来同步所述关节臂和扫描系统的时间戳。
5.根据权利要求4所述的光学扫描仪,其特征在于,所述扫描系统包括单目相机和线结构光投射器,所述线结构光投射器将线结构光投射到被测物体表面,所述单目相机采集带有线结构光的被测物体图像,根据所述单目相机和线结构光投射器间的相对位置关系,使用激光三法计算出激光线上的点在相机坐标系下的坐标。
6.根据权利要求5所述的光学扫描仪,其特征在于,所述线结构光投射器是单线结构光投射器。
7.根据权利要求4所述的光学扫描仪,其特征在于,所述扫描系统包括双目相机和线结构光投射器,所述线结构光投射器是单线结构光投射器或多线结构光投射器,所述线结构光投射器将线结构光投射到被测物体表面,所述双目相机采集带有线结构光的被测物体图像,根据所述双目相机和线结构光投射器间的相对位置关系,使用激光三角法计算出激光线上的点在相机坐标系下的坐标。
8.根据权利要求6或7所述的光学扫描仪,其特征在于,每个所述活动关节安装有相互垂直的回转角传感器,所述回转角传感器用于测量各个关节臂和扫描系统在空间的位置。

说明书全文

一种基于CAN通信的时间戳快速同步的方法及其光学扫描仪

技术领域

[0001] 本发明涉及三维激光测量技术领域,具体而言,涉及一种基于CAN通信的时间戳快速同步的方法及其光学扫描仪。

背景技术

[0002] 三维激光扫描技术是上世纪九十年代中期开始出现的一项技术,是继GPS空间定位系统之后又一项测绘技术新突破。它通过高速激光扫描测量的方法,大面积高分辨率地快速获取被测对象表面的三维坐标数据。可以快速、大量的采集空间点位信息,为快速建立物体的三维影像模型提供了一种全新的技术手段。其具有快速性、非接触性、实时性、主动性、高密度、高精度、数字化、自动化等特性。
[0003] 目前,通常的扫描头和关节臂的时钟同步方法是基于关节臂同步信号的触发信号的触发时刻作为扫描头的曝光起始时刻作为同步数据的结果。如此操作实际上会引起一定的“同步误差”,产生误差的原因在于上述同步方法中没有考虑到曝光是一个持续过程,应该将曝光持续的中间时刻作为同步时刻。

发明内容

[0004] 本发明解决的问题是:激光扫描测头的扫描数据不能很好地同步到关节臂基座坐标系中。
[0005] 为解决上述问题,一方面,本发明提供一种基于CAN通信的时间戳快速同步的方法,其中,包括如下步骤:
[0006] S1.将光学扫描仪置于被测物体相应位置
[0007] S2.进行三维激光扫描,分别获取所述光学扫描仪的扫描系统的时间戳以及关节臂的时间戳数据;
[0008] S3.由CAN通信总线形成数据包,通过CAN通信总线通信时间戳数据来同步所述扫描系统和关节臂的时间戳;
[0009] S4.同步得到占比数据以进行后续的插值操作。
[0010] 优选地,所述通过CAN通信总线通信时间戳数据来同步所述扫描系统和关节臂的时间戳的工作过程如下:
[0011] 通过CAN数据包中的一个计数器进行时间戳同步:
[0012] a1.关节臂时间戳计数,循环计数长度为N
[0013] 关节臂中时间戳的时间戳计数器的有效范围是0,1,2,…,N‑1,0,1,2,…(该时间戳是回环计数的);
[0014] a2.扫描系统时间戳计数,循环计数长度为N
[0015] 扫描系统中时间戳的时间戳计数器的有效范围也是0,1,2,…,N‑1,0,1,2,…(该时间戳是回环计数的);
[0016] a3.偏移计数
[0017] 同时记录在某一的CAN数据包存在起始时间戳和曝光偏移量;
[0018] a4.曝光持续时间
[0019] 分别获取扫描系统帧时间戳序列和关节臂帧时间戳序列,扫描系统以固定曝光时间工作,那么时间戳数值为N的这一帧数据同步得到对应关节臂的关键帧是数值上与N最接近的前后两帧数据;
[0020] 定义扫描系统帧的数据在关节臂的前后两关键帧时间范围内的精确占比为K,关节臂前后两关键帧分别为KeyFrameTime1,KeyFrameTime2,曝光时间为ShutterTime,曝光偏移量为Offset,扫描系统帧时间戳为ScannerFrameTime,上述提及的所有时间的单位都是ms,
[0021] 那么精确占比
[0022]
[0023] 优选地,同步过程中的查找策略为:
[0024] b1.如果关节臂端的输出帧率高于扫描系统输出帧率的情况下,则使用扫描系统数据为同步原始端,关节臂端数据为同步目的端,
[0025] b2.如果扫描系统的输出帧率高于关节臂端输出帧率的情况下,则使用关节臂端数据为同步原始端,扫描系统数据为同步目的端。
[0026] 上述两种情况下,同步的算法并未改变,但是同步操作的触发方式发生了改变,从基于扫描帧的同步触发,变换成了基于关节臂帧的同步触发。
[0027] 优选地,同步过程中还包括回环检测,进行阈值处理:
[0028] 如果当前同步的帧数据中包含时间戳大于N‑m的数据,其中数值m根据关节臂和扫描系统较低的帧率决定;
[0029] 如果关节臂关键帧的时间戳KeyFrameTime2绝对数值小于时间戳KeyFrameTime1,那么需要对时间戳KeyFrameTime2进行+N处理,同样的,如果扫描系统帧的时间戳ScannerFrameTime绝对数值小于关节臂关键帧的时间戳KeyFrameTime1,也需要对时间戳ScannerFrameTime进行+N处理。
[0030] 另一方面,本发明还提供一种光学扫描仪,其采用了如上所述的基于CAN通信的时间戳快速同步的方法,其中,所述光学扫描仪包括测量模和通信模块;
[0031] 所述测量模块包括若干关节臂、若干活动关节和扫描系统,各关节臂顺次排列设置,相邻的关节臂之间通过活动关节相互连接,首端的关节臂一端连接在固定基座上,末端的关节臂一端通过活动关节连接有扫描系统,扫描系统用于测量被测物体和扫描系统之间的距离;
[0032] 所述通信模块为CAN通信总线,用于与所述关节臂和扫描系统通信连接,通过CAN通信总线通信时间戳数据来同步所述关节臂和扫描系统的时间戳,将扫描数据统一在关节臂基座坐标系,完成扫描功能。
[0033] 优选地,所述扫描系统包括单目相机和线结构光投射器,所述线结构光投射器将线结构光投射到被测物体表面,所述单目相机采集带有线结构光的被测物体图像,根据所述单目相机和线结构光投射器间的相对位置关系,使用激光三法计算出激光线上的点在相机坐标系下的坐标。
[0034] 优选地,所述线结构光投射器是单线结构光投射器。
[0035] 优选地,所述扫描系统包括双目相机和线结构光投射器,所述线结构光投射器是单线结构光投射器或多线结构光投射器,所述线结构光投射器将线结构光投射到被测物体表面,所述双目相机采集带有线结构光的被测物体图像,根据所述双目相机和线结构光投射器间的相对位置关系,使用激光三角法计算出激光线上的点在相机坐标系下的坐标。
[0036] 优选地,每个所述活动关节安装有相互垂直的回转角传感器,所述回转角传感器用于测量各个关节臂和扫描系统在空间的位置。每个所述活动关节的回转中心和相应的所述关节臂构成一个极坐标系统,回转角即极角由所述回转角传感器测量,而所述关节臂两端所述活动关节的回转中心距离为极坐标的极径长度,即所述测量模块是由若干个串连的所述极坐标系统组成,当所述扫描系统对被测物体进行测量时,所述光学扫描仪可给出所述扫描系统在空间的三维位置信息,所述扫描系统对所述被测物体在不同部位进行测量时,根据所建立的测量数学模型,由计算机给出被测参数实际值。
[0037] 这样,光学扫描仪通过CAN通信总线通信时间戳数据来同步所述关节臂和扫描系统的时间戳,将扫描数据统一在关节臂基座坐标系,完成扫描功能。
[0038] 相对于现有技术,本发明所述的基于CAN通信的时间戳快速同步的方法及其光学扫描仪具有以下有益效果:
[0039] (1)本发明所述的基于CAN通信的时间戳快速同步的方法及其光学扫描仪考虑到曝光是一个持续过程,可以将激光扫描测头的扫描数据很好地同步到关节臂基座的坐标系中;
[0040] (2)本发明所述的基于CAN通信的时间戳快速同步的方法及其光学扫描仪基于CAN时间戳同步的机制,可实现扫描头和关节臂的时间戳的快速同步,更加精确;
[0041] (3)本发明所述的基于CAN通信的时间戳快速同步的方法及其光学扫描仪通过CAN通信时间戳数据,具有实时性强,开发周期短的优势。附图说明
[0042] 图1为本发明的方法流程图
[0043] 图2为本发明的触发同步流程图;
[0044] 图3为本发明的光学扫描仪的主视结构示意图。
[0045] 附图标记说明:
[0046] 1、固定基座;2、关节臂;3、扫描系统;15、通信模块。

具体实施方式

[0047] 为使本发明的上述目的、特征和优点能够更为明显易懂,下面结合附图对本发明的具体实施例做详细的说明。
[0048] 实施例一
[0049] 提供一种基于CAN通信的时间戳快速同步的方法,如图1所示,其中,包括如下步骤:
[0050] S1.将光学扫描仪置于被测物体相应位置;
[0051] S2.进行三维激光扫描,分别获取所述光学扫描仪的扫描系统的时间戳以及关节臂的时间戳数据;
[0052] S3.由CAN通信总线形成数据包,通过CAN通信总线通信时间戳数据来同步所述扫描系统和关节臂的时间戳;
[0053] S4.同步得到占比数据以进行后续的插值操作。
[0054] CAN是Controller Area Network的缩写(以下称为CAN),是ISO国际标准化的串行通信协议。ISO11898及ISO11519进行了标准化,现在在欧洲已是汽车网络的标准协议。CAN控制器根据两根线上的电位差来判断总线电平。总线电平分为显性电平和隐性电平,二者必居其一。发送方通过使总线电平发生变化,将消息发送给接收方。通过CAN通信时间戳数据来同步扫描系统和关节臂的时间戳,将扫描数据统一在关节臂基座坐标系,完成扫描功能。
[0055] 所述通过CAN通信总线通信时间戳数据来同步所述扫描系统和关节臂的时间戳的工作过程如下:
[0056] 通过CAN数据包中的一个计数器进行时间戳同步:
[0057] a1.关节臂时间戳计数,循环计数长度为N
[0058] 关节臂中时间戳的时间戳计数器的有效范围是0,1,2,…,N‑1,0,1,2,…(该时间戳是回环计数的);
[0059] a2.扫描系统时间戳计数,循环计数长度为N
[0060] 扫描系统中时间戳的时间戳计数器的有效范围也是0,1,2,…,N‑1,0,1,2,…(该时间戳是回环计数的);
[0061] a3.偏移计数
[0062] 同时记录在某一帧的CAN数据包存在起始时间戳和曝光偏移量;
[0063] a4.曝光持续时间
[0064] 假设我们分别有扫描系统帧时间戳序列和关节臂帧时间戳序列:
[0065] 扫描系统帧时间戳序列
[0066]时间戳ID 107 113 120 126 132 …
偏移量 0.2 0.3 0.1 0.2 0.2 …
[0067] 关节臂帧时间戳序列
[0068] 时间戳ID 105 108 112 115 118 121 124 128 …
[0069] 假设我们扫描系统以0.5ms的固定曝光时间工作,那么时间戳数值为120的这一帧数据同步情况如下:
[0070] 扫描系统帧时间戳序列
[0071]时间戳ID 107 113 120 126 132 …
偏移量 0.2 0.3 0.1 0.2 0.2 …
[0072] 关节臂帧时间戳序列
[0073] 时间戳ID 105 108 112 115 118 121 124 128 …
[0074] 容易得到我们对应关节臂的关键帧是时间戳为118,121的这两帧数据。
[0075] 如果定义扫描系统帧的数据在关节臂的前后两关键帧时间范围内的精确占比为K,关节臂前后两关键帧分别为KeyFrameTime1,KeyFrameTime2,曝光时间为ShutterTime,曝光偏移量为Offset,扫描系统帧时间戳为ScannerFrameTime,注意上述提及的所有时间的单位都是ms。
[0076] 那么精确占比
[0077]
[0078] 以扫描系统帧时间戳120的数据为例,
[0079] K=(120–118+0.1+0.5/2)/(121‑118)=0.7833 (1)
[0080] 同样的,如果数据出现在时间戳循环连接的地方,则为下述情况:
[0081] 扫描系统帧时间戳序列
[0082] 时间戳ID N‑10 N‑6 N‑1 0 5 …偏移量 0.5 0.2 0.3 0.1 0.7 …
[0083] 关节臂帧时间戳序列
[0084]时间戳ID N‑5 N‑1 2 5 8 11 14 18 …
[0085] 以扫描系统帧时间戳N‑1的数据为例,
[0086] K=(N‑1–(N‑1)+0.3+0.5/2)/(2+N‑(N‑1))=0.1833 (2)
[0087] 同步过程中的查找策略为:
[0088] b1.如果关节臂端的输出帧率高于扫描系统输出帧率的情况下,则使用扫描系统数据为同步原始端,关节臂端数据为同步目的端。
[0089] 具体说来,如果关节臂端的每秒输出600个时间戳数据,扫描系统每秒输出200个时间戳数据,那么按照扫描系统帧为同步原始端,关节臂帧为同步目的端。
[0090] b2.如果扫描系统的输出帧率高于关节臂端输出帧率的情况下,则使用关节臂端数据为同步原始端,扫描系统数据为同步目的端。
[0091] 具体说来,如果关节臂端的每秒输出200个时间戳数据,扫描系统每秒输出600个时间戳数据,那么按照关节臂帧为同步原始端,扫描系统帧为同步目的端。
[0092] 上述两种情况下,同步的算法并未改变,但是同步操作的触发方式发生了改变,从基于扫描系统帧的同步触发,变换成了基于关节臂帧的同步触发。
[0093] 同时,我们注意到同步的过程中还包括回环检测,我们使用了阈值处理,如果当前同步的帧数据中包含时间戳大于N‑m的数据(m是一个经验值,根据关节臂和扫描系统较低的帧率决定,一般我们取10),
[0094] 如果关节臂关键帧的时间戳KeyFrameTime2绝对数值小于时间戳KeyFrameTime1,那么需要对时间戳KeyFrameTime2进行+N处理,同样的,如果扫描系统帧的时间戳ScannerFrameTime绝对数值小于关节臂关键帧的时间戳KeyFrameTime1,也需要对时间戳ScannerFrameTime进行+N处理。
[0095] 实施例二
[0096] 提供一种光学扫描仪,其采用了如实施例一所述的基于CAN通信的时间戳快速同步的方法,如图3所示,其中,所述光学扫描仪包括测量模块和通信模块15;
[0097] 所述测量模块包括若干关节臂2、若干活动关节和扫描系统3,各关节臂2顺次排列设置,相邻的关节臂2之间通过活动关节相互连接,首端的关节臂2一端连接在固定基座1上,末端的关节臂2一端通过活动关节连接有扫描系统3,扫描系统3用于测量被测物体和扫描系统3之间的距离;
[0098] 所述通信模块15为CAN通信总线,用于与所述关节臂2和扫描系统3通信连接,通过CAN通信总线通信时间戳数据来同步所述关节臂2和扫描系统3的时间戳,将扫描数据统一在关节臂基座坐标系,完成扫描功能。
[0099] 所述扫描系统包括单目相机和线结构光投射器,所述线结构光投射器将线结构光投射到被测物体表面,所述单目相机采集带有线结构光的被测物体图像,根据所述单目相机和线结构光投射器间的相对位置关系,使用激光三角法计算出激光线上的点在相机坐标系下的坐标。
[0100] 所述线结构光投射器是单线结构光投射器。
[0101] 所述扫描系统包括双目相机和线结构光投射器,所述线结构光投射器是单线结构光投射器或多线结构光投射器,所述线结构光投射器将线结构光投射到被测物体表面,所述双目相机采集带有线结构光的被测物体图像,根据所述双目相机和线结构光投射器间的相对位置关系,使用激光三角法计算出激光线上的点在相机坐标系下的坐标。
[0102] 每个所述活动关节安装有相互垂直的回转角传感器,所述回转角传感器用于测量各个关节臂和扫描系统在空间的位置。每个所述活动关节的回转中心和相应的所述关节臂构成一个极坐标系统,回转角即极角由所述回转角传感器测量,而所述关节臂两端所述活动关节的回转中心距离为极坐标的极径长度,即所述测量模块是由若干个串连的所述极坐标系统组成,当所述扫描系统对被测物体进行测量时,所述光学扫描仪可给出所述扫描系统在空间的三维位置信息,所述扫描系统对所述被测物体在不同部位进行测量时,根据所建立的测量数学模型,由计算机给出被测参数实际值。
[0103] 这样,本实施例中的光学扫描仪通过CAN通信总线通信时间戳数据来同步所述关节臂和扫描系统的时间戳,将扫描数据统一在关节臂基座坐标系,完成扫描功能。
[0104] 虽然本发明披露如上,但本发明的保护范围并非仅限于此。本领域技术人员在不脱离本发明的精神和范围的前提下,可进行各种变更与修改,这些变更与修改均将落入本发明的保护范围。
QQ群二维码
意见反馈