假设我有一个简单的摆锤连接到 sdf 文件中定义的四旋翼。
当我将此 sdf 文件加载到 aMultibodyTree
中时,默认的连续状态向量的大小为 4(四元数)+ 3(x,y,z)+ 1(将四旋翼连接到摆锤的关节)= 8,如this answer所示。
默认情况下,urdf/sdf 解析器为系统添加基于四元数的浮动基数。
我的问题是,我怎么知道这个 4 (quaternion) + 3 (x, y, z) 框架的附加位置?
以及如何控制它的附着位置?假设我的运动方程与钟摆的尖端有关,我希望这个 4 + 3 四元数浮动底座连接到我的钟摆尖端,我将如何定义它?