平衡摇臂式移动机器人姿态控制算法

doi:10.13700/j.bh.1001-5965.2017.0111

北京航空航天大学学报 ›› 2018, Vol. 44 ›› Issue (2): 391-398.doi: 10.13700/j.bh.1001-5965.2017.0111

平衡摇臂式移动机器人姿态控制算法

刘本勇, 高峰, 姜惠, 张彬

北京航空航天大学交通科学与工程学院, 北京 100083

收稿日期:2017-03-02 修回日期:2017-04-06 出版日期:2018-02-20 发布日期:2017-06-27
通讯作者: 高峰,E-mail:gaof@buaa.edu.cn E-mail:gaof@buaa.edu.cn
作者简介:刘本勇,男,硕士研究生。主要研究方向:特种车辆;高峰,男,博士,教授,博士生导师。主要研究方向:智能车辆与特种车辆。
基金资助:
国家自然科学基金（51675027）；"十三五"重大专项（2016YFD0700503-1）

Attitude control algorithm of balancing-arm mobile robot

LIU Benyong, GAO Feng, JIANG Hui, ZHANG Bin

School of Transportation Science and Engineering, Beijing University of Aeronautics and Astronautics, Beijing 100083, China

Received:2017-03-02 Revised:2017-04-06 Online:2018-02-20 Published:2017-06-27
Supported by:
National Natural Science Foundation of China (51675027);The 13th Five Years Major Project (2016YFD0700503-1)

摘要/Abstract

摘要： 以具有平衡摇臂机构的移动机器人为研究对象，设计一种基于非线性规划遗传算法的姿态控制算法，提高越障过程中工作平台的平稳性。首先简化平衡摇臂机构并定义表征移动机器人空间状态的姿态参数。利用空间机构学位姿变换方程推导出所定义的空间姿态参数与轮心相对位置之间的数学关系。然后设计非线性规划遗传算法，以移动机器人稳定性条件为约束设计遗传算法适应度函数并求解目标姿态控制参数。为验证所设计的姿态控制算法，在ADAMS软件中搭建移动机器人三维模型和障碍路面模型，并联合MATLAB/Simulink对移动机器人进行了运动学仿真。仿真结果表明在该姿态算法的控制下，与不施加主动姿态控制相比较，移动机器人通过搭建的障碍路面时最大侧倾角由10.8°降低到了1.8°，质心高度变化幅值度由96.4 mm降低到了34.9 mm，证明了姿态控制算法的有效性。

关键词: 平衡摇臂, 运动学建模, 空间姿态, 遗传算法, 非线性规划

Abstract: In order to improve the stability of working platform in the process of obstacle negotiation, with balancing-arm mobile robot as research object, an attitude control algorithm was designed based on nonlinear programming genetic algorithm. First, the simplified model of balancing-arm mechanism was built and spatial posture parameters were defined to character the space state of robot. Mathematical relationship between spatial posture parameters and wheel center positions was deduced by coordinate transformation equation based on spatial mechanism. Then, a nonlinear programming genetic algorithm was designed. The genetic algorithm fitness function used to solve objective control parameters was established under the constraint of stability. To verify the performance of the proposed attitude control algorithm, 3D model of the mobile robot and road were built in the ADAMS software, and then kinematics simulation studies were carried out by ADAMS and MATLAB/Simulink. The results of simulation show that when balance-arm mobile robot passes through the designed obstacles with the designed controller, the roll angle falls from 10.8° to 1.8° compared with no controller and the amplitude of wheel center position falls from 96.4 mm to 34.9 mm as also. The simulation results demonstrate the validity of the proposed attitude control algorithm.

Key words: balancing-arm, kinematical modeling, spatial attitude, genetic algorithm, nonlinear programming

中图分类号:

TP242.6

刘本勇, 高峰, 姜惠, 张彬. 平衡摇臂式移动机器人姿态控制算法[J]. 北京航空航天大学学报, 2018, 44(2): 391-398.

LIU Benyong, GAO Feng, JIANG Hui, ZHANG Bin. Attitude control algorithm of balancing-arm mobile robot[J]. JOURNAL OF BEIJING UNIVERSITY OF AERONAUTICS AND A, 2018, 44(2): 391-398.

参考文献

[1] 马金猛,李小凡,姚辰,等.地面移动机器人越障动力学建模与分析[J].机器人,2008,30(3):273-278.MA J M,LI X F,YAO C,et al.Dynamic modeling and analysis for obstacle negotiation of ground mobile robot[J].Robot,2008,30(3):273-278(in Chinese).
[2] 叶锦华.不确定非完整轮式移动机器人的运动控制研究[D].广州:华南理工大学,2013:6-13.YE J H.Research on motion control of uncertain nonholonomic wheeled mobile robot[D].Guangzhou:South China University of Technology,2013:6-13(in Chinese).
[3] 王佐伟,梁斌,吴宏鑫.六轮月球探测车运动学建模与分析[J].宇航学报,2003,24(5):1-10.WANG Z W,LIANG B,WU H X.Kinematical modeling and analysis of six-wheel lunar rover[J].Journal of Astronautics,2003,24(5):1-10(in Chinese).
[4] 徐坤,郑羿,丁希仑,等.六轮腿式机器人结构设计与运动模式分析[J].北京航空航天大学学报,2016,42(1):59-71.XU K,ZHENG Y,DING X L,et al.Structure designe and motion mode analysis of a six wheel-legged robot[J].Journal of Beijing University of Aeronautics and Astronautics,2016,42(1):59-71(in Chinese).
[5] 周开波,王旭永,罗小桃,等.摇臂式六轮探测车空间姿态建模与求解[J].上海交通大学学报,2013,47(7):1093-1098.ZHOU K B,WANG X Y,LUO X T,et al.Spatital attitude model of six-wheeled rocker rover and its mathematical solution[J].Journal of Shanghai Jiaotong University,2013,47(7):1093-1098(in Chinese).
[6] 崔莹,高峰.可变直径轮月球探测车运动学建模与分析[J].北京航空航天大学学报,2008,34(3):348-352.CUI Y,GAO F.Kinematic modeling and analysis of variable diameter wheeled lunar rover[J].Journal of Beijing University of Aeronautics and Astronautics,2008,34(3):348-352(in Chinese).
[7] PANSINI V,MONNET A,SALLERON J,et al.Development of a genetic algorithm for multi-objective assembly line balancing using multiple assignment approach[J].The International Journal of Advanced Manufacturing Technology,2015,77(5):1419-1432.
[8] 陶建国,邓宗全,高海波,等.月球车连杆式差速平衡机构的运动学分析[J].哈尔滨工业大学学报,2009,41(9):21-26.TAO J G,DENG Z Q,GAO H B,et al.Kinematics analysis of differential bar linkage on lunar rover[J].Journal of Harbin Institute of Technology,2009,41(9):21-26(in Chinese).
[9] MICHALEWICZ Z,JANIKOW C Z,KRAWCZYK J B.A modified genetic algorithm for optimal control problems[J].Computers & Mathematics with Applications,1992,23(12):83-94.
[10] 朱会霞,王福林,张勇,等.改进遗传算法优化非线性规划问题[J].数学的实践与认识,2013,43(7):117-125.ZHU H X,WANG F L,ZHANG Y,et al.Improved genetic algorithm to optimize the nonlinear programming problem[J].Mathematics in Practice and Theory,2013,43(7):117-125(in Chinese).
[11] KWOK D P, SHENG F.Genetic algorithm and simulated annealing for optimal robot arm PID control[C]//IEEE Conference on Evolutionary Computation.Piscataway,NJ:IEEE Press,1994,2:707-713.
[12] FU Y Y,KO C N,LEE T L,et al.A nonlinear programming method for time-optimal control of an omni-directional mobile robot[J].Journal of Vibration & Control,2008,14(14):1729-1747.
[13] CHEN J L,CHANG W D.Feedback linearization control of a two-link robot using a multi-crossover genetic algorithm[J].Expert Systems with Applications,2009,36(2):4154-4159.
[14] 史峰,王辉,郁磊,等.MATLAB智能算法[M].北京:北京航空航天大学出版社,2011:17-24.SHI F,WANG H,YU L,et al.MATLAB intelligent algorithm[M].Beijing:Beihang University Press,2011:17-24(in Chinese).
[15] 李金良,包继华,于岩,等. 基于遗传算法的腿轮式机器人运动姿态优化[J].机床与液压,2010,38(21):23-25.LI J L,BAO J H,YU Y,et al.Kinetic optimization for a leg-wheeled robot based on genetic algorithm[J].Machine Tool & Hydraulics,2010,38(21):23-25(in Chinese).
[16] ZHOU L F,HONG B R.A knowledge based genetic algorithm for path planning of a mobile robot[J].Acta Electronica Sinica,2006,34(5):911-914.

平衡摇臂式移动机器人姿态控制算法

Attitude control algorithm of balancing-arm mobile robot

PDF (PC)

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	潘雄, 郝帅, 苑政国, 宋凝芳. 基于无关变量分离的EFSM测试数据进化生成[J]. 北京航空航天大学学报, 2019, 45(5): 919-929.
[2]	孙波, 梁勇, 汉牟田, 杨磊, 荆丽丽, 俞永庆. 基于GA-SVM的GNSS-IR土壤湿度反演方法[J]. 北京航空航天大学学报, 2019, 45(3): 486-492.
[3]	周玙, 刘莉. 倾转旋翼无人机最优过渡倾转角曲线[J]. 北京航空航天大学学报, 2019, 45(11): 2277-2283.
[4]	高爽, 张若愚. 基于自适应遗传算法的MEMS加速度计快速标定方法[J]. 北京航空航天大学学报, 2019, 45(10): 1982-1989.
[5]	孙健, 付永领, 何杰, 谭林, 李胜广, 许文鹏. 基于非线性规划的室内TOA测距值优化方法[J]. 北京航空航天大学学报, 2018, 44(8): 1636-1642.
[6]	姜雨, 徐成, 蔡梦婷, 陈丽丽. 基于双层规划模型的滑行道与停机位再指派联合调度[J]. 北京航空航天大学学报, 2018, 44(11): 2437-2443.
[7]	史树峰, 师鹏, 赵育善. 基于星下点机动的再入飞行器离轨规划[J]. 北京航空航天大学学报, 2018, 44(10): 2141-2148.
[8]	陈云鹏, 庞丽萍, 尹永利, 李国相, 王浚. 空间站大气环控系统应急运行策略优化[J]. 北京航空航天大学学报, 2017, 43(9): 1924-1930.
[9]	霍琳, 费思邈. 基于遗传算法的飞行管理系统余度配置优化方法[J]. 北京航空航天大学学报, 2017, 43(7): 1306-1312.
[10]	李志栋, 张涛. 非完美特性下的多状态系统检测与维修优化[J]. 北京航空航天大学学报, 2017, 43(5): 951-960.
[11]	李小涛, 彭翀. 基于混合多智能体遗传算法的作业车间调度问题研究[J]. 北京航空航天大学学报, 2017, 43(2): 410-416.
[12]	胡鑫铭, 陆志强. 考虑物料配送的飞机移动生产线调度问题优化[J]. 北京航空航天大学学报, 2017, 43(12): 2573-2582.
[13]	王巍, 刘春, 李东升. 基于混合遗传算法的直升机前推/后拉配平[J]. 北京航空航天大学学报, 2017, 43(10): 1994-2002.
[14]	张永德, 梁艺, 毕津滔, 许勇. 前列腺癌粒子植入机器人运动学建模和仿真[J]. 北京航空航天大学学报, 2016, 42(4): 662-668.
[15]	高明, 秦世引. 基于非线性直方图变换的对比度畸变图像校正[J]. 北京航空航天大学学报, 2016, 42(3): 514-521.