自平衡两轮移动机器人的设计
|
摘要
自平衡两轮移动机器人是一种类似于倒立摆的轮式移动机器人。由于该机器人在控制上的复杂性和技术实现上的难度，很适合作为各种控制理论和方法研究的试验平台。
本文在分析了国内外研究现状的基础上自行设计制作了简易机器人的总体机械结构和硬件电路。采用dsPIC30F4011作为本系统的主控芯片，自制的倾角传感器、陀螺仪和自制的电机编码器作为检测系统的传感器，并设计了遥控器电路和人-机接口电路等。
根据已构建的机器人的系统参数，分析了机器人的运动状态，建立了机器人的动力学模型，得到了系统的状态空间表达式，设计了LQR最优控制器和PID控制器，并进行了MATLAB仿真，两者均获得了期望的平衡效果，验证了系统的合理性和可行性。
对传感器的标定实验表明在机器人倾斜角度小于±10°时机器人的倾斜角度和传感器的偏差是线性的，利用陀螺仪模块得到了机器人的角速度，利用自制的编码器得到了机器人的角度，通过比较多种PID算法的优缺点，设计了适合于本系统的基于增量式PID的改进的控制算法，最后进行了硬件和软件的联合调试。实现了机器人自平衡控制，得到了较为理想的平衡和运行控制效果。
As a kind of wheeled mobile robot, self-balanced two-wheeled robot is similar toinverted pendulum. Due to the control complexity and the technique difficulty, therobot quite suits to be an experiment platform of various control theory and methods.
Through analyzing the self-balancing two-wheeled vehicle from the domestic andforeign, mechanical structure and hardware of the self-balanced two-wheeled robot aredesigned. The dsPIC30F4011as the control chip, the homemade tilt sensor sensors,gyroscope and homemade motor encoder to compose the detecting system, and remotecontrol circuit, people-machine interface circuit and so on are all designed.
According to the robot’s parameters and motion, dynamical model are built, andobtain the system state space expression, design the LQR optimal controller and PIDcontroller, get the expected balancing results and verify the rationality and feasibilityof the system by making the simulation experiments with MATLAB.
The senor calibration experiment indicates that the robot’s inclination angle andthe sensor’s error are linear when inclination angle is less than plus or minus10degrees. The gyroscope gets the robot’s angle, and homemade motor encoder gets therobot’s angular velocity quantity. Through comparing the relative merits amongmultiple PID arithmetic, the improved based on incremental type PID of controlalgorithm which is suitable to the system is designed. Finally, the hardware and thesoftware were debugged together that makes the robot balanced and get thecomparatively desired result.
本文在分析了国内外研究现状的基础上自行设计制作了简易机器人的总体机械结构和硬件电路。采用dsPIC30F4011作为本系统的主控芯片，自制的倾角传感器、陀螺仪和自制的电机编码器作为检测系统的传感器，并设计了遥控器电路和人-机接口电路等。
根据已构建的机器人的系统参数，分析了机器人的运动状态，建立了机器人的动力学模型，得到了系统的状态空间表达式，设计了LQR最优控制器和PID控制器，并进行了MATLAB仿真，两者均获得了期望的平衡效果，验证了系统的合理性和可行性。
对传感器的标定实验表明在机器人倾斜角度小于±10°时机器人的倾斜角度和传感器的偏差是线性的，利用陀螺仪模块得到了机器人的角速度，利用自制的编码器得到了机器人的角度，通过比较多种PID算法的优缺点，设计了适合于本系统的基于增量式PID的改进的控制算法，最后进行了硬件和软件的联合调试。实现了机器人自平衡控制，得到了较为理想的平衡和运行控制效果。
As a kind of wheeled mobile robot, self-balanced two-wheeled robot is similar toinverted pendulum. Due to the control complexity and the technique difficulty, therobot quite suits to be an experiment platform of various control theory and methods.
Through analyzing the self-balancing two-wheeled vehicle from the domestic andforeign, mechanical structure and hardware of the self-balanced two-wheeled robot aredesigned. The dsPIC30F4011as the control chip, the homemade tilt sensor sensors,gyroscope and homemade motor encoder to compose the detecting system, and remotecontrol circuit, people-machine interface circuit and so on are all designed.
According to the robot’s parameters and motion, dynamical model are built, andobtain the system state space expression, design the LQR optimal controller and PIDcontroller, get the expected balancing results and verify the rationality and feasibilityof the system by making the simulation experiments with MATLAB.
The senor calibration experiment indicates that the robot’s inclination angle andthe sensor’s error are linear when inclination angle is less than plus or minus10degrees. The gyroscope gets the robot’s angle, and homemade motor encoder gets therobot’s angular velocity quantity. Through comparing the relative merits amongmultiple PID arithmetic, the improved based on incremental type PID of controlalgorithm which is suitable to the system is designed. Finally, the hardware and thesoftware were debugged together that makes the robot balanced and get thecomparatively desired result.
引文
[1]李威.两轮自平衡机器人控制系统研制[D].哈尔滨工业大学硕士学位论文，2005,6.
[2]常春阳.两轮电动车行走机构控制的相关问题研究[D].河南科技大学硕士学位学位论文，2005,6.
[3]王晓宇.两轮自平衡机器人的研究[D].哈尔滨工业大学博士学位论文，2007,12.
[4]李红美，李智，高飞.平衡的杰作—赛格威HT两轮平台电动车[J].电器工业，2002(6):19-21.
[5]孔祥宣.自主式双轮动态平衡移动机器人的控制系统研究[D].上海交通大学大学硕士学位论文，2007,2.
[6]王瑜.两轮自平衡机器人的控制技术研究[D].哈尔滨工程大学硕士学位论文，2009,3.
[7] A.Salerno, J.Angeles. The Control of Semi-Autonomous Two-Wheeled RobotsUndergoing Large Payload-Variations[J]. Proceedings of the2004IEEEInternational Conference on Robotics and Automation,2004,1740-1745.
[8] A.Salerno,J.Angeles.The Control of Semi-Autonomous Self-BalancingTwo-Wheeled Quasiholonomic Mobile Robots[J]. Preceedings of the15thCISM-IFTOMM Symposium on Robot Design,Dynamics and Control,2004,1-8.
[9] A.Salerno, S.Ostrovskaya and J.Angeles. The Development of QuasiholonomicWheeled Robots[J].Proceedings of the2002IEEE International Conference onRobotics and Automation,2002,3514-3520.
[10]张吉昌.单轴双轮自平衡代步车的研究与设计[D].中国海洋大学硕士学位论文，2009,6.
[11]郑钧元.两轮自我平衡机器人之平衡控制[D].国立中央大学硕士学位论文，2003,6.
[12]王祯祥.两轮自我平衡机器人之前后行走控制[D].国立中央大学硕士学位论文，2003,6.
[13]蔡侨伦.DSP主控之两轮机器人平衡与两轮同步控制[D].国立中央大学硕士学位论文，2004,6.
[14]陈家良.改良式DSP主控之两轮机器人基本控制[D].国立中央大学硕士学位论文，2005,6.
[15]李航,孙厚芳,韩建海，等.两轮机器人行走机构的建模与实验[J].北京理工大学学报,2004,24(12):1058-1061.
[16]韩建海,李航,白玉川，等.平行双轮电动车的建模与控制仿真[J].中国机械工程,2005,16(8):683-686.
[17]赵书尚，韩建海，李济顺，等.平行双轮电动车及其控制系统的研究[J].机电工程,2005,22:12-15.
[18]屠运武，徐俊艳，等.自平衡控制系统的建模与仿真[J].系统仿真学报，2004,16（4）:839-841.
[19]丛爽，张冬军，魏衡华.单级倒立摆三种控制方法的对比研究[J].系统工程与电子技术,2001,23(11):47-49.
[20] Boquete V, Garcia R, Barea R, etal. Neural Control of the Movement of aWheelchair[J]. Journal of Intelligent and Robotic Systerms,1999,25(3):213-216.
[21]世界首例倒立摆实物控制系统在我校试验成功[J].北京师范大学学报（自然科学版）,2002,(10):5-8.
[22] Brown SC, Passino KM. Intelligent Control for an Acrobot [J]. Jounal ofIntelligent and Robotic System,1997,18(2):209-248.
[23] http://v.youku.com/v_playlist/f3459594olp0.html.
[24]狄海江.两轮自平衡机器人中若干问题研究[D].北京工业大学硕士学位论文，2008,5.
[25]何礼高. dsPIC30F@电机与电源系列数字信号控制器原理与应用[M].北京航空航天大学出版社，2007.
[26] http://www.xie-gang.com/PT22622272.htm.
[27] http://www.pcbwork.net/down/1764.pdf.
[28] http://wenku.baidu.com/view/4fe72e28915f804d2b16c123.html.
[29] http://www.docin.com/p-41278663.html.
[30] http://wenku.baidu.com/view/a7e63aa3b0717fd5360cdc1e.html.
[31] http://www.soiseek.cn/MURATA/ENC-03R/.
[32]陈扬.自动导引车系统（AGVS）的设计与实现[D].南京理工大学硕士学位论文，2007,7.
[33]袁泽睿.两轮自平衡机器人控制算法的研究[D].哈尔滨工业大学硕士学位论文，2006,6.
[34] Katsuhiko Ogata，卢伯英，于海勋，等.现代控制工程[M].电子工业版社，2003.
[35]赵世敏.倒立摆控制系统实验指示书[R].清华大学自动化系，2007,3.
[36]刘璟，梁昔明.LQR控制与PID控制在单级倒立摆中的对比研究[J].自动化技术与应用,2007,26(1):13-14,17.
[37]阮晓钢，刘江，狄海江，李欣源，赵建伟.两轮自平衡机器人系统设计、建模及LQ控制[J].现代电子技术,2008.18(281):57-60.
[38]杨平,徐春梅,曾婧婧,等.PID控制在倒立摆实时控制系统中的应用[J].微计算机信息,2006,22(7-1):83-85.
[39]杨平,徐春梅,贺茂康,等.直线二级倒立摆的PID实时控制[J].上海电力学院学报,2008,2(2):236-238,247.
[40]刘金琨.先进PID控制MATLAB仿真（第2版）[M].北京:电子工业出版社，2004.
[41]陶永华.新型PID控制及其应用（第3版）[M].北京:机械工业出版社，2002.
[42]胡寿松.自动控制原理（第四版）[M].北京:科学出版社，2001.
[43]杨丹明.基于路径跟踪的移动机器人导航控制系统设计[D].苏州大学硕士学位论文，2011,6.
[44]傅言.过程计算机控制系统[M].西安:西北工业大学出版社，1995.
[45]张培仁，杨兴明.机器人系统设计与算法[M].合肥：中国科学技术大学出版社，2008.
[46]俞声伟，颜文俊.两轮小型移动机器人的底层运动控制器设计[J].机电工程，2006,9(23):38-40.
[2]常春阳.两轮电动车行走机构控制的相关问题研究[D].河南科技大学硕士学位学位论文，2005,6.
[3]王晓宇.两轮自平衡机器人的研究[D].哈尔滨工业大学博士学位论文，2007,12.
[4]李红美，李智，高飞.平衡的杰作—赛格威HT两轮平台电动车[J].电器工业，2002(6):19-21.
[5]孔祥宣.自主式双轮动态平衡移动机器人的控制系统研究[D].上海交通大学大学硕士学位论文，2007,2.
[6]王瑜.两轮自平衡机器人的控制技术研究[D].哈尔滨工程大学硕士学位论文，2009,3.
[7] A.Salerno, J.Angeles. The Control of Semi-Autonomous Two-Wheeled RobotsUndergoing Large Payload-Variations[J]. Proceedings of the2004IEEEInternational Conference on Robotics and Automation,2004,1740-1745.
[8] A.Salerno,J.Angeles.The Control of Semi-Autonomous Self-BalancingTwo-Wheeled Quasiholonomic Mobile Robots[J]. Preceedings of the15thCISM-IFTOMM Symposium on Robot Design,Dynamics and Control,2004,1-8.
[9] A.Salerno, S.Ostrovskaya and J.Angeles. The Development of QuasiholonomicWheeled Robots[J].Proceedings of the2002IEEE International Conference onRobotics and Automation,2002,3514-3520.
[10]张吉昌.单轴双轮自平衡代步车的研究与设计[D].中国海洋大学硕士学位论文，2009,6.
[11]郑钧元.两轮自我平衡机器人之平衡控制[D].国立中央大学硕士学位论文，2003,6.
[12]王祯祥.两轮自我平衡机器人之前后行走控制[D].国立中央大学硕士学位论文，2003,6.
[13]蔡侨伦.DSP主控之两轮机器人平衡与两轮同步控制[D].国立中央大学硕士学位论文，2004,6.
[14]陈家良.改良式DSP主控之两轮机器人基本控制[D].国立中央大学硕士学位论文，2005,6.
[15]李航,孙厚芳,韩建海，等.两轮机器人行走机构的建模与实验[J].北京理工大学学报,2004,24(12):1058-1061.
[16]韩建海,李航,白玉川，等.平行双轮电动车的建模与控制仿真[J].中国机械工程,2005,16(8):683-686.
[17]赵书尚，韩建海，李济顺，等.平行双轮电动车及其控制系统的研究[J].机电工程,2005,22:12-15.
[18]屠运武，徐俊艳，等.自平衡控制系统的建模与仿真[J].系统仿真学报，2004,16（4）:839-841.
[19]丛爽，张冬军，魏衡华.单级倒立摆三种控制方法的对比研究[J].系统工程与电子技术,2001,23(11):47-49.
[20] Boquete V, Garcia R, Barea R, etal. Neural Control of the Movement of aWheelchair[J]. Journal of Intelligent and Robotic Systerms,1999,25(3):213-216.
[21]世界首例倒立摆实物控制系统在我校试验成功[J].北京师范大学学报（自然科学版）,2002,(10):5-8.
[22] Brown SC, Passino KM. Intelligent Control for an Acrobot [J]. Jounal ofIntelligent and Robotic System,1997,18(2):209-248.
[23] http://v.youku.com/v_playlist/f3459594olp0.html.
[24]狄海江.两轮自平衡机器人中若干问题研究[D].北京工业大学硕士学位论文，2008,5.
[25]何礼高. dsPIC30F@电机与电源系列数字信号控制器原理与应用[M].北京航空航天大学出版社，2007.
[26] http://www.xie-gang.com/PT22622272.htm.
[27] http://www.pcbwork.net/down/1764.pdf.
[28] http://wenku.baidu.com/view/4fe72e28915f804d2b16c123.html.
[29] http://www.docin.com/p-41278663.html.
[30] http://wenku.baidu.com/view/a7e63aa3b0717fd5360cdc1e.html.
[31] http://www.soiseek.cn/MURATA/ENC-03R/.
[32]陈扬.自动导引车系统（AGVS）的设计与实现[D].南京理工大学硕士学位论文，2007,7.
[33]袁泽睿.两轮自平衡机器人控制算法的研究[D].哈尔滨工业大学硕士学位论文，2006,6.
[34] Katsuhiko Ogata，卢伯英，于海勋，等.现代控制工程[M].电子工业版社，2003.
[35]赵世敏.倒立摆控制系统实验指示书[R].清华大学自动化系，2007,3.
[36]刘璟，梁昔明.LQR控制与PID控制在单级倒立摆中的对比研究[J].自动化技术与应用,2007,26(1):13-14,17.
[37]阮晓钢，刘江，狄海江，李欣源，赵建伟.两轮自平衡机器人系统设计、建模及LQ控制[J].现代电子技术,2008.18(281):57-60.
[38]杨平,徐春梅,曾婧婧,等.PID控制在倒立摆实时控制系统中的应用[J].微计算机信息,2006,22(7-1):83-85.
[39]杨平,徐春梅,贺茂康,等.直线二级倒立摆的PID实时控制[J].上海电力学院学报,2008,2(2):236-238,247.
[40]刘金琨.先进PID控制MATLAB仿真（第2版）[M].北京:电子工业出版社，2004.
[41]陶永华.新型PID控制及其应用（第3版）[M].北京:机械工业出版社，2002.
[42]胡寿松.自动控制原理（第四版）[M].北京:科学出版社，2001.
[43]杨丹明.基于路径跟踪的移动机器人导航控制系统设计[D].苏州大学硕士学位论文，2011,6.
[44]傅言.过程计算机控制系统[M].西安:西北工业大学出版社，1995.
[45]张培仁，杨兴明.机器人系统设计与算法[M].合肥：中国科学技术大学出版社，2008.
[46]俞声伟，颜文俊.两轮小型移动机器人的底层运动控制器设计[J].机电工程，2006,9(23):38-40.