CN113063442B - 扫地机器人陀螺仪标定方法、装置、计算机设备及存储器 - Google Patents
扫地机器人陀螺仪标定方法、装置、计算机设备及存储器 Download PDFInfo
- Publication number
- CN113063442B CN113063442B CN202110287961.5A CN202110287961A CN113063442B CN 113063442 B CN113063442 B CN 113063442B CN 202110287961 A CN202110287961 A CN 202110287961A CN 113063442 B CN113063442 B CN 113063442B
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- measured
- detected
- angle
- sweeping robot
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000010408 sweeping Methods 0.000 title claims abstract description 65
- 238000000034 method Methods 0.000 title claims abstract description 46
- 230000003068 static effect Effects 0.000 claims abstract description 18
- 238000001514 detection method Methods 0.000 claims abstract description 16
- 230000009471 action Effects 0.000 claims abstract description 10
- 230000008859 change Effects 0.000 claims description 12
- 238000004590 computer program Methods 0.000 claims description 7
- 238000012795 verification Methods 0.000 claims description 6
- 230000008569 process Effects 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 3
- 230000002349 favourable effect Effects 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Abstract
本申请实施例属于扫地机器人检测技术领域,涉及扫地机器人陀螺仪标定方法,包括连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式;调整步骤:在所述校准模式下,将参考陀螺仪和待测陀螺仪的初始角度调整为一致;驱动机器人根据预设动作转动;在静止状态下,分别获取参考陀螺仪和待测陀螺仪的角度值,根据所述角度变化量的比例确定标定系数,并且根据标定系数调整待测陀螺仪的角度变化幅度;转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值。本申请还提供扫地机器人陀螺仪标定装置、计算机设备及存储介质。本申请检测成本低效率高。
Description
技术领域
本申请涉及扫地机器人检测技术领域,尤其涉及扫地机器人陀螺仪标定方法、装置、计算机设备及存储器。
背景技术
扫地机器人能够自主的对一片预设的区域进行清扫,从而简化室内清洁的工作量,在扫地机器人自主清扫的过程中需要依靠导航控制扫地机器人合理的在预设区域内行走并清洁,在此过程当中需要通过陀螺仪获取扫地机器人动态角度的变化数据,每个扫地机器人在出厂的时候,都需要保证陀螺仪的精度在允许的范围之内,现有的陀螺仪检测方式通常需要使用到专用的检测设备,而此类专业设备,使用成本高昂,适合在专业的电子配件生产厂家使用,对于陀螺仪使用量不大的厂商而言,配套专用的陀螺仪检测设备将造成检测工序的成本高昂,专用的陀螺仪检测设备的重要价值,在于他可以驱动待测的陀螺仪转动预设的旋转角度,而扫地机器人本身即可实现机身转动的精确控制,因此,有必要通过扫地机器人本身检测其使用的陀螺仪以降低扫地机器人上的陀螺仪检测的成本。
发明内容
本申请实施例的目的在于提出一种借助扫地机器人本身标定陀螺仪的方法。
为了解决上述技术问题,本申请实施例提供扫地机器人陀螺仪标定方法,采用了如下所述的技术方案:
扫地机器人陀螺仪标定方法,包括下述步骤:
连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式;
调整步骤:在所述校准模式下,将参考陀螺仪和待测陀螺仪的初始角度调整为一致;
驱动机器人根据预设动作转动;
在静止状态下,分别获取参考陀螺仪和待测陀螺仪的角度值,如果所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值大于预设阈值,则根据所述角度变化量的比例确定标定系数,并且根据标定系数调整待测陀螺仪的角度变化幅度;
转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值。
进一步的,所述步骤连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式,具体包括:
控制扫地机器人开机或重启;
在预设时间内检测参考陀螺仪产生的所述信号,如果检测到了所述信号,进入校准模式。
进一步的,所述步骤将参考陀螺仪和待测陀螺仪的初始角度调整为一致,具体包括:
根据待测陀螺仪初始时间不为0,连续获取待测陀螺仪的角速度;
根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;
在扫地机器人静止的状态下,将参考陀螺仪和待测陀螺仪的初始时间设定为0,并且将待测陀螺仪和参考陀螺仪的初始角度设定为0。
进一步的,所述步骤将参考陀螺仪和待测陀螺仪的初始角度调整为一致,还包括:
根据待测陀螺仪的初始时间为0,连续获取待测陀螺仪的角速度;
根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;
在扫地机器人静止的状态下,获取所述待测陀螺仪或所述待测陀螺仪的当前角度,并且将所述参考陀螺仪和待测陀螺仪的初始角度设定为所述当前角度。
进一步的,所述步骤转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值之后,该方法还包括:
进入验证模式中,驱动机器人转动,并且根据参考陀螺仪和待测陀螺仪的角度变化量小于阈值验证待测陀螺仪正常。
进一步的,所述步骤进入验证模式中,驱动机器人转动,并且根据参考陀螺仪和待测陀螺仪的角度变化量小于阈值验证待测陀螺仪正常之后,该方法还包括:
预设时间之后,进入调整步骤,以周期性的标定所述待测陀螺仪。
为了解决上述技术问题,本申请实施例还提扫地机器人陀螺仪标定装置,采用了如下所述的技术方案:
扫地机器人陀螺仪标定装置,包括:
模式控制模块,用于连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式;
调整模块,用于执行调整步骤:在所述校准模式下,将参考陀螺仪和待测陀螺仪的初始角度调整为一致;
驱动模块,用于驱动机器人根据预设动作转动;
标定模块,用于在静止状态下,分别获取参考陀螺仪和待测陀螺仪的角度值,如果所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值大于预设阈值,则根据所述角度变化量的比例确定标定系数,并且根据标定系数调整待测陀螺仪的角度变化幅度;
循环模块,用于转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值。
进一步的,所述调整模块,具体包括:
角速度获取子模块,用于根据待测陀螺仪初始时间不为0,连续获取待测陀螺仪的角速度;
静止判定子模块,用于根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;
初始值设定子模块,用于在扫地机器人静止的状态下,将参考陀螺仪和待测陀螺仪的初始时间设定为0,并且将待测陀螺仪和参考陀螺仪的初始角度设定为0。
为了解决上述技术问题,本申请实施例还提供一种计算机设备,采用了如下所述的技术方案:
一种计算机设备,包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器执行所述计算机程序时实现如上所述的扫地机器人陀螺仪标定方法的步骤。
为了解决上述技术问题,本申请实施例还提供一种计算机可读存储介质,采用了如下所述的技术方案:
一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如上所述的扫地机器人陀螺仪标定方法的步骤。
与现有技术相比,本申请实施例主要有以下有益效果:通过在扫地机器人上设置精度良好的参考陀螺仪,并且在检测到参考陀螺仪的状态下进入校准状态,首先调整参考陀螺仪和待测陀螺仪的初始角度参数,之后根据预设的动作驱动扫地机器人转动,以产生角度变化供参考陀螺仪和待测陀螺仪同时检测,之后对比参考陀螺仪和待测陀螺仪的角度值的差值,确定待测陀螺仪的标定系数,以调整待测陀螺仪检测角度变化的幅度,该方案利用扫地机器人能够稳定输出转动角度,通过参考陀螺仪配合进行待测陀螺仪的检测,检测成本低效率高。
附图说明
为了更清楚地说明本申请中的方案,下面将对本申请实施例描述中所需要使用的附图作一个简单介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1根据本申请的扫地机器人陀螺仪标定方法的一个实施例的流程图;
图2是根据本申请的扫地机器人陀螺仪标定装置的一个实施例的结构示意图;
图3是根据本申请的计算机设备的一个实施例的结构示意图。
具体实施方式
除非另有定义,本文所使用的所有的技术和科学术语与属于本申请的技术领域的技术人员通常理解的含义相同;本文中在申请的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本申请;本申请的说明书和权利要求书及上述附图说明中的术语“包括”和“具有”以及它们的任何变形,意图在于覆盖不排他的包含。本申请的说明书和权利要求书或上述附图中的术语“第一”、“第二”等是用于区别不同对象,而不是用于描述特定顺序。
在本文中提及“实施例”意味着,结合实施例描述的特定特征、结构或特性可以包含在本申请的至少一个实施例中。在说明书中的各个位置出现该短语并不一定均是指相同的实施例,也不是与其它实施例互斥的独立的或备选的实施例。本领域技术人员显式地和隐式地理解的是,本文所描述的实施例可以与其它实施例相结合。
为了使本技术领域的人员更好地理解本申请方案,下面将结合附图,对本申请实施例中的技术方案进行清楚、完整地描述。
参考图1,示出了根据本申请的扫地机器人陀螺仪标定方法方法的一个实施例的流程图。所述的扫地机器人陀螺仪标定方法,包括以下步骤:
步骤S100:连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式;
步骤S200:调整步骤:在所述校准模式下,将参考陀螺仪和待测陀螺仪的初始角度调整为一致;
步骤S300:驱动机器人根据预设动作转动;
步骤S400:在静止状态下,分别获取参考陀螺仪和待测陀螺仪的角度值,如果所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值大于预设阈值,则根据所述角度变化量的比例确定标定系数,并且根据标定系数调整待测陀螺仪的角度变化幅度;
步骤S500:转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值。
具体的,通过在扫地机器人上设置精度良好的参考陀螺仪,并且在检测到参考陀螺仪的状态下进入校准状态,首先调整参考陀螺仪和待测陀螺仪的初始角度参数,之后根据预设的动作驱动扫地机器人转动,以产生角度变化供参考陀螺仪和待测陀螺仪同时检测,之后对比参考陀螺仪和待测陀螺仪的角度值的差值,确定待测陀螺仪的标定系数,以调整待测陀螺仪检测角度变化的幅度,该方案利用扫地机器人能够稳定输出转动角度,通过参考陀螺仪配合进行待测陀螺仪的检测,检测成本低效率高。
在本实施例中,扫地机器人陀螺仪标定方法所运行的电子设备(例如图1所示的服务器/终端设备)可以通过有线连接方式或者无线连接方式请求或者接收数据和信息。需要指出的是,上述无线连接方式可以包括但不限于3G/4G连接、WiFi连接、蓝牙连接、WiMAX连接、Zigbee连接、UWB(ultra wideband)连接、以及其他现在已知或将来开发的无线连接方式。
进一步的,所述步骤100:连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式,具体包括:
步骤101:控制扫地机器人开机或重启;
步骤102:在预设时间内检测参考陀螺仪产生的所述信号,如果检测到了所述信号,进入校准模式。
具体的,扫地机器人的校准工作紧紧在出厂及检修过程中才会进行,并且在需要机器人进行陀螺仪校准工作的前提是安装了参考陀螺仪,所以在开机自检的过程中通过扫描接口或端口的方式判断有无参考陀螺仪的加装,仅仅在加装了陀螺仪的前提之下,才进入校准模式,该方案提升了机器人校准工作的便利性。
进一步的,所述步骤S200:将参考陀螺仪和待测陀螺仪的初始角度调整为一致,具体包括:
步骤S201:连续获取待测陀螺仪的角速度;
步骤S202:根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;
步骤S203:根据待测陀螺仪初始时间不为0,,在扫地机器人静止的状态下,将所述待测陀螺仪的初始时间设定为0,并且将待测陀螺仪和参考陀螺仪的初始角度设定为0。
具体的,待测陀螺仪和参考陀螺仪之间的校准是通过单位时间角度变化量的大小的匹配进行的,待测陀螺仪和参考陀螺仪分别具有各自的时钟,需要将时钟调整为一致,并且起始角度的标量调整为一致,才便于后续的检测和计算,在一种实施例当中,待测陀螺仪的起始时间不为零,此时将待测陀螺仪和标准陀螺仪的初始时间以及初始的角度标量均调整为零,以开始后续的标定计算。该方案有利于提升陀螺仪标定的效率。
进一步的,所述步骤步骤S200:将参考陀螺仪和待测陀螺仪的初始角度调整为一致中,步骤S202根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止之后还包括:
步骤S204:根据待测陀螺仪初始时间为0,在扫地机器人静止的状态下,获取所述待测陀螺仪或所述待测陀螺仪的当前角度,并且将所述参考陀螺仪和待测陀螺仪的初始角度设定为所述当前角度。
在一种实施例当中,如果待测陀螺仪的初始时间为0,说明待测陀螺仪已经完成了归零状态,此时待测陀螺仪的角度示数不一定为零,将参考陀螺仪的初始时间调整为零,而将参考陀螺仪的初始角度调整为与待测陀螺仪一致,并进行待测陀螺仪的标定。
进一步的,所述步骤S500:转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值之后,该方法还包括:
步骤S600:进入验证模式中,驱动机器人转动,并且根据参考陀螺仪和待测陀螺仪的角度变化量小于阈值验证待测陀螺仪正常。
该方案有利于保证待测陀螺仪标定系数获取的准确。
进一步的,所述步骤S600:进入验证模式中,驱动机器人转动,并且根据参考陀螺仪和待测陀螺仪的角度变化量小于阈值验证待测陀螺仪正常之后,该方法还包括:
步骤S700:预设时间之后,进入调整步骤,以周期性的标定所述待测陀螺仪。
该方案有利于持续表征待测陀螺仪稳定运行。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,该计算机程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,前述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)等非易失性存储介质,或随机存储记忆体(Random Access Memory,RAM)等。
应该理解的是,虽然附图的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,其可以以其他的顺序执行。而且,附图的流程图中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,其执行顺序也不必然是依次进行,而是可以与其他步骤或者其他步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
进一步参考图2,作为对上述图1所示方法的实现,本申请提供了扫地机器人陀螺仪标定的一个实施例,该装置实施例与图1所示的方法实施例相对应,该装置具体可以应用于各种电子设备中。
扫地机器人陀螺仪标定装置,包括:
模式控制模块100,用于连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式;
调整模块200,用于执行调整步骤:在所述校准模式下,将参考陀螺仪和待测陀螺仪的初始角度调整为一致;
驱动模块300,用于驱动机器人根据预设动作转动;
标定模块400,用于在静止状态下,分别获取参考陀螺仪和待测陀螺仪的角度值,如果所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值大于预设阈值,则根据所述角度变化量的比例确定标定系数,并且根据标定系数调整待测陀螺仪的角度变化幅度;
循环模块500,用于转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值。
具体的,通过在扫地机器人上设置精度良好的参考陀螺仪,并且在检测到参考陀螺仪的状态下进入校准状态,首先调整参考陀螺仪和待测陀螺仪的初始角度参数,之后根据预设的动作驱动扫地机器人转动,以产生角度变化供参考陀螺仪和待测陀螺仪同时检测,之后对比参考陀螺仪和待测陀螺仪的角度值的差值,确定待测陀螺仪的标定系数,以调整待测陀螺仪检测角度变化的幅度,该方案利用扫地机器人能够稳定输出转动角度,通过参考陀螺仪配合进行待测陀螺仪的检测,检测成本低效率高。
进一步的,所述调整模块,具体包括:
角速度获取子模块201,用于根据待测陀螺仪初始时间不为0,连续获取待测陀螺仪的角速度;
静止判定子模块202,用于根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;
初始值设定子模块203,用于在扫地机器人静止的状态下,将参考陀螺仪和待测陀螺仪的初始时间设定为0,并且将待测陀螺仪和参考陀螺仪的初始角度设定为0。
为解决上述技术问题,本申请实施例还提供计算机设备。具体请参阅图3,图3为本实施例计算机设备基本结构框图。
所述计算机设备6包括通过系统总线相互通信连接存储器61、处理器62、网络接口63。需要指出的是,图中仅示出了具有组件61-63的计算机设备6,但是应理解的是,并不要求实施所有示出的组件,可以替代的实施更多或者更少的组件。其中,本技术领域技术人员可以理解,这里的计算机设备是一种能够按照事先设定或存储的指令,自动进行数值计算和/或信息处理的设备,其硬件包括但不限于微处理器、专用集成电路(ApplicationSpecific Integrated Circuit,ASIC)、可编程门阵列(Field-Programmable GateArray,FPGA)、数字处理器(Digital Signal Processor,DSP)、嵌入式设备等。
所述计算机设备可以是桌上型计算机、笔记本、掌上电脑及云端服务器等计算设备。所述计算机设备可以与用户通过键盘、鼠标、遥控器、触摸板或声控设备等方式进行人机交互。
所述存储器61至少包括一种类型的可读存储介质,所述可读存储介质包括闪存、硬盘、多媒体卡、卡型存储器(例如,SD或DX存储器等)、随机访问存储器(RAM)、静态随机访问存储器(SRAM)、只读存储器(ROM)、电可擦除可编程只读存储器(EEPROM)、可编程只读存储器(PROM)、磁性存储器、磁盘、光盘等。在一些实施例中,所述存储器61可以是所述计算机设备6的内部存储单元,例如该计算机设备6的硬盘或内存。在另一些实施例中,所述存储器61也可以是所述计算机设备6的外部存储设备,例如该计算机设备6上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(FlashCard)等。当然,所述存储器61还可以既包括所述计算机设备6的内部存储单元也包括其外部存储设备。本实施例中,所述存储器61通常用于存储安装于所述计算机设备6的操作系统和各类应用软件,例如陀螺仪标定方法的程序代码等。此外,所述存储器61还可以用于暂时地存储已经输出或者将要输出的各类数据。
所述处理器62在一些实施例中可以是中央处理器(Central Processing Unit,CPU)、控制器、微控制器、微处理器、或其他数据处理芯片。该处理器62通常用于控制所述计算机设备6的总体操作。本实施例中,所述处理器62用于运行所述存储器61中存储的程序代码或者处理数据,例如运行所述陀螺仪标定方法的程序代码。
所述网络接口63可包括无线网络接口或有线网络接口,该网络接口63通常用于在所述计算机设备6与其他电子设备之间建立通信连接。
本申请还提供了另一种实施方式,即提供一种计算机可读存储介质,所述计算机可读存储介质存储有陀螺仪标定程序,所述陀螺仪标定程序可被至少一个处理器执行,以使所述至少一个处理器执行如上述的陀螺仪标定方法的步骤。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到上述实施例方法可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件,但很多情况下前者是更佳的实施方式。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质(如ROM/RAM、磁碟、光盘)中,包括若干指令用以使得一台终端设备(可以是手机,计算机,服务器,空调器,或者网络设备等)执行本申请各个实施例所述的方法。
显然,以上所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例,附图中给出了本申请的较佳实施例,但并不限制本申请的专利范围。本申请可以以许多不同的形式来实现,相反地,提供这些实施例的目的是使对本申请的公开内容的理解更加透彻全面。尽管参照前述实施例对本申请进行了详细的说明,对于本领域的技术人员来而言,其依然可以对前述各具体实施方式所记载的技术方案进行修改,或者对其中部分技术特征进行等效替换。凡是利用本申请说明书及附图内容所做的等效结构,直接或间接运用在其他相关的技术领域,均同理在本申请专利保护范围之内。
Claims (10)
1.扫地机器人陀螺仪标定方法,其特征在于,包括下述步骤:
在安装了参考陀螺仪的扫地机器人上,连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式;
调整步骤:在所述校准模式下,将参考陀螺仪和待测陀螺仪的初始角度调整为一致;将参考陀螺仪和待测陀螺仪的初始时间设定为0;
待测陀螺仪和参考陀螺仪之间的校准是通过单位时间角度变化量的大小的匹配进行;
具体根据预设的动作驱动扫地机器人转动,以产生角度变化供参考陀螺仪和待测陀螺仪同时检测,之后对比参考陀螺仪和待测陀螺仪的角度值的差值,确定待测陀螺仪的标定系数;
在静止状态下,分别获取参考陀螺仪和待测陀螺仪的角度值,通过单位时间匹配角度变化量的大小,如果所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值大于预设阈值,则根据所述角度变化量的比例确定标定系数,并且根据标定系数调整待测陀螺仪的角度变化幅度;
转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值。
2.根据权利要求1所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式,具体包括:
控制扫地机器人开机或重启;
在预设时间内检测参考陀螺仪产生的所述信号,如果检测到了所述信号,进入校准模式。
3.根据权利要求1所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤将参考陀螺仪和待测陀螺仪的初始角度调整为一致,具体包括:
根据待测陀螺仪初始时间不为0,连续获取待测陀螺仪的角速度;
根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;
在扫地机器人静止的状态下,并且将待测陀螺仪和参考陀螺仪的初始角度设定为0。
4.根据权利要求3所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤将参考陀螺仪和待测陀螺仪的初始角度调整为一致,还包括:
根据待测陀螺仪的初始时间为0,连续获取待测陀螺仪的角速度;
根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;
在扫地机器人静止的状态下,获取所述待测陀螺仪或所述待测陀螺仪的当前角度,并且将所述参考陀螺仪和待测陀螺仪的初始角度设定为所述当前角度。
5.根据权利要求1所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值之后,该方法还包括:
进入验证模式中,驱动机器人转动,并且根据参考陀螺仪和待测陀螺仪的角度变化量小于阈值验证待测陀螺仪正常。
6.根据权利要求5所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤进入验证模式中,驱动机器人转动,并且根据参考陀螺仪和待测陀螺仪的角度变化量小于阈值验证待测陀螺仪正常之后,该方法还包括:
预设时间之后,进入调整步骤,以周期性的标定所述待测陀螺仪。
7.扫地机器人陀螺仪标定装置,其特征在于,包括:
模式控制模块,用于在安装了参考陀螺仪的扫地机器人上,连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式;
调整模块,用于执行调整步骤:在所述校准模式下,将参考陀螺仪和待测陀螺仪的初始角度调整为一致;将参考陀螺仪和待测陀螺仪的初始时间设定为0;
待测陀螺仪和参考陀螺仪之间的校准是通过单位时间角度变化量的大小的匹配进行;
驱动模块,用于根据预设的动作驱动扫地机器人转动,以产生角度变化供参考陀螺仪和待测陀螺仪同时检测,之后对比参考陀螺仪和待测陀螺仪的角度值的差值,确定待测陀螺仪的标定系数;
标定模块,用于在静止状态下,分别获取参考陀螺仪和待测陀螺仪的角度值,通过单位时间匹配角度变化量的大小,如果所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值大于预设阈值,则根据所述角度变化量的比例确定标定系数,并且根据标定系数调整待测陀螺仪的角度变化幅度;
循环模块,用于转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值。
8.根据权利要求7所述的扫地机器人陀螺仪标定方法,其特征在于,所述调整模块,具体包括:
角速度获取子模块,用于根据待测陀螺仪初始时间不为0,连续获取待测陀螺仪的角速度;
静止判定子模块,用于根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;
初始值设定子模块,用于在扫地机器人静止的状态下,将参考陀螺仪和待测陀螺仪的初始时间设定为0,并且将待测陀螺仪和参考陀螺仪的初始角度设定为0。
9.一种计算机设备,包括存储器和处理器,所述存储器中存储有计算机程序,其特征在于:所述处理器执行所述计算机程序时实现如权利要求1至6中任一项所述的扫地机器人陀螺仪标定方法的步骤。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至6中任一项所述的扫地机器人陀螺仪标定方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110287961.5A CN113063442B (zh) | 2021-03-17 | 扫地机器人陀螺仪标定方法、装置、计算机设备及存储器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110287961.5A CN113063442B (zh) | 2021-03-17 | 扫地机器人陀螺仪标定方法、装置、计算机设备及存储器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113063442A CN113063442A (zh) | 2021-07-02 |
CN113063442B true CN113063442B (zh) | 2024-06-07 |
Family
ID=
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20070033248A (ko) * | 2005-09-21 | 2007-03-26 | 삼성전자주식회사 | 자이로 센서의 보정 방법 및 장치 |
CN101932908A (zh) * | 2007-12-21 | 2010-12-29 | 萨基姆防务安全公司 | 由陀螺系统执行的测量方法 |
CN107194969A (zh) * | 2012-10-16 | 2017-09-22 | 高通股份有限公司 | 基于消失点确定的传感器校准和位置估计 |
CN109489686A (zh) * | 2018-10-31 | 2019-03-19 | 中国人民解放军国防科技大学 | 四频差动激光陀螺带宽与角分辨率测试方法 |
CN109631947A (zh) * | 2018-12-28 | 2019-04-16 | Tcl移动通信科技(宁波)有限公司 | 一种移动终端的旋转修正方法、存储介质及移动终端 |
CN109813341A (zh) * | 2019-02-26 | 2019-05-28 | 南京理工大学 | 一种硅微机械陀螺驱动力耦合误差在线自校准系统 |
CN109916428A (zh) * | 2017-12-12 | 2019-06-21 | 珠海全志科技股份有限公司 | 设备内陀螺仪传感系统性能测试方法及装置 |
CN110177998A (zh) * | 2017-01-06 | 2019-08-27 | Idhl控股公司 | 用于陀螺仪标定校准的方法、装置和系统 |
CN110542417A (zh) * | 2019-09-05 | 2019-12-06 | 武汉理工大学 | 基于静态和和动态倾角仪校正的陀螺仪线形测量方法与系统 |
CN111024119A (zh) * | 2019-11-25 | 2020-04-17 | 天津津航技术物理研究所 | 一种三轴mems陀螺仪快速标定方法 |
CN111912428A (zh) * | 2020-07-20 | 2020-11-10 | 北京京东乾石科技有限公司 | 一种检测陀螺仪的方法和系统 |
CN112461261A (zh) * | 2020-11-06 | 2021-03-09 | 长沙天仪空间科技研究院有限公司 | 一种校正mems陀螺仪温度漂移的装置和方法 |
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20070033248A (ko) * | 2005-09-21 | 2007-03-26 | 삼성전자주식회사 | 자이로 센서의 보정 방법 및 장치 |
CN101932908A (zh) * | 2007-12-21 | 2010-12-29 | 萨基姆防务安全公司 | 由陀螺系统执行的测量方法 |
CN107194969A (zh) * | 2012-10-16 | 2017-09-22 | 高通股份有限公司 | 基于消失点确定的传感器校准和位置估计 |
CN110177998A (zh) * | 2017-01-06 | 2019-08-27 | Idhl控股公司 | 用于陀螺仪标定校准的方法、装置和系统 |
CN109916428A (zh) * | 2017-12-12 | 2019-06-21 | 珠海全志科技股份有限公司 | 设备内陀螺仪传感系统性能测试方法及装置 |
CN109489686A (zh) * | 2018-10-31 | 2019-03-19 | 中国人民解放军国防科技大学 | 四频差动激光陀螺带宽与角分辨率测试方法 |
CN109631947A (zh) * | 2018-12-28 | 2019-04-16 | Tcl移动通信科技(宁波)有限公司 | 一种移动终端的旋转修正方法、存储介质及移动终端 |
CN109813341A (zh) * | 2019-02-26 | 2019-05-28 | 南京理工大学 | 一种硅微机械陀螺驱动力耦合误差在线自校准系统 |
CN110542417A (zh) * | 2019-09-05 | 2019-12-06 | 武汉理工大学 | 基于静态和和动态倾角仪校正的陀螺仪线形测量方法与系统 |
CN111024119A (zh) * | 2019-11-25 | 2020-04-17 | 天津津航技术物理研究所 | 一种三轴mems陀螺仪快速标定方法 |
CN111912428A (zh) * | 2020-07-20 | 2020-11-10 | 北京京东乾石科技有限公司 | 一种检测陀螺仪的方法和系统 |
CN112461261A (zh) * | 2020-11-06 | 2021-03-09 | 长沙天仪空间科技研究院有限公司 | 一种校正mems陀螺仪温度漂移的装置和方法 |
Non-Patent Citations (1)
Title |
---|
MEMS微型惯性测量组合的标定;陈湾湾;陈智刚;付建平;;仪表技术与传感器;20141215(第12期);全文 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10852139B2 (en) | Positioning method, positioning device, and robot | |
US10871778B2 (en) | Robot charging control method, apparatus, and robot thereof | |
JP3958289B2 (ja) | 電子コンパスの自動補正方法 | |
CN111590595B (zh) | 一种定位方法、装置、移动机器人及存储介质 | |
CN111070205B (zh) | 对桩控制方法、装置、智能机器人及存储介质 | |
KR101808095B1 (ko) | 사용자 단말의 위치 측정 방법 및 장치 | |
CN110411435B (zh) | 机器人定位方法、装置以及机器人 | |
CN107580294B (zh) | 一种室内混合定位方法 | |
CN105829832A (zh) | 用于确定物体绕旋转轴线的旋转角度的方法和设备 | |
CN110658542B (zh) | 自动驾驶汽车定位识别方法、装置、设备及存储介质 | |
CN105786546B (zh) | 一种应用程序的卸载方法及装置 | |
CN112674653B (zh) | 障碍物位置标记方法、装置、计算机设备及存储介质 | |
CN112082547A (zh) | 组合导航系统优化方法、装置、电子设备及存储介质 | |
CN113063442B (zh) | 扫地机器人陀螺仪标定方法、装置、计算机设备及存储器 | |
CN112690710B (zh) | 障碍物通过性判断方法、装置、计算机设备及存储介质 | |
CN113063442A (zh) | 扫地机器人陀螺仪标定方法、装置、计算机设备及存储器 | |
CN107091646A (zh) | 导航控制方法、装置及可移动设备 | |
CN113252028B (zh) | 输水隧洞内机器人的定位方法、电子设备及存储介质 | |
CN111994078B (zh) | 应用于自动驾驶的行驶纠偏方法、装置、设备及存储介质 | |
CN113156949A (zh) | 机器人航向角纠偏方法、装置、计算机设备及存储介质 | |
CN113091743A (zh) | 机器人的室内定位方法及装置 | |
US10675762B2 (en) | Systems and methods for using an external sensor and a mobile device to simulate real sensors for a robot | |
CN114518125B (zh) | 加速度计前进里程获取方法及应用 | |
CN114862956B (zh) | 一种适用于隧洞施工的扫描设备移动定位方法及系统 | |
CN116185046B (zh) | 一种移动机器人的定位方法、移动机器人及介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant |