CN110109354B - 一种反作用轮平衡自行车机器人自适应滑模控制方法 - Google Patents
一种反作用轮平衡自行车机器人自适应滑模控制方法 Download PDFInfo
- Publication number
- CN110109354B CN110109354B CN201910308634.6A CN201910308634A CN110109354B CN 110109354 B CN110109354 B CN 110109354B CN 201910308634 A CN201910308634 A CN 201910308634A CN 110109354 B CN110109354 B CN 110109354B
- Authority
- CN
- China
- Prior art keywords
- sliding mode
- self
- bicycle
- robot
- control method
- 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
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Abstract
Description
技术领域
本发明涉及自行车机器人平衡控制领域,尤其涉及一种反作用轮平衡自行车机器人自适应滑模控制方法。
背景技术
平衡自行车机器人是一种利用传感器感知自身状态,然后通过控制算法控制,从而实现无人的自平衡。近年来,无人驾驶导航系统正在被广泛研究。自行车机器人作为无人系统的一个类别,也被许多学者和工程师研究过。由于其较窄的结构,自行车机器人可以适应四轮车辆无法工作的特殊环境,例如狭窄的通道或管道。自行车实现无人驾驶的第一步是实现自主平衡。
目前有各种类型的平衡自行车机器人,最常研究的是使用前轮转向来保持自行车平衡。这种方法使自行车的结构变化最小化,但前轮驱动很难在低速和静止状态下平衡自行车。其次,还有用陀螺仪来保持平衡的设计,陀螺仪需要高功率电动机来高速旋转大质量物体。这意味着陀螺仪结构需要配备大容量电池以提供足够的功率,因此整个结构比一般设计更重。
对于以上类别的设计,最常用的控制方法为PID控制,通过采集自行车机器人的车身倾斜角度,对这个角度惊喜比例、微分、积分计算出反作用轮所需要输出的力矩。这种方法设计简单,因此被大范围的使用,但1)PID控制算法在受干扰时的鲁棒性不理想,受到扰动时平衡会出现较大震荡,甚至失去平衡,且其对于不确定的系统参数及变化的系统参数适应能力弱,难以适应参数未确定的自行车机器人。作为一种线性控制方法,PID控制没有针对具体系统模型进行控制,因此无法对非线性系统做出兼具鲁棒性和稳定性的控制
故,针对目前现有技术中存在的上述缺陷,实有必要进行研究,以提供一种方案,解决现有技术中存在的缺陷。
发明内容
本发明的目的是一种反作用轮平衡自行车机器人自适应滑模控制方法,使建模过程更加精简且全面、增强系统的鲁棒性、提高系统的响应速度;能够应对较大的外部扰动;能够自适应外部环境以及大范围负载的变化;系统中参数的值更加精确;平衡控制更加稳定;
为了克服现有技术存在的缺陷,本发明的技术方案为:
一种反作用轮平衡自行车机器人自适应滑模控制方法,包括以下步骤:
通过传感器测量模块采集反作用轮平衡自行车机器人运动参数,该运动参数至少包括自行车机器人倾倒的角速度信号和角加速度信号;
所述滑模自适应控制器的输出方程为:
优选地,所述的自适应滑模控制方法,所述自行车机器人所用的平衡方法为一个电机驱动的反作用轮。
优选地,所述的自适应滑模控制方法,通过陀螺仪采集角速度信号,所述陀螺仪的型号为MPU6050。
优选地,所述的自适应滑模控制方法,通过加速度计采集加速度信号,所述加速度计的型号为MPU6050。
优选地,所述的自适应滑模控制方法,通过通讯模块实现自平衡机器人与外部设备进行数据通讯。
优选地,所述的自适应滑模控制方法,所述主控芯片采用STM32F103
优选地,所述的自适应滑模控制方法,所述通讯模块为无线蓝牙数据传输模块。
与现有技术相比较,本发明所使用的自适应滑模控制方法对于反作用轮平衡自行车机器人控制性能鲁棒性强,对于外部的干扰适应能力强,受到扰动时震荡小,对于不确定的系统参数及变化的系统参数适应能力强。根据系统模型设计的自适应滑模控制器非线性能力强,控制表现兼具鲁棒性和稳定性。
说明书附图
图1为本发明中反作用轮平衡自行车机器人控制系统结构框图;
图2为本发明中反作用轮平衡自行车机器人模型结构图;
图3为本发明中反作用轮自适应滑模控制方法的流程框图;
图4为本发明中反作用轮平衡自行车机器人模型的俯视图和后视图;
图5为本发明中反作用轮自适应滑模控制方法执行流程图;
图6为本发明中转向舵机控制方法执行流程图;
图7为本发明中前进轮驱动电机控制方法执行流程图;
图8为实验时反作用轮平衡自行车机器人平衡控制效果图;
图9为实验时反作用轮驱动电机平衡控制电压输出图;
具体实施方式
参见图1和2展示了本发明反作用轮平衡自行车机器人的系统结构模型。其中,图1为控制系统结构框图,可以看到反作用轮平衡自行车机器人控制系统主要由主控芯片,通讯子系统,转向子系统,前进子系统以及平衡子系统组成。其中通讯子系统包括用于与电脑通讯的串口模块及与手机APP通讯的蓝牙模块,前进子系统和平衡子系统都包括速度编码器和电机,而平衡子系统还包括姿态检测传感器。图2则展示了反作用轮平衡自行车机器人模型。其组成包括一个钢结构的车身。车身中间安装有用于平衡的反作用轮及其驱动的电机。反作用轮驱动电机上部安装有用于转向的舵机,舵机靠两根连接杆来控制前轮转向。前轮与车身的连接用3D打印的连接臂固定。反作用轮后侧是前进驱动电机,它用链条与后轮连接,电机转动待用车辆前进。后轮上方则是车辆供电的锂电池以及主控电路板。
本发明的控制系统分为三个部分,包括反作用轮的平衡控制,前进的速度控制,以及转向控制。其中对于反作用轮的平衡控制是本发明的核心部分。
参见图3为反作用轮自适应滑模控制方法的流程框图,包括以下步骤:
步骤S1:在反作用轮平衡自行车机器人主控芯片中设置用于控制反作用轮平衡输出的控制器。其中控制器的输出方程为:
步骤S2:通过传感器模块采集自行车机器人的状态,主要是陀螺仪采集倾倒的角速度信号和加速度计采集的加速度信号,其型号为集成陀螺仪和加速度计的MPU6050。然后将两个信号进行滤波和融合最终得到控制器的输入角度参数。
步骤S3:自适应滑模控制器获取传入参数后,根据S1中设置的控制方程,计算得到需要的平衡输出力矩,然后通过反作用轮驱动电机转动反作用轮来获得反作用力矩,使自行车保持平衡。这样不断通过反馈角度得到输出,使得自行车机器人可以保持平衡状态。
在步骤1中采用的自适应滑模控制器的设计原理如下:
从飞轮自行车机器人俯视图可以看到,其结构包括自行车前后轮、车身、车把及用于平衡的飞轮结构。其中β表示自行车前轮相对车身方向延长线的偏转角度。传统的自行保持平衡运动是由自行车前进时车把转动提供的反作用力来维持。而在带有飞轮结构的自行车机器人中,自行车机器人的平衡力矩由飞轮转动产生的反作用力提供。因此,自行车机器人的前轮转动对于整体的平衡就不再提供作用,反而将干扰平衡,所以我们将这个力矩看成对平衡系统的干扰项Fc。而Fc的方向又与前轮转向的速度的方向相关。
从飞轮自行车机器人后视图可以看到,自行车机器人运动时受到扰动发生倾斜时的状态。其中表示自行车机器人相对竖直状态所发生倾斜的角度。对参见图4经行受力分析可知,在水平方向上受到一个重力的水平分量。此外,整个车身可以看作一个以于地面接触点为圆心,以质心高度为半径的转动,因此还有一个转动力矩。
根据以上的力学分析可以得到一个自行车平衡力学的表达式:
其中:τ为平衡力矩,Jw为飞轮转动惯量,ω为飞轮转动角速度,Jh为自行车转动惯量,为自行车倾斜角度,M为自行车所受重力,Fc为前轮转动摩擦力,d为未建模的其他力,h为自行车重心高度,β为自行车前轮转角,fc为前轮所受库伦摩擦力大小。
输出控制误差可以定义为:
根据模型表达式的各项,按滑模设计原则对各项取上界可以得到控制器的表达式
为证明所设计控制器的有效性,设计李雅普诺夫方程:
对李雅普诺夫方程求导可以得到表达式:
参见图5,所述为本发明自行车机器人平衡控制的执行流程图。自行车机器人平衡控制分为两个部分,第一部分为反作用轮的速度控制,读取编码器值,用PID速度环让反作用轮保持匀速转动。当反作用轮匀速转动的时候,可以看成系统在稳态,没有反作用力产生。第二部分为用于平衡的反作用力速度输出,即输出平衡控制器中的平衡力矩,作为加速度叠加到速度控制输出上,得到最终的反作用轮输出。
参见图6和7,分别所述为自行车机器人转向控制和前进速度控制的流程图。其中转向控制的执行流程为,初始化系统后,根据输入的转向角度,通过PID算法得到转向舵机的输出,并由转向舵机输出方向。速度控制则是通过采集前进轮编码器值,在输入目标速度,经速度PID控制器的到前进输出的闭环控制。
参见图8和9为实际实验的信号图,展示了实验时平衡控制器输出以及平衡时自行车倾斜角度图。图2.5秒后为外部摩擦力参数变化后系统的状态。可以看到本发明所设计的控制器在实际表现中效果良好,车身来回摇摆幅度小,且对于外部参数的变化有非常高的鲁棒性。
以上实施例的说明只是用于帮助理解本发明的方法及其核心思想。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以对本发明进行若干改进和修饰,这些改进和修饰也落入本发明权利要求的保护范围内。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本发明中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本发明所示的这些实施例,而是要符合与本发明所公开的原理和新颖特点相一致的最宽的范围。
Claims (8)
1.一种反作用轮平衡自行车机器人自适应滑模控制方法,其特征在于,包括以下步骤:
通过传感器测量模块采集反作用轮平衡自行车机器人运动参数,该运动参数至少包括自行车机器人倾倒的角速度信号和角加速度信号;
所述自适应滑模控制器的输出方程为:
2.根据权利要求1所述的反作用轮平衡自行车机器人自适应滑模控制方法,其特征在于,所述自行车机器人所用的平衡方法为一个电机驱动的反作用轮。
4.根据权利要求1所述的反作用轮平衡自行车机器人自适应滑模控制方法,其特征在于,通过陀螺仪采集角速度信号,所述陀螺仪的型号为MPU6050。
5.根据权利要求1所述的反作用轮平衡自行车机器人自适应滑模控制方法,其特征在于,通过加速度计采集加速度信号,所述加速度计的型号为MPU6050。
6.根据权利要求1所述的反作用轮平衡自行车机器人自适应滑模控制方法,其特征在于,通过通讯模块实现自平衡机器人与外部设备进行数据通讯。
7.根据权利要求1所述的反作用轮平衡自行车机器人自适应滑模控制方法,其特征在于,所述主控芯片采用STM32F103。
8.根据权利要求6所述的反作用轮平衡自行车机器人自适应滑模控制方法,其特征在于,所述通讯模块为无线蓝牙数据传输模块。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910308634.6A CN110109354B (zh) | 2019-04-17 | 2019-04-17 | 一种反作用轮平衡自行车机器人自适应滑模控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910308634.6A CN110109354B (zh) | 2019-04-17 | 2019-04-17 | 一种反作用轮平衡自行车机器人自适应滑模控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110109354A CN110109354A (zh) | 2019-08-09 |
CN110109354B true CN110109354B (zh) | 2022-01-07 |
Family
ID=67485620
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910308634.6A Active CN110109354B (zh) | 2019-04-17 | 2019-04-17 | 一种反作用轮平衡自行车机器人自适应滑模控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110109354B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112540536B (zh) * | 2020-11-27 | 2022-04-22 | 南京航空航天大学 | 一种蠕虫管道机器人滑模优化控制器设计方法 |
CN113771837B (zh) * | 2021-09-03 | 2023-02-28 | 长安大学 | 一种无人自行车控制方法及系统 |
CN114019825A (zh) * | 2021-10-08 | 2022-02-08 | 杭州电子科技大学 | 一种基于观测器与自适应结合的平衡自行车滑模控制方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101269683A (zh) * | 2008-01-15 | 2008-09-24 | 李锦上 | 基于姿态控制的平衡式独轮小车 |
CN102520720A (zh) * | 2011-12-09 | 2012-06-27 | 东南大学 | 一种可实现自平衡的独轮机器人 |
CN103629302A (zh) * | 2013-11-29 | 2014-03-12 | 东风小康汽车有限公司重庆分公司 | 内平衡飞轮 |
CN104749955A (zh) * | 2015-03-19 | 2015-07-01 | 杭州电子科技大学 | 一种独轮机器人的有限时间自平衡控制方法 |
CN105116729A (zh) * | 2015-08-17 | 2015-12-02 | 杭州电子科技大学 | 一种两轮自平衡机器人自适应滑模变结构控制方法及系统 |
CN105159086A (zh) * | 2015-09-10 | 2015-12-16 | 杭州电子科技大学 | 独轮机器人的基于事件触发机制有限时间自平衡控制方法 |
CN106041934A (zh) * | 2016-06-30 | 2016-10-26 | 杭州电子科技大学 | 一种两轮自平衡机器人滑模自适应控制方法 |
CN106078744A (zh) * | 2016-06-30 | 2016-11-09 | 杭州电子科技大学 | 一种两轮自平衡机器人滑模自适应控制系统 |
CN106182000A (zh) * | 2016-06-30 | 2016-12-07 | 杭州电子科技大学 | 一种基于部分已知参数的两轮自平衡机器人控制方法 |
CN107065561A (zh) * | 2017-05-16 | 2017-08-18 | 清华大学 | 两轮自平衡车的机器学习控制方法 |
CN107161890A (zh) * | 2017-06-12 | 2017-09-15 | 无锡石油化工起重机有限公司 | 设置有移动式平衡车的吊机平衡臂 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8442753B2 (en) * | 2007-08-10 | 2013-05-14 | Equos Research Co., Ltd. | Inverted pendulum vehicle with stability on a slope |
JP5027933B2 (ja) * | 2009-01-08 | 2012-09-19 | 株式会社小松製作所 | トラクションコントロール装置 |
MX2021007862A (es) * | 2016-02-23 | 2022-09-22 | Deka Products Lp | Sistema de control de dispositivo de movilidad. |
-
2019
- 2019-04-17 CN CN201910308634.6A patent/CN110109354B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101269683A (zh) * | 2008-01-15 | 2008-09-24 | 李锦上 | 基于姿态控制的平衡式独轮小车 |
CN102520720A (zh) * | 2011-12-09 | 2012-06-27 | 东南大学 | 一种可实现自平衡的独轮机器人 |
CN103629302A (zh) * | 2013-11-29 | 2014-03-12 | 东风小康汽车有限公司重庆分公司 | 内平衡飞轮 |
CN104749955A (zh) * | 2015-03-19 | 2015-07-01 | 杭州电子科技大学 | 一种独轮机器人的有限时间自平衡控制方法 |
CN105116729A (zh) * | 2015-08-17 | 2015-12-02 | 杭州电子科技大学 | 一种两轮自平衡机器人自适应滑模变结构控制方法及系统 |
CN107368081A (zh) * | 2015-08-17 | 2017-11-21 | 杭州电子科技大学 | 一种两轮自平衡机器人自适应滑模变结构控制系统 |
CN105159086A (zh) * | 2015-09-10 | 2015-12-16 | 杭州电子科技大学 | 独轮机器人的基于事件触发机制有限时间自平衡控制方法 |
CN106041934A (zh) * | 2016-06-30 | 2016-10-26 | 杭州电子科技大学 | 一种两轮自平衡机器人滑模自适应控制方法 |
CN106078744A (zh) * | 2016-06-30 | 2016-11-09 | 杭州电子科技大学 | 一种两轮自平衡机器人滑模自适应控制系统 |
CN106182000A (zh) * | 2016-06-30 | 2016-12-07 | 杭州电子科技大学 | 一种基于部分已知参数的两轮自平衡机器人控制方法 |
CN107065561A (zh) * | 2017-05-16 | 2017-08-18 | 清华大学 | 两轮自平衡车的机器学习控制方法 |
CN107161890A (zh) * | 2017-06-12 | 2017-09-15 | 无锡石油化工起重机有限公司 | 设置有移动式平衡车的吊机平衡臂 |
Non-Patent Citations (4)
Title |
---|
Research on Self-balancing Control for Upright Vehicle with Two Wheels Based on Sliding Mode Control;Wang Lingling,等;《2017 International Conference on Computer Technology, Electronics and Communication (ICCTEC)》;20171231;第1192-1195页 * |
Two-wheeled Self-balancing Robot Modeling and Nonlinear Control;Jinfeng Qiu,等;《2017 14th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI)》;20171231;第734-739页 * |
一种新的两轮自平衡电动车控制方法;段其昌,等;《计算机应用研究》;20131231;第30卷(第12期);第3678-3681页 * |
不确定欠驱动系统的高阶自适应;杨兴明,等;《模式识别与人工智能》;20140930;第27卷(第9期);第808-814页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110109354A (zh) | 2019-08-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107728635B (zh) | 一种摩托车型机器人的自动平衡装置及方法 | |
Nawawi et al. | Real-time control of a two-wheeled inverted pendulum mobile robot | |
CN110109354B (zh) | 一种反作用轮平衡自行车机器人自适应滑模控制方法 | |
CN100530018C (zh) | 移动台车的控制方法及移动台车 | |
Lam | Gyroscopic stabilization of a kid-size bicycle | |
WO2018176597A1 (zh) | 一种基于速率陀螺仪的无人自行车平衡控制方法 | |
Li et al. | Mechanical design and dynamic modeling of a two-wheeled inverted pendulum mobile robot | |
CN110109353B (zh) | 一种反作用轮平衡自行车机器人模糊自适应滑模控制系统 | |
Prakash et al. | Study of controllers for a two wheeled self-balancing robot | |
CN107856762A (zh) | 一种摩托车型机器人 | |
Li et al. | Dynamic adaptive equilibrium control for a self-stabilizing robot | |
Xiong et al. | Static balancing of robotic bicycle through nonlinear modeling and control | |
KR101063889B1 (ko) | 외바퀴 로봇의 제어시스템 및 그 설계방법 | |
Li et al. | Controller design of a two-wheeled inverted pendulum mobile robot | |
CN111273542A (zh) | 立方体机器人及控制系统和方法以及设计方法 | |
CN113864387B (zh) | 一种主动减震机构控制方法、系统和存储介质 | |
CN207417002U (zh) | 一种摩托车型机器人 | |
Han et al. | Design of two-wheeled self-balancing robot based on sensor fusion algorithm | |
CN207441095U (zh) | 一种智能小车控制系统开发的实验平台 | |
Lamon et al. | The solero rover | |
US20230305563A1 (en) | Method for building controller for robot, method, device for controlling motion of robot, and robot | |
WO2023165192A1 (zh) | 机器人控制方法、装置、机器人以及计算机可读存储介质 | |
Li et al. | BMP: A self-balancing mobile platform | |
Ouyang et al. | Design of a Wheeled Inverted Pendulum as a platform for learning based control | |
Tharun et al. | Smart Embedded Design for Android Application Based Control of Self Balancing Robot |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |