A求取机器人末端位姿B求取机器人关节变量C求取机器人工作空间D用以实现机器人控制