1.三轮全向移动底盘运动学解析

  1. 三轮图片示意图

2.三轮理解

三轮全向移动底盘因其良好的运动性并且结构简单,近年来备受欢迎。三个轮子互相间隔120°,每个全向轮由若干个小滚轮组成,各个滚轮的母线组成一个完整的圆。机器人既可以沿轮面的切线方向移动,也可以沿轮子的轴线方向移动,这两种运动的组合即可以实现平面内任意方向的运动。

3.运动学分析


为便于运动学分析,我们以理想情况为基础,三个轮子相对于车体的中轴线对称,且物理尺寸重量等完全一致;上层负载均衡,机器人的重心与三个轮子转动轴线的交点重合;三个轮体与地面摩擦力足够大,不会发生打滑现象;机器人中心到三个全向轮的距离相等。
定义绝对坐标系 XOY,机器人自身坐标系 X’O’Y’。机器人的姿态角为 θ,即机器人自身坐标相对于绝对坐标的旋转角度。机器人自身旋转的角速度设为 W。 L 为三个轮子相对于机器人中心的距离, VA VA, VB VB, VC VC 分别表示三个轮子沿驱动方向的速度;角度 ψ 为 轮子与机器人坐标系 X 轴的夹角,这个夹角我们可以算出为 60°。我们假定机器人在任意时刻的速度为  V=[Vx,Vy,W] V=[Vx,Vy,W],其中  Vx Vx 和  Vy Vy 分别为机器人在自身坐标系下的 X 轴 Y 轴方向的速度,W 为机器人运动的角速度,假定顺时针方向为正方向。那么可得出机器人运动学方程:
VA=Vx+LW VA=Vx+LW
VB=Vxcosψ+Vysinψ+LW VB=−Vxcosψ+Vysinψ+LW
VC=VxcosψVysinψ+LW VC=−Vxcosψ−Vysinψ+LW

写成矩阵形式为:
VAVBVC=1cosψcosψ0sinψsinψLLLVxVyW [VAVBVC]=[10L−cosψsinψL−cosψ−sinψL][VxVyW]
车轮的线速度还可以表示为:
VA=RωA VA=RωA
VB=RωB VB=RωB
VC=RωC VC=RωC
式中 R 为全向轮的半径,ω 为全向轮旋转角速度,因此得出:
ωAωBωC=R11cosψcosψ0sinψsinψLLLVxVyW [ωAωBωC]=R−1[10L−cosψsinψL−cosψ−sinψL][VxVyW]
以上是机器人在自身坐标系下的运动学方程,实际应用中还需要转换为全局坐标系,上图中机器人自身坐标与全局坐标的夹角为 θ,假设机器人在全局坐标系中的速度为
Vg=[Vgx,Vgy,Wg] Vg=[Vgx,Vgy,Wg]
那么可以推出:
Vgx=VxcosθVysinθ Vgx=Vxcosθ−Vysinθ
Vgy=Vxsinθ+Vycosθ Vgy=Vxsinθ+Vycosθ
因此可以推出机器人相对于自身坐标下的速度  V=[Vx,Vy,W] V=[Vx,Vy,W] 与机器人相对于全局坐标下的速度  Vg=[Vgx,Vgy,Wg] Vg=[Vgx,Vgy,Wg] 之间的变换关系:

R(θ)=cosθsinθ0sinθcosθ0001 R(θ)=[cosθ−sinθ0sinθcosθ0001]

因此两个坐标系下的变换可写成:

VgxVgyWg=cosθsinθ0sinθcosθ0001VxVyW



猜你喜欢

转载自blog.csdn.net/ycy_dy/article/details/78353894
今日推荐