CN110873562A - 机器人导航系统 - Google Patents
机器人导航系统 Download PDFInfo
- Publication number
- CN110873562A CN110873562A CN201810996675.4A CN201810996675A CN110873562A CN 110873562 A CN110873562 A CN 110873562A CN 201810996675 A CN201810996675 A CN 201810996675A CN 110873562 A CN110873562 A CN 110873562A
- Authority
- CN
- China
- Prior art keywords
- information
- angular velocity
- robot
- value
- wheel
- 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.)
- Pending
Links
- 230000003068 static effect Effects 0.000 claims abstract description 15
- 230000001133 acceleration Effects 0.000 claims abstract description 5
- 230000005484 gravity Effects 0.000 claims description 17
- 238000000034 method Methods 0.000 claims description 6
- 238000009987 spinning Methods 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 6
- 230000014509 gene expression Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 238000004140 cleaning Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种机器人导航系统,其包括机器人、状态判断器、导航参考器以及误差补偿滤波器。机器人包括三轴式加速度计、三轴式陀螺仪和具有编码器的轮部,三轴式加速度计侦测机器人的加速度以演算出推进力信息,三轴式陀螺仪侦测机器人角速度并整合成角速度信息,编码器依据轮部的旋转角度演算出第一方向角信息;状态判断器依据推进力信息、角速度信息和第一方向角信息判断机器人为静态状态或动态状态;导航参考器依据推进力信息和角速度信息得出第二方向角信息。当状态判断器判断机器人为动态状态,误差补偿滤波器依据第一方向角信息和第二方向角信息得出误差预估信息,并将误差预估信息回传至编码器以调整第一方向角信息,进而调整机器人的位置和方向角。
Description
技术领域
本发明关于一种导航系统,特别是,一种结合导航参考器和编码器且适用于机器人的机器人导航系统。
背景技术
近来随着传感器的进步和控制技术的成熟,机器人不再局限于在工厂加工处理组件而逐渐从工厂迈进日常生活中,以协助人们处理日常生活中无聊的重复性工作,例如打扫或搬运。另外,由于各种电子零件的成本下降,进而降低机器人的制造成本而开始商品化,越来越受到业界重视。
机器人中相当重要的部分为自主导航,亦即,机器人自己行走而不需使用者控制,而通常其为透过传感器和处理器来辅助机器人行进,然而,机器人在行进时总会伴随摩擦力的产生,摩擦力则会造成传感器的误差,因此,如何精准演算出机器人的路径且考虑到摩擦力产生的误差,遂成为一个重要的议题。
综观前文所述,本发明的发明者思索并设计一种机器人导航系统,以期针对公知技术的缺失加以改善,进而增进产业上的实施利用。
申请内容
有鉴于上述现有的问题,本发明的目的在于提供一种机器人导航系统,用以解决现有技术中所面临的问题。
基于上述目的,本发明提供一种机器人导航系统,其包括机器人、状态判断器、导航参考器以及误差补偿滤波器。机器人包括三轴式加速度计、三轴式陀螺仪以及轮部,轮部包括左轮、右轮以及编码器,三轴式加速度计侦测机器人于各轴的加速度并整合及演算出推进力信息,三轴式陀螺仪侦测机器人于各轴的角速度并整合成角速度信息,编码器依据左轮的旋转角度和右轮的旋转角度演算出第一方向角信息,并计算出左轮的角速度和右轮的角速度以整合成轮部角速度信息;状态判断器连接三轴式加速度计、三轴式陀螺仪以及编码器,以取得推进力信息、角速度信息以及第一方向角信息,并据此判断机器人为静态状态或动态状态;导航参考器连接三轴式加速度计以及三轴式陀螺仪以取得推进力信息以及角速度信息,并据此演算出第二方向角信息;误差补偿滤波器连接导航参考器和编码器,以取得第一方向角信息和第二方向角信息。当状态判断器判断机器人为动态状态,误差补偿滤波器据此演算出误差预估信息,并将误差预估信息回传至编码器,根据误差预估信息加以调整第一方向角信息,进而调整机器人的位置、速度以及方向角,让机器人准确地行进。
优选地,状态判断器包括编码器模块以及惯性模块,编码器模块判断第一方向角信息的轮部编码讯号值,惯性模块比较推进力信息的数值减去重力的数值和推进力临界值以及比较角速度信息的数值和角速度临界值。
优选地,编码器模块判断第一方向角信息的轮部编码讯号值为零,惯性模块判断推进力信息的数值减去重力的数值小于推进力临界值以及角速度信息的数值小于角速度临界值,机器人则为静态状态。
优选地,编码器模块判断第一方向角信息的轮部编码讯号值为零,惯性模块判断推进力信息的数值减去重力的数值大于推进力临界值以及角速度信息的数值大于角速度临界值,机器人则从动态状态恢复至静态状态。
优选地,编码器模块判断第一方向角信息的轮部编码讯号值不等于零,惯性模块判断推进力信息的数值减去重力的数值小于推进力临界值以及角速度信息的数值小于角速度临界值,机器人则为所述静态状态,而左轮和右轮正在自转。
优选地,编码器模块判断第一方向角信息的轮部编码讯号值不等于零,惯性模块判断推进力信息的数值减去重力的数值大于推进力临界值以及角速度信息的数值大于角速度临界值,机器人则为动态状态。
优选地,编码器通过方向推测技术演算出第一方向角信息。
优选地,误差补偿滤波器进一步包含比例积分微分控制组件和模糊规则增益调整组件,比例积分微分控制组件具有比例参数和积分参数以調整误差预估信息的數值。
优选地,誤差补偿滤波器依據第一方向角信息的第一方向角数值和第二方向角信息的第二方向角數值演算出误差预估信息,並回傳误差预估信息至编码器和導航參考器,進而調整第一方向角信息和第二方向角信息。
优选地,比例积分微分控制组件依据模糊规则调整比例参数和积分参数,模糊规则增益调整组件依据左轮的角速度和右轮的角速度来规定模糊规则。
承上所述,本发明的机器人导航系统,可具有下述优点:
(1)本发明的机器人导航系统,通过编码器和导航参考器准确地计算出误差预估信息,据此加以调整轮部的第一方向角信息,进而调整机器人的位置、速度以及方向角,让机器人更为准确地行进。
(2)本发明的机器人导航系统,通过状态判断器判断机器人的状态,得知机器人是否在前进或停止。
附图说明
图1为本发明的第一实施例的整体结构图;
图2为本发明的第一实施例的状态判断器的判断流程图;
图3为本发明的第一实施例的流程图;
图4为本发明的第一实施例的误差补偿滤波器的组件图;
图5为本发明的第一实施例的左轮角速度及右轮角速度和归属度的关系图。
其中的标记为:
10:机器人
11:三轴式加速度计
12:三轴式陀螺仪
13:轮部
20:导航参考器
30:状态判断器
31:编码器模块
32:惯性模块
40:误差补偿滤波器
41:比例积分微分控制组件
42:模糊规则增益调整组件
131:左轮
132:右轮
133:编码器
AF:推进力信息
AR:角速度信息
A1:第一方向角信息
A2:第二方向角信息
ER:误差预估信息
FA:推进力信息的数值
FT:推进力临界值
G:重力
S1、S2、S3、S4:流程
uLl:左轮低速值
uLm:左轮中速值
uLh:左轮高速值
uRl:右轮低速值
uRm:右轮中速值
uRh:右轮高速值
VR:角速度信息的数值
VT:角速度临界值
WAR:轮部角速度信息
yA1:轮部编码讯号值
yH1:第一方向角数值
yH2:第二方向角数值
具体实施方式
本发明的优点、特征以及达到的技术方法将参照例示性实施例及附图进行更详细地描述而更容易理解,且本发明可以不同形式来实现,故不应被理解仅限于此处所陈述的实施例,相反地,对所属技术领域的普通技术人员而言,所提供的实施例将使本揭露更加透彻与全面且完整地传达本发明的保护范围,且本发明将仅替所附加的权利要求书所定义。
如图1所示,其为本发明的机器人导航系统的第一实施例的整体结构图。在本实施例中,本发明的机器人导航系统包括机器人10、状态判断器30、导航参考器20以及误差补偿滤波器40。机器人10包括三轴式加速度计11、三轴式陀螺仪12以及轮部13,轮部13包括左轮131、右轮132以及编码器133,三轴式加速度计11侦测机器人10于各轴的加速度并整合及演算出推进力信息AF,三轴式陀螺仪12侦测机器人10于各轴的角速度并整合成角速度信息AR,编码器133依据左轮131的旋转角度和右轮132的旋转角度并通过方向推测技术,而演算出第一方向角信息A1,并计算出左轮131的角速度uL和右轮132的角速度uR以整合成轮部角速度信息WAR;状态判断器30连接三轴式加速度计11、三轴式陀螺仪12以及编码器133,以取得推进力信息AF、角速度信息AR以及第一方向角信息A1,并包括编码器模块31以及惯性模块32,编码器模块31判断第一方向角信息A1的数值yA1,惯性模块32比较推进力信息AF的数值FA减去重力G的数值和推进力临界值FT以及比较角速度信息AR的数值VR和角速度临界值VT,据此判断机器人10为静态状态或动态状态;导航参考器20连接三轴式加速度计11以及三轴式陀螺仪12以取得推进力信息AF以及角速度信息AR,并据此演算出第二方向角信息A2;误差补偿滤波器40连接导航参考器20和编码器133,以取得第一方向角信息A1和第二方向角信息A2,且连接状态判断器30以得知机器人10为静态状态或动态状态。
需说明的是,第一方向角信息A1包含第一方向角数值yH1,第二方向角信息A2包含第二方向角数值yH2,误差补偿滤波器40乃依据第一方向角数值yH1和第二方向角数值yH2进行演算,以取得误差预估信息ER。
具体而言,三轴式加速度计11、三轴式陀螺仪12以及编码器133分别根据其表达式子演算推进力信息AF、角速度信息AR以及第一方向角信息A1,三轴式加速度计11、三轴式陀螺仪12以及编码器133的表达式子分别如下:
FA=F+G+EA+WA
VR=V+ER+WR
FA为推进力信息AF的数值,F为目前的推进力,G为重力,EA为三轴式加速度计11的误差,WA为三轴式加速度计11的白噪声;VR为角速度信息AR的数值,V为目前三轴式陀螺仪12的角速度,ER为三轴式陀螺仪12的误差,WR为三轴式陀螺仪12的白噪声;yAL为左轮131的编码讯号值,为左轮131的旋转角度,yAR为右轮132的编码讯号值,为右轮132的旋转角度,C为常数,第一方向角信息A1的数值包括轮部编码讯号值yA1,轮部编码讯号值yA1包括yAL和yAR。
请参阅附图2,其为本发明的机器人导航系统的第一实施例的状态判断器的判断流程图。在此,结合附图详细说明状态判断器30的判断流程如下:(1)编码器模块31判断第一方向角信息A1的轮部编码讯号值yA1为零,惯性模块32判断推进力信息AF的数值FA减去重力G的数值小于推进力临界值FT以及角速度信息AR的数值VR小于角速度临界值VT,得知机器人10的左轮131和右轮132为停止状态且未加速前进,据此判断机器人10为静态状态。(2)编码器模块31判断第一方向角信息A1的轮部编码讯号值yA1为零,惯性模块32判断推进力信息AF的数值FA减去重力G的数值大于推进力临界值FT以及角速度信息AR的数值VR大于角速度临界值VT,得知机器人10的左轮131和右轮132为停止状态,但三轴式加速度计11和三轴式陀螺仪12仍在运作,据此判断机器人10从动态状态恢复至静态状态。(3)编码器模块31判断第一方向角信息A1的轮部编码讯号值yA1不等于零,惯性模块32判断推进力信息AF的数值FA减去重力G的数值小于推进力临界值FT以及角速度信息AR的数值VR小于角速度临界值VT,得知机器人10未前进但左轮131和右轮132正在运行,据此判断机器人10则为静态状态,而左轮131和右轮132正在自转。(4)编码器模块31判断第一方向角信息A1的轮部编码讯号值yA1不等于零,惯性模块32判断推进力信息AF的数值FA减去重力G的数值大于推进力临界值FT以及角速度信息AR的数值VR大于角速度临界值VT,得知机器机器人10正在前进或后退,据此判断机器人10为动态状态。
另外,当状态判断器30判断机器人10为静态状态时,因为机器人10并未前进,所以并未有前进误差,开始估计三轴式加速度计11本身的误差以及编码器133因为环境所产生的误差,环境所产生的误差主要来自于左轮131和右轮132与地面的摩擦力所造成的,三轴式加速度计11本身的误差传至导航参考器20,编码器133由于环境所产生的误差会传至编码器133,以准确地演算第一方向角信息A1和第二方向角信息A2。
请参阅附图3,其为本发明的机器人导航系统的第一实施例的流程图。在此,结合附图说明误差补偿滤波器40的运作机制如下:(1)S1:状态判断器30判断机器人10为动态状态,并传至误差补偿滤波器40以让其运作。(2)S2:误差补偿滤波器40接收第一方向角信息A1的第一方向角数值yH1和第二方向角信息A2的第二方向角数值yH2,并依据模糊规则演算出误差预估信息ER。(3)S3:误差补偿滤波器40将误差预估信息ER回传至编码器133和导航参考器20,编码器133根据误差预估信息ER加以调整第一方向角信息A1的第一方向角数值yH1,导航参考器20据此调整而让第二方向角信息A2的第二方向角数值yH2更为准确(4)S4:机器人10则据此调整其位置、速度以及方向角,让机器人10准确地行进。
请参阅附图4,其为本发明的机器人导航系统的第一实施例的误差补偿滤波器的组件图。如图所示,误差补偿滤波器40包含比例积分微分控制组件41以及模糊规则增益调整组件42,模糊规则增益调整组件42则根据左轮131的角速度uL和右轮132的角速度uR来规定模糊规则,比例积分微分控制组件41依据模糊规则调整比例参数Kp、积分参数Ki,比例积分微分控制组件41接受第一方向角信息A1的第一方向角数值yH1以及第二方向角信息A2的第二方向角数值yH2,则根据运算公式演算出误差预估信息ER的数值δ,运算公式如下:
δ=Kp(yH2-yH1)+(Ki(yH2-yH1))/s
此运算公式也考虑到之前的编码器133和导航参考器20产生的误差,因此误差估算会越来越精准,机器人10的移动精准度也随之提高。
请参阅附图5,其为本发明的机器人导航系统的第一实施例的左轮角速度及右轮角速度和归属度的关系图。在此,先搭配附图5将左轮131的角速度uL和右轮132的角速度uR分类为低速区、中速区以及高速区,并具体叙明如下:(1)左轮131的角速度uL处于低速区时为左轮131在低速运动,当左轮131的角速度uL为左轮低速值uLl,归属度为1及其代表左轮131确实处于低速状态;左轮131的角速度uL处于中速区时为左轮131在中速运动,当左轮131的角速度uL为左轮中速值uLm,归属度为1及其代表左轮131确实处于中速状态;左轮131的角速度uL处于高速区时为左轮131在高速运动,当左轮131的角速度uL为左轮高速值uLh,归属度为1及其代表左轮131确实处于高速状态。(2)右轮132的角速度uR处于低速区时为右轮132在低速运动,当右轮132的角速度uR为右轮低速值uRl,归属度为1及其代表右轮132确实处于低速状态;右轮132的角速度uR处于中速区时为右轮132在中速运动,当右轮132的角速度uR为右轮中速值uRm,归属度为1及其代表右轮132确实处于中速状态;右轮132的角速度uL处于高速区时为右轮132在高速运动,当右轮132的角速度uR为右轮高速值uRh,归属度为1及其代表右轮132确实处于高速状态。
续言之,搭配附图5和表1说明左轮131的角速度uL和右轮132的角速度uR所规定的模糊规则如下:(1)当左轮131的角速度uL和右轮132的角速度位于相同速度区间时,亦即左轮131和右轮132皆位于低速区、左轮131和右轮132皆位于中速区或左轮131和右轮132皆位于高速区,机器人10正在直线运动,此时的比例参数Kp设定为Cps和积分参数Ki设定为Cis。(2)当左轮131的角速度uL和右轮132的角速度uR相差不大时,亦即左轮131位于低速区和右轮132位于中速区、左轮131位于中速区和右轮132位于低速区、左轮131位于高速区和右轮132位于中速区或左轮131位于中速区和右轮132位于高速区,机器人10正在例如小转弯之低速旋转运动,此时的比例参数Kp设定为Cpl和积分参数Ki设定为Cil。(3)当左轮131的角速度uL和右轮132的角速度uR相差甚巨时,亦即左轮131位于高速区和右轮132位于低速区或左轮131位于低速区和右轮132位于高速区,机器人10正在例如大转弯的高速旋转运动,此时的比例参数Kp设定为Cph和积分参数Ki设定为Cih。
表1
左轮位于低速区 | 左轮位于中速区 | 左轮位于高速区 | |
右轮位于低速区 | 直线运动 | 低速旋转运动 | 高速旋转运动 |
右轮位于中速区 | 低速旋转运动 | 直线运动 | 低速旋转运动 |
右轮位于高速区 | 高速旋转运动 | 低速旋转运动 | 直线运动 |
其中,Cps、Cis、Cpl、Cil、Cph和Cih皆为常数且各个相异,其大小顺序如下:Cph>Cpl>>Cps,Cih>Cil>>Cis。Cps、Cis、Cpl、Cil、Cph和Cih的数值大小为根据机器人10的实际运作状况而定,而未加以限制其实际数值大小。
再者,可将本发明应用于扫地机器人或其他智能机器人。举例来说,应用本发明于自主导航机器人上,通过三轴式加速度计11和三轴式陀螺仪12设置,测量自主导航机器人于三轴的加速度和角速度,得出自主导航机器人的推进力信息AF和角速度信息AR并传至导航参考器20,进而取得第二方向角信息A2,误差补偿滤波器40比较第二方向角信息A2和编码器133演算出的第一方向角信息A1而取得误差预估信息ER,误差预估信息ER回传至导航参考器20和自主导航机器人,而加以调整自主导航机器人的行进方向和速度,导航参考器20据此演算出更为精准的第二方向角信息A2,自主导航机器人的行进更为精准。
综上所述,本发明的机器人导航系统,利用三轴式加速度计11、三轴式陀螺仪12和导航参考器20取得第二方向角信息A2,再搭配编码器133演算出的第一方向角信息A1,误差补偿滤波器40比较第二方向角信息A2和第一方向角信息A1而演算出误差预估信息ER,并将误差预估信息ER回传至导航参考器20和机器人10,进而让机器人10的行进更为精准,而不会脱离正常轨迹。本发明的机器人导航系统,利用导航参考器20和编码器133的搭配,让机器人10能顺利地运行前进。
以上所述仅为举例性,而非为限制性者。任何未脱离本发明之精神与范围,而对其进行的等效修改或改动,均应包含于所附的权利要求书。
Claims (10)
1.一种机器人导航系统,其特征在于,包括:
机器人,包括三轴式加速度计、三轴式陀螺仪以及轮部,所述轮部包括左轮、右轮以及编码器,所述三轴式加速度计侦测所述机器人于各轴的加速度并整合及演算出推进力信息,所述三轴式陀螺仪侦测所述机器人于各轴的角速度并整合成角速度信息,所述编码器依据所述左轮的旋转角度和所述右轮的旋转角度演算出第一方向角信息,并计算出所述左轮的角速度和所述右轮的角速度以整合成轮部角速度信息;
状态判断器,连接所述三轴式加速度计、所述三轴式陀螺仪以及所述编码器,以取得所述推进力信息、所述角速度信息以及所述第一方向角信息,并据此判断所述机器人为静态状态或动态状态;
导航参考器,连接所述三轴式加速度计以及所述三轴式陀螺仪以取得所述推进力信息以及所述角速度信息,并据此演算出第二方向角信息;以及
误差补偿滤波器,连接所述导航参考器和所述编码器,以取得所述第一方向角信息和所述第二方向角信息;
其中,当所述状态判断器判断所述机器人为所述动态状态,所述误差补偿滤波器据此演算出误差预估信息,并将所述误差预估信息回传至所述编码器,根据所述误差预估信息加以调整所述第一方向角信息,进而调整所述机器人的位置、速度以及方向角。
2.根据权利要求1所述的机器人导航系统,其特征在于,所述状态判断器包括编码器模块以及惯性模块,所述编码器模块判断所述第一方向角信息的轮部编码讯号值,所述惯性模块比较所述推进力信息的数值减去重力的数值和推进力临界值以及比较所述角速度信息的数值和角速度临界值。
3.根据权利要求2所述的机器人导航系统,其特征在于,所述编码器模块判断所述第一方向角信息的轮部编码讯号值为零,所述惯性模块判断所述推进力信息的数值减去重力的数值小于所述推进力临界值以及所述角速度信息的数值小于所述角速度临界值,所述机器人则为所述静态状态。
4.根据权利要求2所述的机器人导航系统,其特征在于,所述编码器模块判断所述第一方向角信息的所述轮部编码讯号值为零,所述惯性模块判断所述推进力信息的数值减去重力的数值大于所述推进力临界值以及所述角速度信息的数值大于所述角速度临界值,所述机器人则从所述动态状态恢复至所述静态状态。
5.根据权利要求2所述的机器人导航系统,其特征在于,所述编码器模块判断所述第一方向角信息的所述轮部编码讯号值不等于零,所述惯性模块判断所述推进力信息的数值减去重力的数值小于所述推进力临界值以及所述角速度信息的数值小于所述角速度临界值,所述机器人则为所述静态状态,而所述左轮和所述右轮正在自转。
6.根据权利要求2所述的机器人导航系统,其特征在于,所述编码器模块判断所述第一方向角信息的所述轮部编码讯号值不等于零,所述惯性模块判断所述推进力信息的数值减去重力的数值大于所述推进力临界值以及所述角速度信息的数值大于所述角速度临界值,所述机器人则为所述动态状态。
7.根据权利要求1所述的机器人导航系统,其特征在于,所述编码器通过方向推测技术演算出所述第一方向角信息。
8.根据权利要求1所述的机器人导航系统,其特征在于,所述误差补偿滤波器进一步包含比例积分微分控制组件和模糊规则增益调整组件,所述比例积分微分控制组件具有比例参数和积分参数以调整所述误差预估信息的数值。
9.根据权利要求8所述的机器人导航系统,其特征在于,所述误差补偿滤波器依据所述第一方向角信息的第一方向角数值和所述第二方向角信息的第二方向角数值演算出所述误差预估信息,并回传所述误差预估信息至所述编码器和所述导航参考器,进而调整所述第一方向角信息和所述第二方向角信息。
10.根据权利要求8所述的机器人导航系统,其特征在于,所述比例积分微分控制组件依据模糊规则调整所述比例参数和所述积分参数,所述模糊规则增益调整组件依据所述左轮的角速度和所述右轮的角速度来规定模糊规则。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810996675.4A CN110873562A (zh) | 2018-08-29 | 2018-08-29 | 机器人导航系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810996675.4A CN110873562A (zh) | 2018-08-29 | 2018-08-29 | 机器人导航系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110873562A true CN110873562A (zh) | 2020-03-10 |
Family
ID=69714621
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810996675.4A Pending CN110873562A (zh) | 2018-08-29 | 2018-08-29 | 机器人导航系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110873562A (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103206965A (zh) * | 2012-01-13 | 2013-07-17 | 株式会社电装 | 车辆用陀螺仪的角速度误差修正装置、修正方法 |
CN105607093A (zh) * | 2015-12-20 | 2016-05-25 | 上海华测导航技术股份有限公司 | 一种组合导航系统及获取导航坐标的方法 |
US20160331557A1 (en) * | 2015-05-11 | 2016-11-17 | The Hong Kong Polytechnic University | Exoskeleton Ankle Robot |
CN106681330A (zh) * | 2017-01-25 | 2017-05-17 | 北京航空航天大学 | 基于多传感器数据融合的机器人导航方法及装置 |
CN107024210A (zh) * | 2017-03-09 | 2017-08-08 | 深圳市朗空亿科科技有限公司 | 一种室内机器人避障方法、装置及导航系统 |
CN107063305A (zh) * | 2017-04-10 | 2017-08-18 | 江苏东方金钰智能机器人有限公司 | 用惯导、压力传感器修正下坡悬空后轮里程计误差的方法 |
-
2018
- 2018-08-29 CN CN201810996675.4A patent/CN110873562A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103206965A (zh) * | 2012-01-13 | 2013-07-17 | 株式会社电装 | 车辆用陀螺仪的角速度误差修正装置、修正方法 |
US20160331557A1 (en) * | 2015-05-11 | 2016-11-17 | The Hong Kong Polytechnic University | Exoskeleton Ankle Robot |
CN105607093A (zh) * | 2015-12-20 | 2016-05-25 | 上海华测导航技术股份有限公司 | 一种组合导航系统及获取导航坐标的方法 |
CN106681330A (zh) * | 2017-01-25 | 2017-05-17 | 北京航空航天大学 | 基于多传感器数据融合的机器人导航方法及装置 |
CN107024210A (zh) * | 2017-03-09 | 2017-08-08 | 深圳市朗空亿科科技有限公司 | 一种室内机器人避障方法、装置及导航系统 |
CN107063305A (zh) * | 2017-04-10 | 2017-08-18 | 江苏东方金钰智能机器人有限公司 | 用惯导、压力传感器修正下坡悬空后轮里程计误差的方法 |
Non-Patent Citations (3)
Title |
---|
AHMAD KAMALNASIR等: "Pose Estimation By Multisensor Data Fusion Of Wheel Encoders, Gyroscope, Accelerometer And Electronic Compass", 《IFAC PROCEEDINGS VOLUMES》 * |
李运国: "基于FPGA的两轮机器人运动控制系统设计", 《中国优秀硕士学位论文全文数据库》 * |
邓超 等: "基于模糊控制的位置精度补偿方法", 《计算机集成制造系统》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106843214B (zh) | 一种基于自抗扰控制的磁带导引agv循迹控制方法 | |
Cho et al. | A dead reckoning localization system for mobile robots using inertial sensors and wheel revolution encoding | |
Low et al. | GPS-based path following control for a car-like wheeled mobile robot with skidding and slipping | |
US8000925B2 (en) | Moving body with tilt angle estimating mechanism | |
Low et al. | GPS-based tracking control for a car-like wheeled mobile robot with skidding and slipping | |
JP4170284B2 (ja) | 移動物体の進行方向の推定方法およびシステム | |
CN110286672A (zh) | 机器人及其导航控制方法、导航控制装置以及存储介质 | |
CN107063305B (zh) | 用惯导、压力传感器修正下坡悬空后轮里程计误差的方法 | |
CN107065873B (zh) | 一种基于磁带导引agv的多曲率圆周路径循迹控制方法 | |
Lee et al. | Robust multirate on-road vehicle localization for autonomous highway driving vehicles | |
KR20210084526A (ko) | 로봇 운동시 카펫으로 인한 드리프트 제어방법, 칩 및 청소 로봇 | |
CN108827339B (zh) | 一种基于惯性辅助的高效视觉里程计 | |
Wang et al. | Multi-sensor data fusion for land vehicle attitude estimation using a fuzzy expert system | |
CN108037658A (zh) | 一种基于导航系统的机器人运行误差的纠偏方法 | |
CN110873562A (zh) | 机器人导航系统 | |
Yu et al. | An improved autonomous inertial-based integrated navigation scheme based on vehicle motion recognition | |
CN115060260A (zh) | 一种基于anfis-eskf的地面移动机器人多传感器融合定位方法 | |
CN111679681B (zh) | 一种基于滑模鲁棒控制的水下机器人运动路径跟踪方法 | |
CN113273927A (zh) | 一种基于多传感器融合的差动轮式机器人及沿墙导航方法 | |
Low et al. | Maneuverability and path following control of wheeled mobile robot in the presence of wheel skidding and slipping | |
CN111735478B (zh) | 基于lstm的行人实时导航零速检测方法 | |
Yu et al. | Dead reckoning of mobile robot in complex terrain based on proprioceptive sensors | |
Hwang et al. | Vision tracking system for mobile robots using two Kalman filters and a slip detector | |
CN107990893A (zh) | 二维激光雷达slam中探测环境发生突变的检测方法 | |
CN114355920B (zh) | 行进方向的控制方法、装置、智能设备及存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20200310 |
|
WD01 | Invention patent application deemed withdrawn after publication |