当前位置: 首页>>代码示例>>Python>>正文


Python PyKDL.changeRefPoint方法代码示例

本文整理汇总了Python中PyKDL.changeRefPoint方法的典型用法代码示例。如果您正苦于以下问题:Python PyKDL.changeRefPoint方法的具体用法?Python PyKDL.changeRefPoint怎么用?Python PyKDL.changeRefPoint使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在PyKDL的用法示例。


在下文中一共展示了PyKDL.changeRefPoint方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。

示例1: ChainJntToJacSolver

# 需要导入模块: import PyKDL [as 别名]
# 或者: from PyKDL import changeRefPoint [as 别名]
# differential kinematics

jac  = ChainJntToJacSolver(chain)
jac2 = ChainJntToJacSolver(chain2)

j   = Jacobian(7)
j2  = Jacobian(7)
j2b = Jacobian(7)
jx  = Jacobian(7)
jxb  = Jacobian(7)

kdl.SetToZero(j)
kdl.SetToZero(j2)
kdl.SetToZero(jx)


jac.JntToJac(joints, j)
jac2.JntToJac(joints, j2)

#########################
fr2 = f*frame
kdl.changeRefPoint(j, fr2.p - f.p, jx)
assert(equal(j2, jx))
# transform to base frame
kdl.changeRefPoint(j2, -f2.p, j2b)
kdl.changeRefPoint(j, -f.p, jxb)

assert(equal(j2b, jxb))
#########################

开发者ID:airballking,项目名称:feature_constraints_controller,代码行数:31,代码来源:kdl_testing.py


注:本文中的PyKDL.changeRefPoint方法示例由纯净天空整理自Github/MSDocs等开源代码及文档管理平台,相关代码片段筛选自各路编程大神贡献的开源项目,源码版权归原作者所有,传播和使用请参考对应项目的License;未经允许,请勿转载。