两轮差速机器人运动学研究及控制探究.docVIP

两轮差速机器人运动学研究及控制探究摘 要：对两轮差速机器人的运动控制进行分析，建立了输入/输出量之间的函数隶属关系，在建立轮式机器人的运动学模型和动力学模型基础上，为实际研究提供可行性指导和理论依据。同时为博创平台的差速机器人运动控制提出新的思路，即基于模糊控制的机器人路径跟踪。将增量式PID控制算法及模糊控制策略结合起来，应用于两轮差速机器人的运动控制模型中，并运用Matlab进行仿真，得到了控制系统的响应曲线，达到了满意的效果。 关键词：差速机器人； 模糊控制； Matlab仿真； 增量式PID控制 中图分类号：TN91134 文献标识码：A 文章编号：1004373X(2012)10009304 Kinematic analysis and control of twowheel differential robot WANG Weixin (Department of Machinery and Electron Engineering, Xian University of Arts and Science, Xi’an 710065, China) Abstract： The motion control of the two wheel differential robot is analyzed. The function affiliation between the input and output quantities is established. The establishment of the kinematics model and dynamics model of wheeled robot provided the feasibility guidance and theoretical basis for practical research. A new way based on path tracking of the fuzzy control robot is put forward for the motion control of differential robot on Bogen platform. The combination of the incremental PID control algorithm with fuzzy control strategy is used to the motion control model of twowheel differential robot. The response curve of the control system was obtained by simulation with Matlab and a satisfactory result was achieved. Keywords： differential robot; fuzzy control; Matlab simulation; incremental PID control -------------------------------------------------------------------------------- 收稿日期：20111211 基金项目：西安市科技计划项目（CXY1134WL39） 随着高技术的发展，机器人技术的应用领域不断扩大，工业机器人 、特种作业机器人、服务机器人、微小型机器人等已经在各个方面得到广泛的应用和发展。两轮差速机器人涉及到多个应用领域，对两轮差速机器人的运动控制研究成为主要的课题。 1 两轮驱动差速机器人的运动学分析 对轮式移动机器人，做路径和轨迹时，一般是以独立驱动轮的轮基中点为基点来进行的。在实时控制中，轨迹产生器把规划好的路径转变成随时间变化的两个独立驱动轮的角速度，通过控制器，分别去控制两个驱动轮。 1.1 运动学正问题 当两驱动轮的角速度已知的情况下，假设左右两驱动轮角速度分别为r和l，曲率半径也是关于t的函数，所以可以求出移动机器人的运动轨迹：xR?=rcos(θ+α)qr? （1） yR?=rsin(θ+α)ql? （2） θ=r/（Lqr?）－r/（Lql?） （3）1.2 运动学逆问题 机器人按确定轨迹运动时，已知左右两轮的速度以及θ（t）已知驱动轮的运动规律可知是惟一的，那么算的机器人的角速度如下：q?=1rx?(t)2+y(t)2? （4） q?l=q?r－Lθ/r=q?－Lθ/r （5）1.3 两轮驱动差速机器人的