移动机器人运动学.pptxVIP

会计学;3.2 运动学模型和约束 为整个机器人运动推导一个模型，是一个由底向上的过程。我们必须用相对清晰和一致的参考框架来表达各轮的力和约束，由于移动机器人的独立和移动本质，需要在全局和局部参考框架之间有一个清楚的映射。;3.2.1 机器人位置的表示 在整个分析过程中，我们将机器人建模成轮子上的一个刚体，运行在水平面上。 为了确定机器人在平面中的位置，我们建立了平面全局参考框架和机器人局部参考框架之间的关系如图所示;全局参考框架和局部参考框架;(XI,YI)为全局参考框架 (XR,YR) 为机器人的局部参考框架，相对于机器人底盘上的P点 在全局参考框架下，P点的位置由坐标x和y确定，全局框架和局部框架的角度差由θ表示。 机器人的姿态可由这三个元素组成的向量来描述，即在全局参考框架下该姿态的基为： ; 为了根据分量的移动描述机器人的移动，需要将全局参考架下的运动映射到局部参考框架下的运动。该映射可由正交旋转矩阵来完成。;举例：;给定在全局参考框架下某个速度 ，我们可以计算沿机器人局部参考框架轴XR和YR的运动分量。;3.2.2 前向运动学模型 给定机器人的几何特征和它的轮子速度，机器人如何运动？即前向运动学模型。 该差动机器人有2个轮子，半径为r，给定中心处为两轮之间的点P，各轮距P的距离为l。 给定r,l,θ和各轮的转速，前向运动学模型会预测全局参考框架中机器人的总速度： ; 建模策略：首先计算在局部参考框架下各轮对机器人运动的贡献，然后再将其影射到全局参考框架下。 首先，考虑在+XR方向上各轮的转动速度对点P的平移速度的贡献。 计算如果一轮旋转，而另一轮无贡献且不动，则点P的平移速度为 ;其次，计算在YR 方向的贡献 由于没有一个轮子可以提供侧向运动，所以沿YR 方向的速度总是零。 最后，计算旋转角速度分量。可独立的计算各轮的贡献，且只要简单相加即可。 ;联合式（1）和式（2）得到差动驱动机器人的运动学模型如式（3）所示： ;其中： ;举例：; 在全局参考框架下，机器人沿着y轴，以速度1旋转的同时以速度3瞬时的移动。另外，机器人沿x轴的速度为零。 给定各轮的速度，用运动学建模（各轮对运动的贡献）的方法，可提供有关机器人移动的信息。然而，我们希望，对于所有机器人的地盘结构，要确定机器人可能运动的空间。所以需要进一步描述各轮加到机器人运动上的约束。;3.2.3 轮子运动学约束 两点假设： 轮子的平面总是和地面保持垂直，并且在任何时候，轮子和地面之间只有一个单独的接触点。 该接触点无滑动，即只存在纯滚动。 两个约束： 轮子平面的滚动约束。 垂直于轮子平面的滑动约束。 ;固定标准轮和它的参数; 固定标准轮A的位置用机器人局部参考框架下的极坐标（ l ，α）来表示。轮子平面相对于底盘的角度用β表示，该角度为固定值。具有半径r的轮子在轮子平面内可自由转动。;固定标准轮约束示意图; 固定标准轮的滚动和滑动约束方程：;举例：; ; 可操纵的标准轮的滚动和滑动约束方程如下： ;小脚轮运动学约束;小脚轮的滚动和滑动约束方程：;瑞典轮运动学约束;瑞典轮的滚动和滑动约束方程为：; 小结：对于小脚轮、瑞典轮和球形轮，由于其内部的自由度，并未对机器人的运动施加实质上的约束，即机器人可在全局参考框架下自由运动。也就是说，只有固定标准轮和可操纵标准轮会对机器人的运动施加约束。;3.2.4 机器人运动学约束 给定一个具有M个轮子的机器人， 假定机器人总共有N个标准轮，由Nf个固定标准轮和Ns个可操纵标准轮组成。βs(t)表示可操纵标准轮的可变操纵角。βf表示固定标准轮的方向。 ;滚动约束：;上述表达式对单个轮子的滚动和滑动约束具有强的相似性，但矩阵代替了单个值，因此把全部轮子的约束都考虑进去了， 表示一个投影矩阵，它将机器人局部参考框架下的运动投影到沿着各个轮子平面上的运动。 也表示一个投影矩阵，它将机器人局部参考框架下的运动投影到各个轮子的法平面内。;举例：;将上式求逆，得到特定的差动驱动机器人的运动学方程：; 一个有3个90度瑞典