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