CS未直接提供基于用户坐标系的偏移
可以使用以下代码,配合上图的图形化编程,实现基于 坐标系1的x方向0.2m的偏移。 在图形化界面中,记录的例如上图的路点_1均为基于base坐标系
def Offs(p,x,y,z,user=[0,0,0,0,0,0]): # 传入的p是基于base坐标系的 out = p.copy() out_in_user = pose_trans(pose_inv(user),out) # 得到在用户坐标系下的值 out_in_user[0] = out_in_user[0]+x out_in_user[1] = out_in_user[1]+y out_in_user[2] = out_in_user[2]+z out = pose_trans(user,out_in_user) # 返回的是计算后,转化回base坐标系下的值 return out