【技术实现步骤摘要】
一种基于自适应比例同步的电动四轮驱动小车控制方法
[0001]本专利技术属于电动四轮驱动小车控制领域,具体涉及一种基于自适应比例同步的电动四轮驱动小车控制方法。
技术介绍
[0002]电动驱动四轮小车在物流、消防、巡检等领域具有广阔的应用前景。受电池容量以及机身总负载约束,一般电动小车结构尽可能简单,降低电机质量。而质量较轻的电机通常输出力矩不大。因此,电动驱动四轮小车领域常常采用无差速机构的四电机驱动的控制方法。该方法不需要复杂的差速机构,降低成本,减少小车负荷;四轮驱动,驱动力由四个车轮提供,降低了对电机驱动力矩要求,降低电机成本,降低电机重量。因此,无差速机构的电动四轮驱动方式在四轮小车控制领域被大量采用。
[0003]四轮驱动小车行驶路面可能遇到各种情况,比如路面不平、倾斜、转弯等,这就要求小车的四个轮子转动能满足路面要求。也就是要求小车能够根据路面情况自动调整四个驱动轮的转速比。如果四个驱动轮有一个或者多个驱动轮不能满足转速比要求,那么就可能由驱动轮变为被动轮,出现车轮打滑、空转等现象。驱动轮的减少势必增加...
【技术保护点】
【技术特征摘要】
1.一种基于自适应比例同步的电动四轮驱动小车控制方法,其特征在于:包括如下步骤:步骤1:根据小车结构建立机身坐标系,坐标原点设在机身质心,x方向为小车前进方向,z方向为小车竖直线上,根据右手法则确定y方向;在机身坐标系下,根据机械结构尺寸确定四个驱动轮轴心在机身坐标系下位置矢量;步骤2:实时读取机身位置姿态传感器信息,获取当前时刻t世界坐标系下当前机身位置、世界坐标系绕x,y,z轴旋转的姿态角度以及相应的速度和角速度;步骤3:根据世界坐标系下机身位置和姿态信息,利用坐标变换关系式计算小车四个驱动轮世界坐标系下位置信息;建立当前时刻t驱动轮轴心l与机身速度、角速度变化关系式;步骤4:根据变化关系式计算轴心速度矢量的模v
l
(t);设车轮输出控制间隔时间为dt,结合当前时刻t的机身位置、姿态计算t+dt时刻机身位置、姿态;步骤5:计算小车车轮轴心在t+dt时刻的速度和驱动轮速度增量Δv
l
(t+dt);根据驱动轮速度增量实时更新四个驱动轮转速;步骤6:根据得到的转速进行控制,各驱动轮驱动力矩均衡;读取各驱动轮力矩传感器参数T
l
(t),求力矩均值T(t),并计算各驱动轮力矩波动系数η
l
(t),如果η
l
(t)都在波动允许范围内,则跳转到步骤1,否则跳转到步骤7;步骤7:根据波动系数η
l
(t)建立模糊隶属度函数ζ
l
(t);修正驱动轮转速v
l
(t+dt)=v
l
(t)+Δv
l
(t+dt)
‑
ζ
l
(t)Δv
l
(t+dt);转向步骤1,重复运行,直到小车停止运动...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。