CS中基于用户坐标系偏移的脚本


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
点击显示全文
赞同0
发表评论
分享

手机扫码分享
0
927
收藏
举报
收起
登录
  • 密码登录
  • 验证码登录
还没有账号,立即注册
还没有账号,立即注册
注册
已有账号,立即登录
选择发帖板块
上传文件
举报
请选择举报理由
举报
举报说明