一种独轮机器人的有限时间自平衡控制方法
【技术领域】
[0001] 本发明属于自动化技术领域，涉及一种独轮机器人的自平衡控制方法。
【背景技术】
[0002] 独轮机器人一直以来受到全世界的强烈关注，特别是日本村田制作所的"村田婉 童"的问世，使得人们对独轮机器人的研宄兴趣大增。独轮机器人的研宄始于二十世纪 七八十年代，主要集中于日本、美国等国家。独轮机器人可作为高等院校和科研院所进行自 动控制理论、复杂系统建模与非线性动力学分析、机器学习和自治系统智能行为等研宄的 实验平台，以及用于进行有关自动控制、机器人学、人工智能的教学平台，由于所需空间小， 控制灵活，还可以作为机场迎宾、商场导游、图书馆导游等的商业应用。目前，针对独轮机器 人控制，大多数研宄人员选择滑模控制，因为滑模控制可以使研宄人员自主选择滑模面和 控制律，具有较强的抗干扰性和鲁棒性。但此类控制方法由于不连续性，存在控制抖振现 象。
【发明内容】
[0003] 本发明的目标是针对现有技术的不足之处，提出独轮机器人的有限时间自平衡控 制方法，具体是以拉格朗日方程为理论基础，建立独轮机器人的动力学模型，并在此基础上 设计连续的有限时间控制方法。该方法能够快速地使独轮机器人恢复到平衡状态，由于控 制器输出连续，因此，传统滑模控制的抖振现象能够避免，从而降低了飞轮旋转的圈数，降 低了控制独轮机器人保持平衡状态所需的能量。
[0004] 本发明方法的步骤包括：
[0005] (一）利用拉格朗日理论建立独轮机器人横向动力学模型，具体方法是：
[0006] ①建立独轮机器人的独轮、机器人车体和飞轮的横向动能方程：
[0007]
【主权项】
1. 一种独轮机器人的有限时间自平衡控制方法，其特征在于，该方法具体包括以下步 骤： (一） 利用拉格朗日理论建立独轮机器人横向动力学模型，具体方法是： ① 建立独轮机器人的独轮、机器人车体和飞轮的横向动能方程：
其中山是独轮的横向转动惯量；I 2是车体的横向转动惯量；I 3是飞轮的横向转动惯 量；IH1是独轮质量；m2是车体质量（不包含独轮，飞轮）；m3是飞轮质量；R 1是独轮的半径； I1是车体质心到独轮质心的距离；I2是飞轮质心距独轮质心的距离；α是车体的横向倾斜 角；Θ是飞轮转过的角度； ② 建立独轮机器人的独轮、机器人车体和飞轮的横向势能方程： V1 = m ^R1COS a +m2g (R^l1) cos α (2) +m3g (Rfl2) cos α 其中：g是重力加速度； ③ 根据拉格朗日理论、动能方程（1)和势能方程（2)，建立独轮机器人的横向动力学模 型：
并且： M = Iii1R1^m2 (Rfl1) 2+m3(Rl+l2) 2+]^+]^ N = (Hi1R^m2 (R^l1) +m3 (R^l2)) g 其中：^是飞轮电机输出转矩； (二） 利用拉格朗日理论建立独轮机器人纵向动力学模型，具体方法是： ① 建立独轮机器人的独轮、机器人车体和飞轮的纵向动能方程：
其中：14是独轮的纵向转动惯量；I 5是车体的纵向转动惯量；I 6是飞轮的纵向转动惯 量；β为车体质心在纵向上的偏角；Φ为独轮质心在纵向上的偏角； ② 建立独轮机器人的独轮、机器人车体和飞轮的纵向势能方程： V2= m ^R1+m2g (R^l1Cos β ) +m3g (R^l2Cos β ) (5) ③根据拉格朗日理论、动能方程（4)和势能方程（5)，建立独轮机器人的纵向动力学模 型：
其中：u2是独轮电机输出转矩； (三） 根据横向动力学模型，设计横向的有限时间自平衡控制器如下：
<5 \^i ^ ^ ^ 'M = Mk2k3；
a通常在区间[2,5]; (四） 根据纵向动力学模型，设计纵向的有限时间自平衡控制器如下：
其中
^为车体质心在纵向上的参考偏角。
【专利摘要】本发明涉及一种独轮机器人的有限时间自平衡控制方法。本发明首先根据独轮机器人横向平衡方向以及独轮机器人的纵向平衡方向，采用拉格朗日理论，分别建立横向和纵向的动力学模型；然后，检测独轮机器人横向车体偏角和纵向车体质心偏角，通过横向有限时间自平衡控制器和纵向有限时间自平衡控制器，控制独轮机器人的飞轮和独轮的转动角度，从而使独轮机器人在横向和纵向上保持平衡状态。本发明的有限时间自平衡控制方法弥补了传统滑模控制方法的不足，是一种连续并能在有限时间内保持独轮机器人平衡的控制方法，同时降低了独轮机器人的能量损耗。本发明可以使独轮机器人始终保持平衡状态。
【IPC分类】G05D1-08, G05B13-04
【公开号】CN104749955
【申请号】CN201510122098
【发明人】吕强, 王平, 张皓洁, 王坚
【申请人】杭州电子科技大学
【公开日】2015年7月1日
【申请日】2015年3月19日