一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

零点校准方法、装置、电子设备及计算机可读存储介质与流程

2021-12-08 00:44:00 来源:中国专利 TAG:
1.本技术涉及传感器领域,更具体而言,涉及一种矢量传感器的零点校准方法、零点校准装置、电子设备及非易失性计算机可读存储介质。
背景技术
::2.矢量传感器能够给出被测物理量的方向和大小,例如三轴磁阻矢量传感器能够测量地球磁场方向而被用于制作罗盘实现方位角测量功能;三轴加速度矢量传感器能够测量地球的重力加速度从而给出相对于水平面的倾斜角度。当被测物理量为零时,矢量传感器的数据输出往往并不为零,即存在零点误差。实际应用中想要直接测量零值的物理量,需要要实现矢量传感器的某一测量轴上被测物理量分量为零或者二者方向完全重合,这往往难以实现。而通过统计大量矢量传感器采用数据样本输出寻找极零点的方法又存在样本有限和校准时矢量传感器不能正常使用的问题。技术实现要素:3.本技术实施方式提供一种矢量传感器的零点校准方法、零点校准装置、电子设备及非易失性计算机可读存储介质。4.本技术实施方式的校准方法包括:获取矢量传感器在当次测量时的当次校正值ek和当次数据;获取所述矢量传感器在前一次测量时的前一数据;根据所述当次数据及所述前一数据获取修正量wk;根据所述当次校正值ek和所述修正量wk获取下一校正值ek 1;及获取矢量传感器下一次测量的下一原始数据rk 1,并根据所述下一原始数据rk 1和所述下一校正值ek 1获取下一有效数据vk 1。5.本技术实施方式的零点校准装置包括获取模块、修正模块、校正模块及计算模块。所述获取模块用于获取矢量传感器在当次测量时的当次校正值ek和当次数据,所述获取模块还用于获取所述矢量传感器在前一次测量时的前一数据;所述修正模块用于根据所述当次数据及所述前一数据获取修正量wk;所述校正模块用于根据所述当次校正值ek和所述修正量wk获取下一校正值ek 1;所述计算模块用于获取矢量传感器下一次测量的下一原始数据rk 1,并根据所述下一原始数据rk 1和所述下一校正值ek 1获取下一有效数据vk 1。6.本技术实施方式的电子设备包括矢量传感器、所述电子设备包括一个或多个处理器、存储器及一个或多个程序,其中,所述矢量传感器用于测量矢量,一个或多个所述程序被存储在所述存储器中,并且被一个或多个所述处理器执行,所述处理器用于:获取矢量传感器在当次测量时的当次校正值ek和当次数据;获取所述矢量传感器在前一次测量时的前一数据;根据所述当次数据及所述前一数据获取修正量wk;根据所述当次校正值ek和所述修正量wk获取下一校正值ek 1;及获取矢量传感器下一次测量的下一原始数据rk 1,并根据所述下一原始数据rk 1和所述下一校正值ek 1获取下一有效数据vk 1。7.本技术实施方式的非易失性计算机可读存储介质包含计算机程序,当所述计算机程序被一个或多个处理器执行时,使得一个或多个所述处理器实现如下校准方法:获取矢量传感器在当次测量时的当次校正值ek和当次数据;获取所述矢量传感器在前一次测量时的前一数据;根据所述当次数据及所述前一数据获取修正量wk;根据所述当次校正值ek和所述修正量wk获取下一校正值ek 1;及获取矢量传感器下一次测量的下一原始数据rk 1,并根据所述下一原始数据rk 1和所述下一校正值ek 1获取下一有效数据vk 1。8.本技术实施方式的矢量传感器的零点校准方法、零点校准装置、电子设备,能够根据当次数据及前一数据获取修正量wk,根据当次校正值ek和修正量wk获取下一校正值ek 1,从而获取更加准确的校正值,以在下一次测量时根据下一校正值ek 1对下一原始数据rk 1进行零点误差校准获取更接近真实值的下一有效数据vk 1。9.本技术的实施方式的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本技术的实施方式的实践了解到。附图说明10.本技术的上述和/或附加的方面和优点从结合下面附图对实施方式的描述中将变得明显和容易理解,其中:11.图1是本技术某些实施方式的矢量传感器的零点校准方法的流程示意图;12.图2是本技术某些实施方式的电子设备的结构示意图;13.图3是本技术某些实施方式的零点校准装置的结构示意图;14.图4是本技术某些实施方式的矢量传感器获取原始数据rk和有效数据vk的场景示意图;15.图5是本技术某些实施方式的矢量传感器获取原始数据rk和有效数据vk的场景示意图;16.图6是本技术某些实施方式的矢量传感器的零点校准的场景示意图;17.图7是本技术某些实施方式的矢量传感器的不同姿态的场景示意图;18.图8是本技术某些实施方式的校准方法的流程示意图;19.图9是本技术某些实施方式的矢量传感器在不同姿态测量矢量的场景示意图;20.图10是本技术某些实施方式的获取零点偏置m0的方向的场景示意图;21.图11是本技术某些实施方式的获取零点偏置m0的方向的场景示意图;22.图12是本技术某些实施方式的矢量传感器的零点校准的场景示意图;23.图13是本技术某些实施方式的校准方法的流程示意图;24.图14是本技术某些实施方式的校准方法的流程示意图;25.图15是本技术某些实施方式的校准方法的流程示意图;26.图16是本技术某些实施方式的获取零点偏置m0的方向的场景示意图;27.图17是本技术某些实施方式的计算机可读存储介质和处理器的连接状态示意图。具体实施方式28.下面详细描述本技术的实施方式,所述实施方式的示例在附图中示出,其中,相同或类似的标号自始至终表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本技术的实施方式,而不能理解为对本技术的实施方式的限制。29.请参阅图1至图3,本技术实施方式提供一种矢量传感器40的零点校准方法。该零点校准方法包括:30.01:获取矢量传感器40在当次测量时的当次校正值ek和当次数据;31.02:获取矢量传感器40在前一次测量时的前一数据;32.03:根据当次数据及前一数据获取修正量wk;33.04:根据当次校正值ek和修正量wk获取下一校正值ek 1;及34.05:获取矢量传感器40下一次测量的下一原始数据rk 1,并根据下一原始数据rk 1和下一校正值ek 1获取下一有效数据vk 1。35.请参阅图2,本技术实施方式还提供一种电子设备100,电子设备100包括矢量传感器40,矢量传感器40用于测量矢量。电子设备100包括还包括一个或多个处理器30、存储器20及一个或多个程序,其中,一个或多个程序被存储在存储器20中,并且被一个或多个处理器30执行,处理器30可用于执行01、02、03及04中的方法。即,处理器30可用于:获取矢量传感器40在当次测量时的当次校正值ek和当次数据;获取矢量传感器40在前一次测量时的前一数据;根据当次数据及前一数据获取修正量wk;根据当次校正值ek和修正量wk获取下一校正值ek 1;及获取矢量传感器40下一次测量的下一原始数据rk 1,并根据下一原始数据rk 1和下一校正值ek 1获取下一有效数据vk 1。36.请参阅图2及图3,本技术实施方式还提供一种零点校准装置10,零点校准装置10可应用于电子设备100。零点校准装置10包括获取模块11、修正模块12、校正模块13及计算模块14。获取模块11可用于执行01和02中的方法,修正模块12可用于执行03中的方法,校正模块13可用于执行04中的方法,计算模块14可用于执行05中的方法。即,获取模块11可用于获取矢量传感器40在当次测量时的当次校正值ek和当次数据;及获取矢量传感器40在前一次测量时的前一数据。修正模块12可用于根据当次数据及前一数据获取修正量wk。校正模块13可用于根据当次校正值ek和修正量wk获取下一校正值ek 1。计算模块14可用于获取矢量传感器40下一次测量的下一原始数据rk 1,并根据下一原始数据rk 1和下一校正值ek 1获取下一有效数据vk 1。37.请参阅图1至图3,其中,矢量传感器40可以是两轴或两轴以上的矢量传感器40,如两轴传感器、三轴传感器、六轴传感器或更多轴传感器等,在此不一一列举。根据被测矢量的类型,矢量传感器40可以选择各种类型的传感器,如地磁传感器、重力加速度传感器、角速度传感器、加速度传感器等,在此不一一列举。在某些实施方式中,矢量传感器40可以是mems(mems,micro‑electro‑mechanicalsystem)传感器,mems传感器可用于测量一种或多种类型的矢量。例如mems传感器包括六轴,能够兼具三轴加速度传感器的功能及三轴地磁传感器的功能,mems传感器的具体类型不局限于此,在此不一一列举。38.电子设备100可以是安装有矢量传感器40的任意电子设备100。例如电子设备100可以为手机、平板电脑(tabletpersonalcomputer)、膝上型电脑(laptopcomputer)、个人数字助理(personaldigitalassistant,简称pda)、移动上网装置(mobileinternetdevice,mid)或可穿戴式设备(wearabledevice)、无人机、无人车、无人船、智能机器人等,在此不一一列举。39.请参阅图2,其中,在一个实施例中,处理器30与矢量传感器40一体设置。在另一个实施例中,处理器30与矢量传感器40独立设置,矢量传感器40可将测量数据传输至处理器30,处理器30根据矢量传感器40测得的数据获取获取下一校正值ek 1,并将下一校正值ek 1传输至矢量传感器40,使矢量传感器40基于下一校正值ek 1获取下一有效数据vk 1,或在处理器30端根据下一校正值ek 1及矢量传感器40获取的下一原始数据rk 1获取下一有效数据vk 1。40.请参阅图4,通常,矢量传感器40的理论零点位置p0与矢量传感器40测量时采用的测量零点位置pe之间往往存在零点偏置m0,具体表现为被测矢量为零时矢量传感器40仍能够获取不为零的数据,此时矢量传感器40获取的矢量数据与零之间的矢量差即为矢量传感器40零点偏置m0。如果矢量传感器40测量时采用理论零点位置,则在被测矢量为零时矢量传感器40获取的矢量数据应该为零,即矢量传感器40获取的矢量数据能够表征真实的被测矢量。41.由于零点偏置m0是理论零点位置p0与测量零点位置pe之间的矢量差,而基于测量零点位置pe获取的原始数据rk能够反映零点位置pe,因此只要能够确定零点偏置m0,即可在矢量传感器40获取的原始数据rk的基础上结合零点偏置m0确定理论零点位置p0,从而获取准确的有效数据vk,其中,有效数据vk是基于矢量传感器40的实际零点位置获取的数据,即消除了零点误差后获取的数据。42.具体地,请参阅图2及图4,以两轴矢量传感器40基于测量零点位置pe测得的原始数据为例,在两轴矢量传感器40的坐标系中,p0是理论零点位置,pe是测量零点位置,零点偏置是理论零点位置p0与测量零点位置pe之间的矢量差,是理论上基于理论零点位置p0能够获取的矢量数据,也是消除零点误差后的理论矢量。可见,因此,只要能够确定零点偏置即可消除原始数据的零点误差得到矢量数据以将矢量数据作为有效数据输出,获取准确的测量矢量。43.请参阅图5,本技术实施方式的零点校准方法能够获取当次校正值和当次数据,当次数据可包括矢量传感器40在当次获取的当次原始数据其中,当次校正值是零点偏置的估计值,校正值表征测量零点位置pe与估计零点位置pk之间的矢量差。在实际测量时往往难以直接获取准确的零点偏置因此需要借助当次校正值估计零点的位置。基于估计零点位置pk,并根据当次校正值和当次原始数据能够获取当次有效数据当次有效数据是对当次原始数据进行零点误差校准后获取的矢量数据,更加接近被测矢量的实际值。44.请结合图4及图5,如果当次校正值与零点偏置重合,即当次校正值完全准确,那么根据当次校正值确定的估计零点位置pk与理论零点位置p0重合,在此情况下,根据当次校正值即可确定理论零点位置p0,即利用当次校正值对当次原始数据进行零点误差校准后可以完全消除当次原始数据的零点误差得到当次有效数据当次有效数据能够反映当次测量结果的实际值。同理,下一校正值越接近零点偏置即下一校正值越准确,则根据下一次测量时获取的下一原始数据和下一校正值获取的下一有效数据也越准确,越接近下一次测量结果的实际值。45.进一步地,请参阅图6,本技术实施方式的零点校准方法能够根据当次校正值ek和修正量wk获取下一校正值ek 1,修正量wk用于修正当次校正值ek得到下一校正值ek 1,使修正后得到的校正值更接近零点偏置m0。如图6所示,修正量wk表征估计零点位置pk与估计零点位置pk 1之间的矢量差,下一校正值是估计零点位置pk 1与测量零点位置pe之间的矢量差。可见,经过修正后,根据下一校正值确定的估计零点位置pk 1比基于当次校正值确定的估计零点位置pk更接近理论零点位置p0,下一校正值也更接近零点偏置随着测量次数k的不断增加,对校正值的修正不断进行,新获取的校正值也越来越逼近零点偏置即零点校准也越来越准确。46.本技术实施方式的矢量传感器40的零点校准方法、零点校准装置10、电子设备100,能够根据当次数据及前一数据获取修正量wk,根据当次校正值ek和修正量wk获取下一校正值ek 1,从而获取更加准确的校正值,以在下一次测量时根据下一校正值ek 1对下一原始数据rk 1进行零点误差校准获取更接近真实值的下一有效数据vk 1。此外,矢量传感器40的零点校准过程是在矢量传感器40正常输出数据的同时进行的,不会影响矢量传感器40的正常使用。47.下面结合附图做进一步说明。48.请参阅图1,方法01:获取矢量传感器40在当次测量时的当次校正值ek和当次数据;方法02:获取矢量传感器40在前一次测量时的前一数据。其中,k为大于0的自然数,即k的最小值为1。k表示测量的次数,例如当k=2时,当次校正值e2表示第2次测量时对应的校正值,修正量wk表示第2次测量时对应的修正量。49.校正值可以是一个预设值,例如当次校正值ek是根据预先的多次测算确定的校正值,或根据经验确定的校正值等,在此不作限制。50.校正值还可以是基于矢量传感器40前一次测量时对应的修正量确定,例如对于下一次测量而言,当次测量是下一次测量的前一次测量,则下一校正值ek 1可根据当次校正值ek和当次测量对应的修正量wk确定。再例如,当次校正值ek可根据上一校正值ek‑1和上一次测量对应的修正量wk‑1确定。具体地,例如当k=2时,校正值e2可根据k=1时的校正值e1和修正量w1确定。特别地,当k=1时,当次测量为第1次测量,由于不存在上一次测量对应的校正值e0和修正量w0,因此校正值e1是一个预设值。51.在某些实施方式中,在前一次测量时矢量传感器40的姿态与在当次测量时矢量传感器40的姿态不同。52.请参阅图7,具体地,不同姿态是指矢量传感器40在预设坐标系中相对于参考矢量在不同角度对应的姿态。例如,矢量传感器40相对固定的参考矢量发生移动或转动,从第一姿态变为第二姿态,比如参考矢量是重力加速度,重力加速度的方向不变,矢量传感器40相对重力加速度方向发生移动或转动而改变姿态。再例如,矢量传感器40自身不发生移动或转动,参考矢量相对矢量传感器40发生移动或转动,比如参考矢量是电磁场矢量,矢量传感器40放置在水平面并保持静止,电磁场源相对矢量传感器40发生移动或转动,使电磁场矢量的角度相对矢量传感器40的坐标轴发生改变,此时同样认为矢量传感器40相对参考矢量的姿态发生改变。再例如,矢量传感器40和参考矢量中至少一者相对另一者发生移动或转动,例如矢量传感器40固定、参考矢量运动;矢量传感器40运动、参考矢量固定;矢量传感器40和参考矢量均运动,则均认为矢量传感器40相对参考矢量的姿态发生改变。53.请参阅图8,在某些实施方式中,当次数据包括当次原始数据rk,前一数据包括前一原始数据rk‑1,03:根据当次数据及前一数据获取修正量wk,包括:54.031:根据当次原始数据rk和前一原始数据rk‑1获取权值dk及估计量mk;及55.032:根据权值dk及估计量mk获取修正量wk。56.请结合图2,在某些实施方式中,处理器30还可用于执行031及032中的方法。即,处理器30还可用于:根据当次原始数据rk和前一原始数据rk‑1获取权值dk及估计量mk;及根据权值dk及估计量mk获取修正量wk。57.请结合图3,在某些实施方式中,校正模块13还可用于执行031及032中的方法。即,校正模块13还可用于:根据当次原始数据rk和前一原始数据rk‑1获取权值dk及估计量mk;及根据权值dk及估计量mk获取修正量wk。58.请参阅图6,修正量wk是下一校正值ek 1和当次校正值ek之间的矢量差。具体地,ek 1=ek wk。本技术的实施方式能够根据权值dk及估计量mk获取修正量wk。59.具体地,请结合图9,以二轴矢量传感器40在不同姿态测量矢量并分别获取前一原始数据和当次原始数据为例,其中在前一次测量时和当次测量时矢量的矢量值|me|不变。请结合图7,在前一次测量时和当次测量时矢量相对矢量传感器40的坐标系方向改变。对于该矢量传感器40,若不存在零点误差,则矢量传感器40测量得到的矢量数据应该为自理论零点位置p0指向圆c的圆周的矢量,其中,圆c是以p0为圆心、以|me|为半径的圆。例如在不存在零点误差时矢量传感器40前一次测量的矢量数据应该为当次测量的矢量数据应该为其中,a1是矢量传感器40的坐标系在前一次测量时的姿态对应的外参矩阵,a2是矢量传感器40的坐标系在当次测量时的姿态对应的外参矩阵,和描述矢量传感器40相对被测矢量的姿态变化过程。前一原始数据和当次原始数据是基于测量零点位置pe测得的矢量,和自零点位置pe指向圆c的圆周。60.请参阅图9,对于和存在如下关系:61.公式一:62.公式二:63.将公式一的等式两边平方后得到公式三,64.公式三:65.将公式二的等式两边平方后得到公式四66.公式四:67.将公式三和公式四的等式作用两边分别做差后到公式五,68.公式五:69.令则公式五可改写为公式六:其中,dk是权值,是估计量。70.根据公式六,若dk>0,即则说明与同向;若dk<0,即则说明与反向。请结合图10,矢量的法平面sk将空间分为两部分,包括与同向的一侧tk和与反向的一侧fk。当时,能够确定的方向在tk侧;当侧;当时,能够确定的方向在fk侧。71.请结合图11,类似地,在第k 1次测量后矢量传感器40获取数据则可根据和获取和dk 1,根据dk 1的正负,可以确定的方向在的法平面sk 1的tk 1侧还是fk 1侧。在图11的示例中,dk和dk 1均<0,根据dk和dk 1的正负可以确定的方向在δ范围之内。随着测量次数k的增加,能够确定多个估计量与零点偏置之间的方向关系,即能够确定在多个的法平面sk分割的半空间的哪一侧,从而进一步确定在空间中的范围,即缩小δ的范围。将在空间中的分布情况取交集,即可确定一个较小的空间范围,这个较小的空间范围能够反映零点偏置的方向。72.请参阅图12,修正量wk用于修正校正值ek得到修正后的校正值ek 1,使测量零点位置pe经过校正值ek 1校正后得到的估计零点位置pk 1更逼近理论零点位置p0。即得到的校正值ek 1的方向和大小越准确,零点校准也越准确。而校正值ek 1=ek wk,修正量wk方向和大小越准确,得到的校正值ek 1的方向和大小也越准确,零点校准也越准确。73.其中,修正量wk的方向由估计量mk的矢量方向及权值dk的正负确定。请结合图10及图11,若dk<0,则修正量wk的方向与估计量mk的矢量方向一致,且与零点偏置均朝向mk的法平面sk的tk侧;若dk>0,则修正量wk的方向与估计量mk的矢量方向相反,且与零点偏置均朝向mk的法平面sk的fk侧。可见,修正量wk的方向始终与零点偏置的方向朝向mk的法平面sk确定的半空间的同一侧。因此,可以利用修正量wk估计零点偏置的方向,即利用修正量wk修正校正值ek的方向,使修正后的校正值ek 1的方向更逼近零点偏置的方向。随着测量次数k的增加,能够确定的零点偏置在空间中的范围越来越精确,修正后的校正值ek 1的方向越来越接近零点偏置的真实方向。74.修正量wk的大小由估计量mk的大小及权值dk确定。具体地,其中,α是预设的经验因子,用于避免的值过大使校正值ek 1的值过大而导致估计零点位置pk 1发散,以及提高零点位置pk 1向理论零点位置p0收敛的速度。在对收敛速度不作要求时,α的取值为1。|dk|能够反映前一次测量与当次测量时矢量传感器40的姿态变化程度。是一个差分过程,考虑噪声的影响,在实际测量时,z为噪声值。若前一次测量与当次测量时矢量传感器40的姿态变化程度较小,则与的值较为接近,较小,噪声值z对的差分结果影响较大,容易导致估计零点位置pk 1发散。而在前一次测量与当次测量时矢量传感器40的姿态变化程度较大时,噪声值z对的差分结果影响较小,使估计零点位置pk 1能够向理论零点位置p0收敛。因此,为避免估计零点位置pk 1发散,需要尽可能在矢量传感器40的姿态变化程度较大时利用修正量wk获取校正值ek 1以确定收敛的估计零点位置pk 1。|dk|与矢量传感器40的姿态变化程度正相关,|dk|的值越大则矢量传感器40的姿态变化程度越大,|dk|的值越小则矢量传感器40的姿态变化程度越小。表征对的利用程度,|dk|越大,则的取值对的利用程度越高,修正量wk对校正值ek的修正幅度也越高,确定的估计零点位置pk 1与前一估计零点位置pk之间的距离越远;|dk|越小,则的取值对的利用程度越低,修正量wk对校正值ek的修正幅度也越低,确定的估计零点位置pk 1与前一估计零点位置pk之间的距离越近。75.进一步地,在某些实施方式中,当|dk|大于预设阈值时,可利用修正量wk修正校正值ek以获取校正值ek 1;当|dk|小于或等于预设阈值时,可认为无需修正校正值ek,可以令修正量wk为零以使ek 1=ek 0=ek,或直接令ek 1=ek,此时无需进行零点校准,直到当|dk n|大于预设阈值时,利用修正量wk n获取校正值ek n。76.具体地,请参阅图13,在某些实施方式中,03:根据当次数据及前一数据获取修正量wk,包括:77.033:根据当次数据及前一数据获取权值dk及估计量mk;78.034:在权值dk大于预设阈值时,根据权值dk及估计量mk获取修正量wk;及79.035:在权值dk小于或等于预设阈值时,令修正量wk为零。80.请结合图2,在某些实施方式中,处理器30还可用于执行033、034及035中的方法。即,处理器30还可用于:根据当次数据及前一数据获取权值dk及估计量mk;在权值dk大于预设阈值时,根据权值dk及估计量mk获取修正量wk;及在权值dk小于或等于预设阈值时,令修正量wk为零。81.请结合图3,在某些实施方式中,校正模块13还可用于执行031及032中的方法。即,校正模块13还可用于:根据当次数据及前一数据获取权值dk及估计量mk;在权值dk大于预设阈值时,根据权值dk及估计量mk获取修正量wk;及在权值dk小于或等于预设阈值时,令修正量wk为零。82.如此,可以确保在进行零点校准时,校准后确定的估计零点位置pk 1是向理论零点位置p0收敛的,从而提高获取的有效数据的准确性。83.类似地,当矢量传感器40为两轴以上的矢量传感器40时,仍然可以通过本技术实施方式的零点校准方法获取修正量wk,以及根据修正量wk和当次校正值ek获取下一校正值ek 1,此处不再赘述。84.请参阅公式六:在某些实施方式中,当次数据包括当次原始数据rk和当次有效数据vk,前一次数据包括前一有效数据vk‑1,权值dk和估计量mk可根据当次有效数据vk和前一有效数据vk‑1获取。85.具体地,请参阅图14,在某些实施方式中,01:获取矢量传感器40在当次测量时的当次校正值ek和当次数据包括:86.011:根据当次原始数据rk及当次校正值ek获取当次有效数据vk。87.请结合图2,在某些实施方式中,处理器30还可用于执行011中的方法。即,处理器30还可用于:根据当次原始数据rk及当次校正值ek获取当次有效数据vk。88.请结合图3,在某些实施方式中,获取模块11还可用于执行01中的方法。即,获取模块11还可用于:根据当次原始数据rk及当次校正值ek获取当次有效数据vk。89.具体地,请结合图5,表征自估计零点位置pk指向圆c的圆周的矢量。类似地,前一有效数据表征自估计零点位置pk‑1指向圆c的圆周的矢量。90.请参阅图15,在某些实施方式中,03:根据当次数据及前一数据获取修正量wk,包括:91.036:根据当次有效数据vk和前一有效数据vk‑1获取权值dk及估计量mk;及92.037:根据权值dk及估计量mk获取修正量wk。93.请结合图2,在某些实施方式中,处理器30还可用于执行036及037中的方法。即,处理器30还可用于:根据当次有效数据vk和前一有效数据vk‑1获取权值dk及估计量mk;及根据权值dk及估计量mk获取修正量wk。94.请结合图3,在某些实施方式中,校正模块13还可用于执行036及037中的方法。即,校正模块13还可用于:根据当次有效数据vk和前一有效数据vk‑1获取权值dk及估计量mk;及根据权值dk及估计量mk获取修正量wk。95.请结合图9、公式五及公式六,在公式五:中,由于和可由矢量传感器40测量任意个矢量获取,因此得到的矢量可以为空间中的任一矢量,即公式六中实质是用表示得到的空间中的任一矢量。在公式五:中,反映矢量传感器40两次测量时的姿态变化程度,即公式六中实质是用dk表征矢量传感器40两次测量时的姿态变化程度。若以表征空间中的任一矢量,以表征矢量传感器40两次测量时的姿态变化程度,即则由公式六可以得到公式七:其中u是不为零的常数,其中u是不为零的常数,96.请参阅图16,并结合图10,在时仍然可以根据dk的正负确定相对零点偏置的方向,即确定零点偏置的方向在的法平面sk分隔的半空间的哪一侧,详细过程不再赘述。如此,在时,仍然可以利用dk的正负和的方向确定的方向,及确定的大小,详细过程不再赘述。97.请参阅图9,除了能够表征矢量传感器40两次测量时的姿态变化程度,还能够表征零点误差的校准程度。例如,若不存在零点误差,则在图9中的估计零点位置pk‑1、估计零点位置pk、及理论零点位置p0三点重合,那么若存在零点误差,则估计零点位置pk‑1和估计零点位置pk越靠近理论零点位置p0,说明零点误差的校准程度越高,此时的值也越小,dk也越小;零点位置pk‑1和估计零点位置pk越远离理论零点位置p0,说明零点误差的校准程度越低,此时的值也越大,dk也越大。请结合方法035:在权值dk小于或等于预设阈值时,令修正量wk为零,即在零点误差的校准程度较高时不修正当次校正值ek,认为零点误差校准已经达到要求。请结合方法034:在权值dk大于预设阈值时,根据权值dk及估计量mk获取修正量wk,以根据当次校正值ek和修正量wk获取下一校正值ek 1,用于在下一次(k 1次)测距时进行零点校准。98.请参阅公式六:其中,权值dk表征矢量传感器40两次测量时的姿态变化程度。在某些实施方式中,可根据姿态数据确定权值dk。其中,姿态数据是其他传感器测得的能够表征矢量传感器40两次测量时的姿态变化程度的数据。在一个实施例中,姿态数据可以是角速度传感器在矢量传感器40两次测量的同时测得的第一角速度和第二角速度,第一角速度和第二角速度之差越大,则表征矢量传感器40两次测量时的姿态变化程度越大,则确定的权值dk越大。姿态数据的类型不局限于矢量传感器40在两次测量时的角速度的变化率,在此不作限制。99.具体地,请参阅图16,在某些实施方式中,03:根据当次数据及前一数据获取修正量wk,包括:100.038:获取姿态数据;及101.039:根据当次数据、前一数据及姿态数据获取修正量wk。102.请结合图2,在某些实施方式中,处理器30还可用于执行038及039中的方法。即,处理器30还可用于:获取姿态数据;及根据当次数据、前一数据及姿态数据获取修正量wk。103.请结合图3,在某些实施方式中,校正模块13还可用于执行038及039中的方法。即,校正模块13还可用于:获取姿态数据;及根据当次数据、前一数据及姿态数据获取修正量wk。104.具体地,修正量wk由权值dk及估计量mk确定,权值dk由姿态数据确定,估计量mk由当次数据和前一数据确定。结合前文所述,若当次数据和前一数据分别为当次原始数据和前一原始数据则若当次数据和前一数据分别为当次有效数据vk和前一有效数据vk‑1,则105.综上,本技术实施方式的矢量传感器40的零点校准方法、零点校准装置10、电子设备100,能够根据当次数据及前一数据获取修正量wk,根据当次校正值ek和修正量wk获取下一校正值ek 1,从而获取更加准确的校正值,以在下一次测量时根据下一校正值ek 1对下一原始数据rk 1进行零点误差校准获取更接近真实值的下一有效数据vk 1。106.本技术实施方式的矢量传感器40的零点校准方法、零点校准装置10、电子设备100还能够在输出有效数据的同时进行零点校准,具体地,在任意的第k次测量时均可进行零点校准,以能够动态地在矢量传感器40的使用过程中完成零点校准,持续确保有效数据的准确性。107.请参阅图17,本技术实施方式还提供一种包含计算机程序401的非易失性计算机可读存储介质400。当计算机程序401被一个或多个处理器30执行时,使得一个或多个处理器30执行上述任一实施方式的校准方法。非易失性计算机可读存储介质400可设置在电子设备100内,也可设置在云端服务器或其他装置中,此时,电子设备100能够与云端服务器或其他装置进行通讯来获取到相应的计算机程序401。108.请结合图2,例如,当计算机程序401被一个或多个处理器30执行时,使得一个或多个处理器30执行01、02、03、04、05、011、031、032、033、034、035、036、037、038及039中的方法。例如执行以下应用校准方法:109.01:获取矢量传感器40在当次测量时的当次校正值ek和当次数据;110.02:获取矢量传感器40在前一次测量时的前一数据;111.03:根据当次数据及前一数据获取修正量wk;112.04:根据当次校正值ek和修正量wk获取下一校正值ek 1;及113.05:获取矢量传感器40下一次测量的下一原始数据rk 1,并根据下一原始数据rk 1和下一校正值ek 1获取下一有效数据vk 1。114.又例如,当计算机程序401被一个或多个处理器30执行时,使得一个或多个处理器30执行以下校准方法:115.01:获取矢量传感器40在当次测量时的当次校正值ek和当次数据;116.02:获取矢量传感器40在前一次测量时的前一数据;117.031:根据当次原始数据rk和前一原始数据rk‑1获取权值dk及估计量mk;118.032:根据权值dk及估计量mk获取修正量wk;119.034:在权值dk大于预设阈值时,根据权值dk及估计量mk获取修正量wk;120.035:在权值dk小于或等于预设阈值时,令修正量wk为零;121.04:根据当次校正值ek和修正量wk获取下一校正值ek 1;及122.05:获取矢量传感器40下一次测量的下一原始数据rk 1,并根据下一原始数据rk 1和下一校正值ek 1获取下一有效数据vk 1。123.在本说明书的描述中,参考术语“某些实施方式”、“一个例子中”、“示例地”等的描述意指结合所述实施方式或示例描述的具体特征、结构、材料或者特点包含于本技术的至少一个实施方式或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施方式或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施方式或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。124.流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为,表示包括一个或更多个用于实现特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分,并且本技术的优选实施方式的范围包括另外的实现,其中可以不按所示出或讨论的顺序,包括根据所涉及的功能按基本同时的方式或按相反的顺序,来执行功能,这应被本技术的实施例所属
技术领域
:的技术人员所理解。125.尽管上面已经示出和描述了本技术的实施方式,可以理解的是,上述实施方式是示例性的,不能理解为对本技术的限制,本领域的普通技术人员在本技术的范围内可以对上述实施方式进行变化、修改、替换和变型。当前第1页12当前第1页12
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献