CN103412487A - 一种基于模糊滑模控制器的球形机器人坡面运动控制方法 - Google Patents
一种基于模糊滑模控制器的球形机器人坡面运动控制方法 Download PDFInfo
- Publication number
- CN103412487A CN103412487A CN2013103221389A CN201310322138A CN103412487A CN 103412487 A CN103412487 A CN 103412487A CN 2013103221389 A CN2013103221389 A CN 2013103221389A CN 201310322138 A CN201310322138 A CN 201310322138A CN 103412487 A CN103412487 A CN 103412487A
- Authority
- CN
- China
- Prior art keywords
- ball shape
- shape robot
- domatic
- fuzzy
- 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.)
- Granted
Links
Images
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取为实数。
表一:模糊控制规则表
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取为实数。
表一:模糊控制规则表
所述步骤S4包括:利用步骤S3计算得到的电机所需驱动力矩,通过电机驱动器的力矩控制模式,以计算得到的电机所需驱动力矩驱动电机运动。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何依照本发明所做的参数修改、替代、组合、简化,均可以等效为置换方式,都包含在本发明的保护范围之内。
Claims (7)
1.一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,包括以下步骤:
S1、通过惯性测量装置测得的球形机器人在坡面的姿态信息,得到当前球形机器人重摆的状态信息,所述重摆的状态信息包括重摆的摆角参数,重摆的摆角速度参数;通过里程计和光电编码器测得球形机器人在坡面的位置与速度信息,所述球形机器人在坡面的位置与速度信息包括球形机器人运动速度参数,球形机器人运动距离参数;通过无线串口传输,球形机器人得到上位机发送来的球形机器人坡面运动的目标停止位置信息;
S2、所述球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息以及球形机器人坡面运动的目标停止位置信息通过串口传输给中央处理芯片;
S3、所述中央处理芯片根据球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息以及球形机器人坡面运动的目标停止位置信息,通过模糊滑模控制器计算出球形机器人当前状态下所需的驱动力矩;
S4、利用计算得到的所需驱动力矩驱动球形机器人完成在坡面的运动。
2.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S1包括:根据陀螺仪测角原理,得到球形机器人在前进方向的姿态参数,得到驱动重摆的实时摆角及摆角速度;根据光电编码器测速原理,测得电机实时转速,通过与摆角速度求和得到球形机器人当前的运动速度;根据里程计的测位移原理,测得球形机器人的运动位移。
3.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S2包括:实时采集球形机器人坡面运动控制所需控制的几个状态变量的实时数值,将采集得到的状态变量数据,即球形机器人重摆的状态信息与球形机器人在坡面的位置与速度信息通过串口传输给中央处理芯片;实时接收球形机器人坡面运动位置控制目标,将所要求的坡面停止位置目标通过串口传输给中央处理芯片。
4.根据权利要求1所述的一种基于模糊滑模控制器的球形机器人坡面运动控制方法,其特征在于,所述步骤S3包括以下步骤:
S31、对球形机器人坡面运动控制所需控制的两个状态量及其目标值,分别设置一级滑模面;
S32、将两级滑模面组合为一级滑模面,对变量做降维处理,同时制定各模糊控制器的规则表与隶属度函数,通过模糊控制器计算当前所需电机控制力矩。
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 true CN103412487A (zh) | 2013-11-27 |
CN103412487B 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) |
Cited By (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 | 苏州市计量测试研究所 | 用于电子吊秤检测装置的砝码自动加载控制装置 |
CN110109353A (zh) * | 2019-04-17 | 2019-08-09 | 杭州电子科技大学 | 一种反作用轮平衡自行车机器人模糊自适应滑模控制系统 |
CN110377032A (zh) * | 2019-07-08 | 2019-10-25 | 希格斯动力科技(珠海)有限公司 | 语义地图下机器人坡地运动控制方法及装置、存储介质 |
CN110968913A (zh) * | 2019-11-19 | 2020-04-07 | 贵州电网有限责任公司 | 一种提升双轮驱动球形机器人爬坡能力的方法 |
CN111637900A (zh) * | 2020-05-29 | 2020-09-08 | 逻腾(杭州)科技有限公司 | 一种滚动机器人里程计算装置及方法 |
WO2022161271A1 (zh) * | 2021-01-26 | 2022-08-04 | 深圳市普渡科技有限公司 | 斜坡定位校正方法、装置、机器人及可读存储介质 |
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 |
---|
TAO YU等: "Path Following Control of a Spherical robot rolling on an inclined plane", 《SENSORS AND TRANSDUCERS》 * |
孙治伟等: "一种具有爬坡能力的球形机器人运动分析", 《机器人》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104898665A (zh) * | 2015-04-16 | 2015-09-09 | 山东建筑大学 | 巡检机器人轨迹规划的方法和装置 |
CN107884057A (zh) * | 2017-11-22 | 2018-04-06 | 苏州市计量测试研究所 | 用于电子吊秤检测装置的砝码自动加载控制装置 |
CN110109353A (zh) * | 2019-04-17 | 2019-08-09 | 杭州电子科技大学 | 一种反作用轮平衡自行车机器人模糊自适应滑模控制系统 |
CN110109353B (zh) * | 2019-04-17 | 2022-01-11 | 杭州电子科技大学 | 一种反作用轮平衡自行车机器人模糊自适应滑模控制系统 |
CN110377032A (zh) * | 2019-07-08 | 2019-10-25 | 希格斯动力科技(珠海)有限公司 | 语义地图下机器人坡地运动控制方法及装置、存储介质 |
CN110377032B (zh) * | 2019-07-08 | 2022-05-27 | 佳木斯市奥义智能科技有限公司 | 语义地图下机器人坡地运动控制方法及装置、存储介质 |
CN110968913A (zh) * | 2019-11-19 | 2020-04-07 | 贵州电网有限责任公司 | 一种提升双轮驱动球形机器人爬坡能力的方法 |
CN110968913B (zh) * | 2019-11-19 | 2023-09-05 | 贵州电网有限责任公司 | 一种提升双轮驱动球形机器人爬坡能力的方法 |
CN111637900A (zh) * | 2020-05-29 | 2020-09-08 | 逻腾(杭州)科技有限公司 | 一种滚动机器人里程计算装置及方法 |
WO2022161271A1 (zh) * | 2021-01-26 | 2022-08-04 | 深圳市普渡科技有限公司 | 斜坡定位校正方法、装置、机器人及可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN103412487B (zh) | 2016-12-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103412487A (zh) | 一种基于模糊滑模控制器的球形机器人坡面运动控制方法 | |
CN106125728B (zh) | 一种四驱轮式移动机器人轨迹跟踪控制方法 | |
CN109848983A (zh) | 一种高顺应性人引导机器人协同作业的方法 | |
CN102039589B (zh) | 模块化的灾害救援机器人 | |
CN106681335A (zh) | 用于农机无人驾驶的避障路径规划及其控制方法 | |
CN101221447A (zh) | 一种机械自动转向控制方法 | |
CN101916071A (zh) | 仿生机器鱼运动的cpg反馈控制方法 | |
CN103901889A (zh) | 一种基于蓝牙通信的多机器人编队控制路径跟踪方法 | |
CN110405762A (zh) | 一种基于空间二阶倒立摆模型的双足机器人姿态控制方法 | |
CN103853050A (zh) | 一种四旋翼飞行器的pid优化控制方法 | |
CN104808590A (zh) | 一种基于关键帧策略的移动机器人视觉伺服控制方法 | |
CN201525026U (zh) | 模块化的灾害救援机器人 | |
Gao et al. | Time-optimal trajectory planning of industrial robots based on particle swarm optimization | |
CN106272436A (zh) | 一种基于变负载的服务机器人自适应控制方法 | |
Yu et al. | Humanoid control of lower limb exoskeleton robot based on human gait data with sliding mode neural network | |
Sell et al. | Kinematics and dynamics of configurable wheel-leg | |
Nandy et al. | A modular approach to detailed dynamic formulation and control of wheeled mobile robot | |
Wu et al. | Research on the design of educational robot with four-wheel omni-direction chassis | |
Zheng et al. | Optimization of an intelligent controller for parallel autonomous parking | |
CN105438305B (zh) | 一种仿生六肢昆虫机器人的使用方法 | |
Chen et al. | An overtaking obstacle algorithm for autonomous driving based on dynamic trajectory planning | |
CN108107881A (zh) | 一种新型的果园作业机器人装置及方法 | |
CN103612267A (zh) | 一种用于并联机器人的自适应控制器 | |
CN104408298B (zh) | 一种基于多重分组迭代区间分支定界技术的ddpc伺服系统故障预示方法 | |
Niu et al. | Sliding mode path tracking control for spraying mobile robots based on weighed integral gain reaching law |
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 |