基于动力学模型的轮式移动机器人电机控制

Dynamic Model Based Motor Control for Wheeled Mobile Robots

  • 摘要: 针对移动机器人两路电机协同控制问题,提出基于动力学模型的轮式移动机器人电机控制律(DMMC).首先推导出质心位置不一定在几何中心的移动机器人运动学模型和动力学模型,并求解出两轮速度与力矩之间的非线性微分方程.然后,基于两轮速度与力矩间非线性微分方程、电机电气方程和电机机电方程,推导出移动机器人系统状态方程.最后采用极点配置得到I型状态反馈控制律.仿真显示,DMMC法实现了对输入指令的零稳态误差快速响应.

     

    Abstract: A novel motor control law based on dynamic model(DMMC) is proposed for wheeled mobile robot to control its two driving motors synchronously.First,kinematic model and dynamic model of the mobile robot,of which the mass center position is arbitrary,are derived,and the nonlinear differential equation of speeds and torques of the two wheels is derived.And then,system state equation of the mobile robot is derived based on the nonlinear differential equations of speeds and torques,electrical equations and electrical-mechanical equations of the two driving motors.Finally,the pole placement method is used to form a type I state feedback control law.Simulation shows that the DMMC controller can respond to the input instructions quickly without static error.

     

/

返回文章
返回