CN103412487B - 一种基于模糊滑模控制器的球形机器人坡面运动控制方法 - Google Patents
一种基于模糊滑模控制器的球形机器人坡面运动控制方法 Download PDFInfo
- Publication number
- CN103412487B CN103412487B CN201310322138.9A CN201310322138A CN103412487B CN 103412487 B CN103412487 B CN 103412487B CN 201310322138 A CN201310322138 A CN 201310322138A CN 103412487 B CN103412487 B CN 103412487B
- Authority
- CN
- China
- Prior art keywords
- robot
- ball shape
- sliding
- fuzzy
- shape 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
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明提供一种基于模糊滑模控制器的球形机器人坡面运动控制方法,包括步骤:(1)通过惯性测量装置测得球形机器人在坡面的姿态与重摆的状态信息;通过里程计和编码器测得机器人在坡面的位置与速度信息;通过无线传输,机器人得到上位机发送来的运动目标位置信息;(2)所得信息通过串口传输给中央处理芯片;(3)所述中央处理芯片根据所得信息,通过模糊滑模控制器计算出球形机器人当前状态下所需的驱动力矩并实时控制机器人的运动。本发明的优点在于:(1)模糊控制降低了控制对于***建模准确性的要求;(2)所用模糊滑模控制器提高了控制的鲁棒性;(3)模糊控制的引入,大大加快了***的收敛速度,改善了现有模糊控制器调节精度不足的问题。
Description
技术领域
本发明属于移动机器人运动控制领域,特别涉及一种基于模糊滑模控制器的球形机器人坡面运动控制方法。
背景技术
球形机器人作为一种特殊类型的移动机器人,较之于传统的轮式、履带式机器人有着诸如不倒、零半径转弯、保护内部结构等诸多优点,但是球形的外壳同样也带来了球形机器人爬坡与越障运动困难的问题。作为移动机器人的一种,爬坡能力是其实际应用的重要指标,爬坡能力不足,爬坡控制困难也大大限制了球形机器人在实际生产生活中的应用。球形机器人的爬坡运动作为重要运动方式之一,也引起了国内外众多学者的广泛关注。Bicchi等对其设计的球形机器人进行了***的分析,建立了该机器人直线运动的动力学模型,并在该模型状态空间形式的基础上,提出了路径规划方法,但并未给出坡面运动的控制方法。北京航空航天大学的战强等人针对BHQ-1G做了球形机器人爬坡能力的分析,但并没有建立相关的动力学模型与控制方法。哈尔滨工业大学的岳明等人对其设计的球形机器人做了爬坡能力分析,建立了动力学模型,并建立了其在爬坡状态下的最优控制器取得了较好的控制效果。但在***建模时对于***状态变量的耦合做了近似线性化的处理,使得非平衡摆角附近的控制性能下降,同时在最优控制器的设计中没有考虑非平衡点附近参数摄动和外界环境变化带来的影响,使得***的抗干扰能力不足。本发明采用模糊滑模控制器的方法,实现了对球形机器人在坡面运动的控制,具有很好的抗干扰能力。
发明内容
本发明旨在提供一种基于模糊滑模控制器的球形机器人坡面运动控制方法,以解决现有球形机器人坡面运动控制方法对建模准确性依赖大、抗干扰能力差等问题。
本发明目的在于克服上述现有技术存在的缺点与不足,提供一种基于模糊滑模控制器的球形机器人坡面运动控制方法。为达上述目的,本发明采用采用如下技术方案:
1.一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,包括以下步骤:
S1、通过惯性测量装置测得的球形机器人在坡面的姿态信息,得到当前球形机器人重摆的状态信息,所述重摆的状态信息包括重摆的摆角参数,重摆的摆角速度参数;通过里程计和光电编码器测得球形机器人在坡面的位置与速度信息,所述球形机器人在坡面的位置与速度信息包括球形机器人运动速度参数,球形机器人运动距离参数;通过无线串口传输,球形机器人得到上位机发送来的球形机器人坡面运动的目标停止位置信息;
S2、所述球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息以及球形机器人坡面运动的目标停止位置信息通过串口传输给中央处理芯片;
S3、所述中央处理芯片根据球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息以及球形机器人坡面运动的目标停止位置信息,通过模糊滑模控制器计算出球形机器人当前状态下所需的驱动力矩;
S4、利用计算得到的所需驱动力矩驱动球形机器人完成在坡面的运动。
2.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S1包括:根据陀螺仪测角原理,得到球形机器人在前进方向的姿态参数,得到驱动重摆的实时摆角及摆角速度;根据光电编码器测速原理,测得电机实时转速,通过与摆角速度求和得到球形机器人当前的运动速度;根据里程计的测位移原理,测得球形机器人的运动位移。
3.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S2包括:实时采集球形机器人坡面运动控制所需控制的几个状态变量的实时数值,将采集得到的状态变量数据,即球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息通过串口传输给中央处理芯片;实时接收球形机器人坡面运动位置控制目标,将所要求的坡面停止位置目标通过串口传输给中央处理芯片。
4.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S3包括以下步骤:
S31、对球形机器人坡面运动控制所需控制的两个状态量及其目标值,分别设置一级滑模面;
S32、将两级滑模面组合为一级滑模面,对变量做降维处理,同时制定各模糊控制器的规则表与隶属度函数,通过模糊控制器计算当前所需电机控制力矩。
5.根据权利要求4所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S31包括:根据球形机器人实际应用中对于运动到坡面任意位置停止的控制目标,在此对***的两组状态变量分别选取滑模面:
S1=λ1e1+e2,S2=e4
式中分别对应球形机器人期望滚动角与实际滚动角的误差,期望滚动角速度与实际滚动角速度的误差,重摆期望摆动角速度与实际角速度的误差,θd为球形机器人期望滚动角。λ1对应切换面1的斜率,为了满足可达性条件,取λ1为正实数。
6.根据权利要求4所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S32包括:为了达到为模糊控制输入降维的作用,在此将两级滑模面合成一级总滑模面:
S=S1+λ2S2
式中λ2为总滑模面中滑模面二的权系数,为了满足可达性条件,λ2取为实数。
取总滑模函数S的输入论域为[-m,m],滑模函数的导数的输入论域为[-n,n],输出力矩u的输出论域为[-m,m],其中于是可以得出如下表1所示模糊规则表:
表一:模糊控制规则表
7.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S4包括:利用步骤S3计算得到的电机所需驱动力矩,通过电机驱动器的力矩控制模式,以计算得到的电机所需驱动力矩驱动电机运动。
本发明相对于现有技术具有如下的优点及技术效果:
1、将模糊控制运用于球形机器人坡面运动控制中,降低了控制对于***建模准确性的要求;
2、通过采用模糊滑模控制器对球形机器人的坡面运动进行控制,结合了模糊控制与滑模变结构控制的优点,提高了控制的鲁棒性,大大增强了***的抗干扰能力;
3、模糊控制的引入,大大加快了***的收敛速度,所控制状态变量能够更快趋于目标值,降低了调节时间,同时本模糊滑模控制器的设计也改善了现有模糊控制器调节精度不足的问题,使得控制更加准确。
附图说明
图1为实施过程中的球形机器人坡面运动姿态简图;
图2为本发明模糊滑模控制器流程图;
图3a、图3b分别为本发明模糊滑模控制器控制球形机器人坡面运动时机器人滚过角度与重摆摆角实验曲线图。
具体实施方式
下面结合实施例及附图对本发明作进一步详细描述,但本发明的实施方式不限于此实施例。
如图1到图3所示,本发明包括下列步骤:
S1、通过惯性测量装置测得的球形机器人在坡面的姿态信息,得到当前球形机器人重摆的状态信息,所述重摆的状态信息包括重摆的摆角参数,重摆的摆角速度参数;通过里程计和光电编码器测得球形机器人在坡面的位置与速度信息,所述球形机器人在坡面的位置与速度信息包括球形机器人运动速度参数,球形机器人运动距离参数;通过无线串口传输,球形机器人得到上位机发送来的球形机器人坡面运动的目标停止位置信息;
S2、所述球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息以及球形机器人坡面运动的目标停止位置信息通过串口传输给中央处理芯片;
S3、所述中央处理芯片根据球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息以及球形机器人坡面运动的目标停止位置信息,通过模糊滑模控制器计算出球形机器人当前状态下所需的驱动力矩;
S4、利用计算得到的所需驱动力矩驱动球形机器人完成在坡面的运动。
所述步骤S1包括:根据陀螺仪测角原理,得到球形机器人在前进方向的姿态参数,得到驱动重摆的实时摆角及摆角速度;根据光电编码器测速原理,测得电机实时转速,通过与摆角速度求和得到球形机器人当前的运动速度;根据里程计的测位移原理,测得球形机器人的运动位移。
所述步骤S2包括:实时采集球形机器人坡面运动控制所需控制的几个状态变量的实时数值,将采集得到的状态变量数据,即球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息通过串口传输给中央处理芯片;实时接收球形机器人坡面运动位置控制目标,将所要求的坡面停止位置目标通过串口传输给中央处理芯片。
所述步骤S3包括以下步骤:
S31、对球形机器人坡面运动控制所需控制的两个状态量及其目标值,分别设置一级滑模面;
S32、将两级滑模面组合为一级滑模面,对变量做降维处理,同时制定各模糊控制器的规则表与隶属度函数,通过模糊控制器计算当前所需电机控制力矩。
所述步骤S31包括:根据球形机器人实际应用中对于运动到坡面任意位置停止的控制目标,在此对***的两组状态变量分别选取滑模面:
S1=λ1e1+e2,S2=e4
式中分别对应球形机器人期望滚动角与实际滚动角的误差,期望滚动角速度与实际滚动角速度的误差,重摆期望摆动角速度与实际角速度的误差,θd为球形机器人期望滚动角。λ1对应切换面1的斜率,为了满足可达性条件,取λ1为正实数。
所述步骤S32包括:为了达到为模糊控制输入降维的作用,在此将两级滑模面合成一级总滑模面:
S=S1+λ2S2
式中λ2为总滑模面中滑模面二的权系数,为了满足可达性条件,λ2取为实数。
取总滑模函数S的输入论域为[-m,m],滑模函数的导数的输入论域为[-n,n],输出力矩u的输出论域为[-m,m],其中于是可以得出如下表1所示模糊规则表:
表一:模糊控制规则表
所述步骤S4包括:利用步骤S3计算得到的电机所需驱动力矩,通过电机驱动器的力矩控制模式,以计算得到的电机所需驱动力矩驱动电机运动。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何依照本发明所做的参数修改、替代、组合、简化,均可以等效为置换方式,都包含在本发明的保护范围之内。
Claims (7)
1.一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,包括以下步骤:
S1、通过惯性测量装置测得的球形机器人在坡面的姿态信息,得到当前球形机器人重摆的状态信息,所述重摆的状态信息包括重摆的摆角参数,重摆的摆角速度参数;通过里程计和光电编码器测得球形机器人在坡面的位置与速度信息,所述球形机器人在坡面的位置与速度信息包括球形机器人运动速度参数,球形机器人运动距离参数;通过无线串口传输,球形机器人得到上位机发来的球形机器人坡面运动的目标停止位置信息;
S2、所述球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息以及球形机器人坡面运动的目标停止位置信息通过串口传输给中央处理芯片;
S3、所述中央处理芯片根据球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息以及球形机器人坡面运动的目标停止位置信息,通过模糊滑模控制器计算出球形机器人当前状态下所需的驱动力矩;
S4、利用计算得到的所需驱动力矩驱动球形机器人完成在坡面的运动。
2.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S1包括:根据陀螺仪测角原理,得到球形机器人在前进方向的姿态参数,得到驱动重摆的实时摆角及摆角速度;根据光电编码器测速原理,测得电机实时转速,通过与摆角速度求和得到球形机器人当前的运动速度;根据里程计的测位移原理,测得球形机器人的运动位移。
3.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S2包括:实时采集球形机器人坡面运动控制所需控制的几个状态变量的实时数值,将采集得到的状态变量数据,即球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息通过串口传输给中央处理芯片;实时接收球形机器人坡面运动位置控制目标,将所要求的目标停止位置信息通过串口传输给中央处理芯片。
4.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S3包括以下步骤:
S31、对球形机器人在坡面运动控制所需控制的球形机器人重摆的状态信息与球形机器人在坡面的位置速度信息及其目标值,分别设置分别设置为一级滑模面S1和一级滑模面S2;
S32、将两级滑模面组合为一级滑模面将这两个一级滑模面组合为二级总滑模面S,对变量做降维处理,同时制定各模糊控制器的规则表与隶属度函数,通过模糊控制器计算当前所需电机控制力矩。
5.根据权利要求4述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S31包括:根据球形机器人实际应用中对于运动到坡面任意位置停止的控制目标,在此对***的球形机器人重摆的状态信息与球形机器人在坡面的位置速度信息分别取滑模面:
S1=λ1e1+e2,S2=e4
式中的e1=θd-θ,分别对应球形机器人期望滚动角与实际滚动角的误差,期望滚动角速度与实际滚动角速度的误差,重摆期望摆动角速度与实际角速度的误差,θd为球形机器人期望滚动角,λ1为对应滑模面一的斜率,为了满足可达性条件,取λ1为正实数。
6.根据权利要求4述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S32包括:为了达到为模糊控制输入降维的作用,在此将两级滑模面合成一级总滑模面将两个一级滑模面合成一个二级总滑模面S:
S=S1+λ2S2
式中λ2为滑模面中滑模面二的权系数,为了满足可达性条件,λ2取为实数,取总滑模函数S的输入论域为[-m,m],滑模函数的导数的输入论域为[-n,n],输出力矩u的输出论域为[-m,m],其中于是可以得出如下表1所示的模糊控制规则表:
表1:模糊控制规则表。
7.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S4包括:利用步骤S3计算得到的电机所需驱动力矩,通过电机驱动器的力矩控制模式,以计算得到的电机所需驱动力矩驱动电机运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310322138.9A CN103412487B (zh) | 2013-07-29 | 2013-07-29 | 一种基于模糊滑模控制器的球形机器人坡面运动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310322138.9A CN103412487B (zh) | 2013-07-29 | 2013-07-29 | 一种基于模糊滑模控制器的球形机器人坡面运动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103412487A CN103412487A (zh) | 2013-11-27 |
CN103412487B true CN103412487B (zh) | 2016-12-07 |
Family
ID=49605512
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310322138.9A Active CN103412487B (zh) | 2013-07-29 | 2013-07-29 | 一种基于模糊滑模控制器的球形机器人坡面运动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103412487B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104898665A (zh) * | 2015-04-16 | 2015-09-09 | 山东建筑大学 | 巡检机器人轨迹规划的方法和装置 |
CN107884057A (zh) * | 2017-11-22 | 2018-04-06 | 苏州市计量测试研究所 | 用于电子吊秤检测装置的砝码自动加载控制装置 |
CN110109353B (zh) * | 2019-04-17 | 2022-01-11 | 杭州电子科技大学 | 一种反作用轮平衡自行车机器人模糊自适应滑模控制*** |
CN110377032B (zh) * | 2019-07-08 | 2022-05-27 | 佳木斯市奥义智能科技有限公司 | 语义地图下机器人坡地运动控制方法及装置、存储介质 |
CN110968913B (zh) * | 2019-11-19 | 2023-09-05 | 贵州电网有限责任公司 | 一种提升双轮驱动球形机器人爬坡能力的方法 |
CN111637900B (zh) * | 2020-05-29 | 2021-10-15 | 逻腾(杭州)科技有限公司 | 一种滚动机器人里程计算装置及方法 |
CN114789439B (zh) * | 2021-01-26 | 2024-03-19 | 深圳市普渡科技有限公司 | 斜坡定位校正方法、装置、机器人及可读存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1397411A (zh) * | 2002-08-22 | 2003-02-19 | 北京邮电大学 | 改进的球形机器人全方位行走装置 |
WO2006049559A1 (en) * | 2004-11-02 | 2006-05-11 | Viktor Kaznov | Ball robot |
CN102179812A (zh) * | 2011-04-01 | 2011-09-14 | 北京邮电大学 | 一种可运用于探测的球形机器人 |
CN102393745A (zh) * | 2011-11-29 | 2012-03-28 | 北京邮电大学 | 一种适用于球形机器人阵列式接触传感器***设计 |
CN102880051A (zh) * | 2012-09-24 | 2013-01-16 | 上海大学 | 轮式移动机器人的模糊滑模驱动控制方法 |
JP2013084221A (ja) * | 2011-10-12 | 2013-05-09 | Tottori Univ | 直線検出装置、直線検出方法、直線検出プログラム及び撮影システム |
CN103135549A (zh) * | 2012-12-21 | 2013-06-05 | 北京邮电大学 | 一种具有视觉反馈的球形机器人运动控制***及运动控制方法 |
-
2013
- 2013-07-29 CN CN201310322138.9A patent/CN103412487B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1397411A (zh) * | 2002-08-22 | 2003-02-19 | 北京邮电大学 | 改进的球形机器人全方位行走装置 |
WO2006049559A1 (en) * | 2004-11-02 | 2006-05-11 | Viktor Kaznov | Ball robot |
CN102179812A (zh) * | 2011-04-01 | 2011-09-14 | 北京邮电大学 | 一种可运用于探测的球形机器人 |
JP2013084221A (ja) * | 2011-10-12 | 2013-05-09 | Tottori Univ | 直線検出装置、直線検出方法、直線検出プログラム及び撮影システム |
CN102393745A (zh) * | 2011-11-29 | 2012-03-28 | 北京邮电大学 | 一种适用于球形机器人阵列式接触传感器***设计 |
CN102880051A (zh) * | 2012-09-24 | 2013-01-16 | 上海大学 | 轮式移动机器人的模糊滑模驱动控制方法 |
CN103135549A (zh) * | 2012-12-21 | 2013-06-05 | 北京邮电大学 | 一种具有视觉反馈的球形机器人运动控制***及运动控制方法 |
Non-Patent Citations (2)
Title |
---|
Path Following Control of a Spherical robot rolling on an inclined plane;Tao Yu等;《Sensors and Transducers》;20130530;第21卷;第42-47页 * |
一种具有爬坡能力的球形机器人运动分析;孙治伟等;《机器人》;20120331;第34卷(第2期);第152-158页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103412487A (zh) | 2013-11-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103412487B (zh) | 一种基于模糊滑模控制器的球形机器人坡面运动控制方法 | |
CN107168369B (zh) | 一种欠驱动无人车的编队控制方法及*** | |
CN109885052A (zh) | 基于全向移动机器人运动学建模的误差模型预测控制方法 | |
CN108527372B (zh) | 一种变刚度串联弹性驱动器的机器人关节自适应控制方法 | |
CN103034123B (zh) | 基于动力学模型参数辨识的并联机器人控制方法 | |
CN104698848B (zh) | 一种下肢外骨骼康复机器人康复训练的控制方法 | |
CN107092266B (zh) | 一种移动车轨迹跟踪控制方法 | |
CN103878791B (zh) | 工业机器人无外部传感器的外力检测方法 | |
CN109848983A (zh) | 一种高顺应性人引导机器人协同作业的方法 | |
CN104881030B (zh) | 基于快速终端滑模原理的无人车侧纵向耦合跟踪控制方法 | |
CN102385342B (zh) | 虚拟轴机床并联机构运动控制的自适应动态滑模控制方法 | |
CN102736626B (zh) | 基于视觉的移动小车位姿镇定控制方法 | |
CN103121451A (zh) | 一种弯路换道轨迹的跟踪控制方法 | |
CN103279039A (zh) | 一种机器人神经网络式计算力矩控制器训练平台及训练方法 | |
CN109606363A (zh) | 一种多状态反馈的智能汽车可拓车道保持控制方法 | |
CN104375504B (zh) | 一种陪跑机器人及其跟踪控制策略与运动控制方法 | |
CN103780188A (zh) | 基于动态摩擦补偿的永磁球形电机转子自适应控制*** | |
CN103984237A (zh) | 基于运动状态综合识别的轴对称飞行器三通道自适应控制***设计方法 | |
Peng et al. | Dynamic model and balancing control for two-wheeled self-balancing mobile robot on the slopes | |
CN104898665A (zh) | 巡检机器人轨迹规划的方法和装置 | |
CN105929849A (zh) | 一种基于点镇定的轮式移动机器人目标跟踪控制方法 | |
CN106371442A (zh) | 一种基于张量积模型变换的移动机器人控制方法 | |
CN102880051A (zh) | 轮式移动机器人的模糊滑模驱动控制方法 | |
CN106272436A (zh) | 一种基于变负载的服务机器人自适应控制方法 | |
CN108062024A (zh) | 一种考虑阻力的移动机器人反演滑模控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |