速度分析
建立三輪底盤的速度物理學模型如圖所示。
其中v1、v2、v3分別爲三個輪子的轉速,ω爲旋轉角速度,vx、vy爲車身座標系中的速度即相對速度(由於底盤速度性能與在世界座標系中的姿態無關,因此此處爲簡化運算,取車身座標系與世界座標系X,Y方向重合),a爲旋轉中心到輪軸心的垂直距離,θ爲輪軸與x軸夾角,θ=π/6。不難得出各輪速度的轉換矩陣爲:
記vT=[v1v2v3]VT=[vxvyω]轉換矩陣爲R則有
vT=R VT
R−1vT= VT
即
所以
Vmax=vx2+vy2=94(v12+v22+v32−v1v2−v1v3−v2v3)
其中{v1,v2,v3}∈[−vm,vm,]
又由不旋轉的條件可知
ω=3a1(v1+v2+v3)=0
即
v1+v2+v3=0
由以上兩式,構造非線性規劃模型,用MATLAB求解得:
直線行走的最大速度
Vmax=32vm
各方向速度圖像:
分析可知,三輪底盤當沿着一個輪軸方向前進時,速度可取到平動的最大值32vm
加速度分析
假設啓動階段驅動電機處於恆轉矩模式,即各輪驅動力恆定,建立三輪底盤的驅動力物理學模型如圖所示。
其中f1、f2、f3分別爲三個輪子的驅動力,α爲角加速度,ax、ay爲車身座標系中的加速度即相對加速度(由於底盤速度性能與在世界座標系中的姿態無關,因此此處爲簡化運算,取車身座標系與世界座標系X,Y方向重合),a爲旋轉中心到輪軸心的垂直距離,θ爲輪軸與x軸夾角,θ=π/6。不難得出驅動力與加速度之間的轉換矩陣爲:
利用與上述相同的方法,可以得到加速度在各個方向上的極值,如下圖:
因此,對三輪底盤來說,最大速度和最大加速度均發生在與一個輪軸重合的方向上。
非線性歸劃求極值MATLAB源碼