KDL中提供了点(point).坐标系(frame).刚体速度(twist),以及6维力/力矩(wrench)等基本几何元素,具体可以参考 Geometric primitives 文档. Creating a Frame, Vector and Rotation PyKDL中创建一个坐标系时有下面4种构造函数: __init__() # Construct an identity frame __init__(rot, pos) # Construct a frame from a rotat…