激光设备运动状态的检测方法、装置、计算机设备及介质与流程

文档序号:28495307发布日期:2022-01-15 03:57阅读:193来源:国知局
激光设备运动状态的检测方法、装置、计算机设备及介质与流程

1.本发明涉及激光应用技术领域,尤其涉及一种激光设备运动状态的检测方法、装置、计算机设备及介质。


背景技术:

2.随着电子制造业的迅猛发展,传统的制造加工工艺已越来越难以满足现代电子制造工艺的要求。与传统的加工工艺技术相比,激光加工技术有着其独特的优越性,显现出巨大的工业化前景。
3.目前,由于房屋结构、刚才等屏蔽作用,导致采用激光设备在室内进行激光加工时,无法通过gps、地磁等信号准确的在室内检测到激光设备的状态。虽然现有技术中可以通过纯惯导、激光雷达、wifi定位、蓝牙信标、超宽带等技术获取激光设备当前的状态,但是上述方法成本较高,而且获取的数据精度较低,导致在无法准确的检测到激光设备是否处于静止状态。


技术实现要素:

4.本发明实施例提供了一种激光设备运动状态的检测方法、装置、计算机设备及介质,用于解决现有技术中无法准确并较低成本的检测激光设备状态的技术问题。
5.第一方面,本发明实施例提供了一种激光设备运动状态的检测方法,其包括:获取激光设备的传感器在预设时间内输出的测量数据;将所述测量数据输入至预置的卡尔曼滤波模型中,得到所述预设时间内每一时刻所述激光设备的运动状态;根据所述运动状态的极差和方差检测所述激光设备在所述预设时间内的运动状态。
6.第二方面,本发明实施例提供了一种激光设备运动状态的检测装置,其包括:第一获取单元,用于获取激光设备的传感器在预设时间内输出的测量数据;第一输入单元,用于将所述测量数据输入至预置的卡尔曼滤波模型中,得到所述预设时间内每一时刻所述激光设备的运动状态;第一检测单元,用于根据所述运动状态的极差和方差检测所述激光设备在所述预设时间内的运动状态。
7.第三方面,本发明实施例又提供了一种计算机设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其中,所述处理器执行所述计算机程序时实现如上述第一方面所述的激光设备运动状态的检测方法。
8.第四方面,本发明实施例还提供了一种计算机可读存储介质,其中,所述计算机可读存储介质存储有计算机程序,所述计算机程序当被处理器执行时使所述处理器执行上述第一方面所述的激光设备运动状态的检测方法。
9.本发明实施例提供了一种激光设备运动状态的检测方法、装置、计算机设备及介
质。该方法通过在激光设备中配置传感器并从传感器中获取激光设备在预设时间内输出的测量数据,然后将测量数据输入到预置的卡尔曼滤波模型中以得到激光设备在预设时间内每一时刻的运动状态,最后根据每一时刻的运动状态的极差和方差对激光设备在预设时间内的运动状态进行检测。本发明通过在激光设备上配置传感器,同时对传感器输出的测量数据进行卡尔曼滤波,不仅成本低廉、效率较高,而且可以有效消除激光设备处于静止状态带来的噪声误差,进而准确的检测到激光设备是否处于静止状态。
附图说明
10.为了更清楚地说明本发明实施例技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
11.图1为本发明实施例提供的激光设备运动状态的检测方法的流程示意图;图2为本发明实施例提供的激光设备运动状态的检测方法的一流程示意图;图3为本发明实施例提供的激光设备运动状态的检测方法的另一流程示意图;图4为本发明实施例提供的激光设备运动状态的检测方法的另一流程示意图;图5为本发明实施例提供的激光设备运动状态的检测方法的另一流程示意图;图6为本发明实施例提供的激光设备运动状态的检测方法的另一流程示意图;图7为本发明实施例提供的激光设备运动状态的检测装置的示意性框图;图8为本发明实施例提供的计算机设备的示意性框图。
具体实施方式
12.下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
13.应当理解,当在本说明书和所附权利要求书中使用时,术语“包括”和“包含”指示所描述特征、整体、步骤、操作、元素和/或组件的存在,但并不排除一个或多个其它特征、整体、步骤、操作、元素、组件和/或其集合的存在或添加。
14.还应当理解,在此本发明说明书中所使用的术语仅仅是出于描述特定实施例的目的而并不意在限制本发明。如在本发明说明书和所附权利要求书中所使用的那样,除非上下文清楚地指明其它情况,否则单数形式的“一”、“一个”及“该”意在包括复数形式。
15.还应当进一步理解,在本发明说明书和所附权利要求书中使用的术语“和/ 或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。
16.请参阅图1,图1为本发明实施例提供的激光设备运动状态的检测方法的流程示意图。本发明实施例的所述的激光设备运动状态的检测方法应用于终端设备中,该方法通过安装于终端设备中的激光设备运动状态的检测系统进行执行激光设备运动状态的检测方法。其中,终端设备为具备数据处理功能且可接收传感器输出的测量数据的终端设备,例如台式电脑、笔记本电脑、平板电脑或手机等。
17.下面对所述的激光设备运动状态的检测方法进行详细说明。
18.如图1所示,该方法包括以下步骤s110~s130。
19.s110、获取激光设备的传感器在预设时间内输出的测量数据。
20.具体的,所述预设时间为终端设备需要检测激光设备在预设时间内任一时刻运动状态的时间信息,例如,当终端设备需要检测激光设备当前的运动状态时,所述预设时间中最后时刻则为所述当前时刻。
21.在本实施例中,激光设备中安装的传感器为具备陀螺仪的imu传感器,该传感器配置了三轴陀螺仪,三轴加速度计以及三轴磁力计。其中,传感器输出的测量数据包括三维方向上的高低位数据,该高低位数据包括观测激光设备在三维方向上每一时刻的加速度、角速度以及角度,该传感器精度中加速度的精度为0.0005g,角速度的精度为0.61
°
,角度的精度为0.1
°

22.在其他发明实施例中,步骤s110之前,还包括步骤:预先设置传输所述测量数据的波特率并对所述波特率进行初始化。
23.在本实施例中,终端设备与激光设备的传感器采用usb或串口连接并进行数据通信,为了保证终端设备与传感器之间通信的稳定性,同时减少终端设备与传感器之间的波特率误差,需预先设置传感器传输所述测量数据的波特率,同时传感器在传输所述测量数据之前,预先初始化对所述波特率进。
24.s120、将所述测量数据输入至预置的卡尔曼滤波模型中,得到所述预设时间内每一时刻所述激光设备的运动状态。
25.具体的,所述卡尔曼滤波模型由卡尔曼滤波算法构建得到,卡尔曼滤波算法是利用线性系统状态方程,通过系统输入输出观测数据,对系统状态进行最优估计的算法。其中,卡尔曼滤波算法由五大公式组成,该五大公式分为预测和更新。
26.其中,预测方程为:预测方程为:其中,为k 时刻的先验状态估计值,即为传感器中观测到的数据;为k
ꢀ‑
1时刻的后验状态估计值,即为卡尔曼滤波最终输出的结果之一,和均为状态变量,f为状态转移函数,实际上是对目标状态转换的一种猜想模型。例如,在机动目标跟踪中,状态转移矩阵常常用来对目标的运动建模,其模型可能为匀速直线运动或者匀加速运动,当状态转移矩阵不符合目标的状态转换模型时,滤波会很快发散;b和u是系统控制变量,即为将输入转换为状态的矩阵,为k时刻的先验估计协方差,是滤波的中间计算结果;p为k-1时刻的后验估计协方差,表示状态的不确定度,是滤波的结果之一;q是过程噪声矩阵,该参数被用来表示状态转换矩阵与实际过程之间的误差。
27.更新方程为:更新方程为:更新方程为:
其中,y为实际观测和预测观测的残差,和卡尔曼增益一起修正先验(预测),得到后验;z为测量均值,是滤波的输入;为k 时刻的后验状态估计值,是滤波的结果之一,即更新后的结果,也叫最优估计;为k时刻的后验估计协方差,是滤波的结果之一;h为测量函数,是状态变量到测量的转换矩阵,表示将状态和观测连接起来的关系,卡尔曼滤波里为线性关系,测量函数负责将m维的测量值转换到n维,使之符合状态变量的数学形式,是滤波的前提条件之一;r为测量噪声,是滤波器的已知条件;k为卡尔曼增益矩阵,是滤波的中间计算结果,又称卡尔曼增益或卡尔曼系数;i是单位矩阵。
28.在本实施例中,所述卡尔曼滤波模型的状态变量中包括激光设备的角速度,所述激光设备为可进行手持的激光设备,当用户手持该激光设备持续运动过程时,由于激光设备的运动速度较小,使得激光设备的加速度大小与激光设备在静止状态下相类似,故需通过激光设备运动时的角速度来检测激光设备的运动状态。因此在构建卡尔曼滤波模型时,需将卡尔曼滤波模型的状态变量中的运动速度替换成激光设备的角速度,进而使得在构建得到卡尔曼滤波模型中输入含有激光设备的角速度后,即传感器输出的测量数据,便可从卡尔曼滤波模型中得到每一时刻激光设备的实际角速度。
29.在其他发明实施例中,如图2所示,步骤s120包括子步骤s121和s122。
30.s121、对所述测量数据进行解析,得到每一时刻所述传感器测量的加速度、角度以及角速度;s122、将所述加速度、所述角度以及所述角速度输入至所述卡尔曼滤波模型中,得到每一时刻所述激光设备的运动状态。
31.在本实施例中,所述测量数据包括三维方向上的高低位数据,此时无法直接将所述测量数据输入至卡尔曼滤波模型中的五个方程中进行计算,故需对所述测量数据进行解析以从所述测量数据中获取每一时刻所述传感器测量的加速度、角度以及角速度。其中,测量数据中加速度的axh、axl分别为激光设备在x轴方向上的高位数据和低位数据,ayh、ayl分别为激光设备在y轴方向上的高位数据和低位数据,azh、azl分别为激光设备在z轴方向上的高位数据和低位数据;测量数据中角速度的wxh、wxl分别为激光设备在x轴方向上的高位数据和低位数据,wyh、wyl分别为激光设备在y轴方向上的高位数据和低位数据,wzh、wzl分别为激光设备在z轴方向上的高位数据和低位数据;测量数据中角度的rollh、rolll分别为激光设备在x轴方向上的高位数据和低位数据,pitchh、pitchl分别为激光设备在y轴方向上的高位数据和低位数据,yawh、yawl分别为激光设备在z轴方向上的高位数据和低位数据。
32.具体的,加速度的计算公式为:ax=((axh《《8)|axl)/32768*16gay=((ayh《《8)|ayl)/32768*16gaz=((azh《《8)|azl)/32768*16g其中,g为本地重力加速度,ax、ay以及az分别为解析后激光设备在x轴、y轴以及z轴上的加速度。
33.角速度计算公式为:
wx=((wxh《《8)|wxl)/32768*2000(
°
/s)wy=((wyh《《8)|wyl)/32768*2000(
°
/s)wz=((wzh《《8)|wzl)/32768*2000(
°
/s)其中,wx、wy以及wz分别为解析后激光设备在x轴、y轴以及z轴上的角速度。
34.角度计算公式为:roll=((rollh《《8)|rolll)/32768*180(
°
)pitch=((pitchh《《8)|pitchl)/32768*180(
°
)yaw=((yawh《《8)|yawl)/32768*180(
°
)其中,滚转角roll、俯仰角pitch以及偏航角yaw分别为解析后激光设备在x轴、y轴以及z轴上转动的角度。
35.在其他发明实施例中,如图3所示,步骤s121包括子步骤s1211和s1212。
36.s1211、获取所述测量数据的校验和;s1212、若所述测量数据与所述校验和相匹配,根据所述测量数据生成每一时刻所述传感器测量的加速度、角度以及角速度。
37.具体的,所述校验和为在数据处理和数据通信领域中用于校验目的地一组数据项的和,校验和通常是以十六进制为数制表示的形式。其中,为了保证获取传感器输出的测量数据的完整性和准确性,需根据测量数据传输后的校验和来验证是否已获取到传感器全部传输的测量数据。若已获取到传感器全部传输的测量数据,则可根据相应的计算公式计算得到每一时刻所述传感器测量的加速度、角度以及角速度。例如,在对所述测量数据中含有激光设备加速度的高低位数据进行校验和匹配时,其校验和sum为:sum=0x55+0x51+axh+axl+ayh+ayl+azh+azl,当其校验和sum与所述测量数据中含有激光设备加速度的高低位数据相匹配时,则根据该数据生成激光设备在x轴、y轴以及z轴上的加速度。
38.在其他发明实施例中,如图4所示,步骤s122包括子步骤s1221、s1222和s1223。
39.s1221、根据所述角度、所述加速度生成所述激光设备的净加速度;s1222、根据所述角速度、所述净加速度生成所述卡尔曼滤波模型的状态变量;s1223、根据所述状态变量在所述卡尔曼滤波模型中生成每一时刻所述激光设备的运动状态。
40.具体的,激光设备的净加速度为激光设备在减去重力加速度后得到加速度,所述卡尔曼滤波模型中的状态变量为x =(wx,wy,wz,ax,ay,az),其中,(wx,wy,wz)为从所述测量数据中解析出的角速度,(ax,ay,az)为激光设备的净加速度。
41.在本实施例中,通过对所述角度进行四元数转换并根据转换后的四元数对所述激光设备的重力加速度进行投影,然后将解析出的加速度减去投影后的重力加速度,便可得到每一时刻激光设备的净加速度,然后将其输入至卡尔曼滤波模型中,便可得到每一时刻所述激光设备的运动状态,其运动状态即为激光设备在每一时刻的实际运动状态,且通过激光设备的角速度来进行表征。
42.在其他发明实施例中,如图5所示,步骤s1221包括子步骤s12211、s12212和s12213。
43.s12211、对所述角度进行四元数转换,得到转换后的四元数;s12212、根据所述转换后的四元数对所述激光设备的重力加速度进行投影,得到
投影后的重力加速度;s12213、根据所述加速度、所述投影后的重力加速度生成所述激光设备的净加速度。
44.在本实施例中,角度的四元转换公式为:q(0)=cos(pitch/2)*cos(roll/2)*cos(yaw/2)-sin(pitch/2)*sin(roll/2)*sin(yaw/2)q(1)=sin(pitch/2)*cos(roll/2)*cos(yaw/2)-cos(pitch/2)*sin(roll/2)*sin(yaw/2)q(2)=cos(pitch/2)*sin(roll/2)*cos(yaw/2)+sin(pitch/2)*cos(roll/2)*sin(yaw/2)q(3)=cos(pitch/2)*cos(roll/2)*sin(yaw/2)+cos(pitch/2)*sin(roll/2)*sin(yaw/2)其中,转换后的四元数对激光设备的重力加速度进行投影的公式为:gx=2*q(1)*q(3)-2q(0)*q(2)gy=2*q(2)*q(3)+2q(0)*q(1)gz=q(0)
2-q(1)
2-q(2)2+q(3)2其中,gx、gy、gz分别为激光设备的重力加速度在x轴、y轴以及z轴上投影后的重力加速度。
45.最终生成的净加速度的公式为:ax=ax-gxay=ay-gyaz=az-gzs130、根据所述运动状态的极差和方差检测所述激光设备在所述预设时间内的运动状态。
46.具体的,所述运动状态包括缓慢移动状态、剧烈运动状态以及静止状态,所述运动状态通过激光设备的角速度来判定,所述运动状态的极差为激光设备在预设时间内实际角速度的最大值和最小值之间的差值,所述运动状态的方差为激光设备在预设时间内实际角速度的方差。其中,所述运动状态的极差用于表征激光设备在预设时间内实际角速度的离散程度,即激光设备在预设时间内的波动程度或突变程度,所述运动状态的方差用于表征激光设备在预设时间内实际角速度的偏离程度。本实施例中将激光设备在预设时间内运动状态的极差和方差结合来检测激光设备在预设时间内的运动状态,进一步的提高了检测激光设备在预设时间内的运动状态的精确度。
47.在其他发明实施例中,如图6所示,步骤s130包括子步骤s131和s132。
48.s131、若所述极差大于预设的阈值,根据所述极差检测所述激光设备在所述预设时间内的运动状态;s132、若所述极差小于所述阈值,根据所述方差检测所述激光设备在所述预设时间内的运动状态。
49.具体的,所述阈值为在检测激光设备在预设时间内的运动状态时选择运动状态的极差和方差的临界值,所述阈值可根据实际应用进行设定,本实施例中不做具体限定。
50.在本实施例中,所述运动状态的极差公式为:其中,max(wi)为预设时间内取最大值函数,min(wi)为预设时间内取最小值函数,thresh1为对卡尔曼滤波状态进行校验的过程。
51.所述运动状态的方差公式为:其中,std(wi)为预设时间内取标准差函数,thresh2 为对卡尔曼滤波状态进行校验的过程,wi为预设时间内每一时刻的实际角速度。
52.另外,当激光设备在预设时间内运动状态的极差小于所述阈值时,采用方差检测到激光设备处于静止状态后,则需将卡尔曼滤波模型中的状态变量进行初始化,防止激光设备中在静止状态条件下持续进行卡尔曼滤波,从而消除静止状态的噪声带来的误差。
53.在本发明实施例所提供的激光设备运动状态的检测方法中,通过获取激光设备的传感器在预设时间内输出的测量数据;将所述测量数据输入至预置的卡尔曼滤波模型中,得到所述预设时间内每一时刻所述激光设备的运动状态;根据所述运动状态的极差和方差检测所述激光设备在所述预设时间内的运动状态。本发明通过在激光设备上配置传感器,同时对传感器输出的测量数据进行卡尔曼滤波,解决了无法准确的在室内检测到激光设备的状态的技术问题,该方法不仅成本低廉、效率较高,而且可以有效消除激光设备处于静止状态带来的噪声误差,进而准确的检测到激光设备是否处于静止状态。
54.本发明实施例还提供了一种激光设备运动状态的检测装置100,该装置用于执行前述激光设备运动状态的检测方法的任一实施例。
55.具体地,请参阅图7,图7是本发明实施例提供的激光设备运动状态的检测装置100的示意性框图。
56.如图7所示,所述的激光设备运动状态的检测装置100,该装置包括:第一获取单元110、第一输入单元120和第一检测单元130。
57.第一获取单元110,用于获取激光设备的传感器在预设时间内输出的测量数据。
58.在另一实施例中,所述的激光设备运动状态的检测装置100包括:设置单元。
59.设置单元,用于预先设置传输所述测量数据的波特率并对所述波特率进行初始化。
60.第一输入单元120,用于将所述测量数据输入至预置的卡尔曼滤波模型中,得到所述预设时间内每一时刻所述激光设备的运动状态。
61.在另一实施例中,所述第一输入单元120包括:解析单元和第二输入单元。
62.解析单元,用于对所述测量数据进行解析,得到每一时刻所述传感器测量的加速
度、角度以及角速度;第二输入单元,用于将所述加速度、所述角度以及所述角速度输入至所述卡尔曼滤波模型中,得到每一时刻所述激光设备的运动状态。
63.在另一实施例中,所述解析单元包括:第二获取单元和第一生成单元。
64.第二获取单元,用于获取所述测量数据的校验和;第一生成单元,用于若所述测量数据与所述校验和相匹配,根据所述测量数据生成每一时刻所述传感器测量的加速度、角度以及角速度。
65.在另一实施例中,所述第二输入单元包括:第二生成单元、第三生成单元和第四生成单元。
66.第二生成单元,用于根据所述角度、所述加速度生成所述激光设备的净加速度;第三生成单元,用于根据所述角速度、所述净加速度生成所述卡尔曼滤波模型的状态变量;第四生成单元,用于根据所述状态变量在所述卡尔曼滤波模型中生成每一时刻所述激光设备的运动状态。
67.在另一实施例中,所述第二生成单元包括:转换单元、投影单元和第五生成单元。
68.转换单元,用于对所述角度进行四元数转换,得到转换后的四元数;投影单元,用于根据所述转换后的四元数对所述激光设备的重力加速度进行投影,得到投影后的重力加速度;第五生成单元,用于根据所述加速度、所述投影后的重力加速度生成所述激光设备的净加速度。
69.第一检测单元130,用于根据所述运动状态的极差和方差检测所述激光设备在所述预设时间内的运动状态。
70.在另一实施例中,所述第一检测单元130包括:第二检测单元和第三检测单元。
71.第二检测单元,用于若所述极差大于预设的阈值,根据所述极差检测所述激光设备在所述预设时间内的运动状态;第三检测单元,用于若所述极差小于所述阈值,根据所述方差检测所述激光设备在所述预设时间内的运动状态。
72.本发明实施例所提供的激光设备运动状态的检测装置100用于执行上述获取激光设备的传感器在预设时间内输出的测量数据;将所述测量数据输入至预置的卡尔曼滤波模型中,得到所述预设时间内每一时刻所述激光设备的运动状态;根据所述运动状态的极差和方差检测所述激光设备在所述预设时间内的运动状态。
73.需要说明的是,所属领域的技术人员可以清楚地了解到,上述激光设备运动状态的检测装置100和各单元的具体实现过程,可以参考前述方法实施例中的相应描述,为了描述的方便和简洁,在此不再赘述。
74.上述激光设备运动状态的检测装置可以实现为一种计算机程序的形式,该计算机程序可以在如图8所示的计算机设备上运行。
75.请参阅图8,图8是本技术实施例提供的一种计算机设备的示意性框图。该计算机设备500可以是终端,其中,终端可以是智能手机、平板电脑、笔记本电脑、台式电脑、个人数字助理和穿戴式设备等具有通信功能的电子设备。
76.参阅图8,该计算机设备500包括通过系统总线501连接的处理器502、存储器和网络接口505,其中,存储器可以包括非易失性存储介质503和内存储器504。
77.该非易失性存储介质503可存储操作系统5031和计算机程序5032。该计算机程序5032包括程序指令,该程序指令被执行时,可使得处理器502执行一种激光设备运动状态的
processing unit,cpu),该处理器502还可以是其他通用处理器、数字信号处理器 (digital signal processor,dsp)、专用集成电路 (application specific integrated circuit,asic)、现成可编程门阵列 (field-programmable gate array,fpga) 或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。其中,通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。
89.本领域普通技术人员可以理解的是实现上述实施例的方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成。该计算机程序包括程序指令,计算机程序可存储于一存储介质中,该存储介质为计算机可读存储介质。该程序指令被该计算机系统中的至少一个处理器执行,以实现上述方法的实施例的流程步骤。
90.因此,本发明还提供一种存储介质。该存储介质可以为计算机可读存储介质。该存储介质存储有计算机程序,其中计算机程序包括程序指令。该程序指令被处理器执行时使处理器执行如下步骤:获取激光设备的传感器在预设时间内输出的测量数据;将所述测量数据输入至预置的卡尔曼滤波模型中,得到所述预设时间内每一时刻所述激光设备的运动状态;根据所述运动状态的极差和方差检测所述激光设备在所述预设时间内的运动状态。
91.在一实施例中,所述处理器在执行所述程序指令而实现所述获取激光设备在预设时间内输出的测量数据之前,具体实现如下步骤:预先设置传输所述测量数据的波特率并对所述波特率进行初始化。
92.在一实施例中,所述处理器在执行所述程序指令而实现所述将所述测量数据输入至预置的卡尔曼滤波模型中,得到所述预设时间内每一时刻所述激光设备的运动状态时,具体实现如下步骤:对所述测量数据进行解析,得到每一时刻所述传感器测量的加速度、角度以及角速度;将所述加速度、所述角度以及所述角速度输入至所述卡尔曼滤波模型中,得到每一时刻所述激光设备的运动状态。
93.在一实施例中,所述处理器在执行所述程序指令而实现所述对所述测量数据进行解析,得到每一时刻所述传感器测量的加速度、角度以及角速度时,具体实现如下步骤:获取所述测量数据的校验和;若所述测量数据与所述校验和相匹配,根据所述测量数据生成每一时刻所述传感器测量的加速度、角度以及角速度。
94.在一实施例中,所述处理器在执行所述程序指令而实现所述将所述加速度、所述角度以及所述角速度输入至所述卡尔曼滤波模型中,得到每一时刻所述激光设备的运动状态时,具体实现如下步骤:根据所述角度、所述加速度生成所述激光设备的净加速度;根据所述角速度、所述净加速度生成所述卡尔曼滤波模型的状态变量;根据所述状态变量在所述卡尔曼滤波模型中生成每一时刻所述激光设备的运动状态。
95.在一实施例中,所述处理器在执行所述程序指令而实现所述根据所述角度、所述加速度生成所述激光设备的净加速度时,具体实现如下步骤:对所述角度进行四元数转换,得到转换后的四元数;根据所述转换后的四元数对所述激光设备的重力加速度进行投影,得到投影后的重力加速度;根据所述加速度、所述投影后的重力加速度生成所述激光设备的净加速度。
96.在一实施例中,所述处理器在执行所述程序指令而实现所述根据所述运动状态的极差和方差检测所述激光设备在所述预设时间内的运动状态时,具体实现如下步骤:若所述极差大于预设的阈值,根据所述极差检测所述激光设备在所述预设时间内的运动状态;
若所述极差小于所述阈值,根据所述方差检测所述激光设备在所述预设时间内的运动状态。
97.所述存储介质可以是u盘、移动硬盘、只读存储器(read-only memory,rom)、磁碟或者光盘等各种可以存储程序代码的计算机可读存储介质。
98.本领域普通技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
99.在本发明所提供的几个实施例中,应该理解到,所揭露的装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的。例如,各个单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式。例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。
100.本发明实施例方法中的步骤可以根据实际需要进行顺序调整、合并和删减。本发明实施例装置中的单元可以根据实际需要进行合并、划分和删减。另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以是两个或两个以上单元集成在一个单元中。
101.该集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分,或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,终端,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。
102.以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1