我们采用这样的一个体系，即存在着一个世界坐标系，我们所定义的位姿都是参照世界坐标系或者由世界坐标系定义的笛卡尔坐标系。
1.位姿表示
位姿描述：
在机器人学中，位置和姿态经常成对出现，于是我们将此组合称作位姿，4个矢量成一组，表示了位置和姿态信息。并用它们来描述坐标系，即一个坐标系可以等价地用一个位置矢量和一个旋转矩阵来描述。
位置：x、y、z坐标
姿态：刚体与OX轴的夹角rx、与OY轴的夹角ry、与OZ轴的夹角rz
假设基坐标系为OXYZ，刚体坐标系为O`X`Y`Z`。对于机器人而言，空间中的任何一个点都必须要用上述六个参数明确指定，即(x,y,z,rx,ry,rz)，即便(x,y,z)都一样，(rx,ry,rz)不同代表机器人以不同的姿态去到达同一个点。
刚体的位置可以用一个3x1的矩阵来表示，即刚体坐标系中心O`在基坐标系中的位置，即
刚体的姿态可以用一个3x3的矩阵来表示，即刚体坐标系在基坐标系中的姿态，即
