关于珞石机器人二次开发SDK的posture函数的算法RX RY RZ纠正 C#
创始人
2024-12-15 18:37:47
0

在珞石SDK二次开发的函数钟,获取当前机器人位姿的函数posture函数在输出时会发现数据不正确,与示教器数据不一致。

其中第一个数据正确 第二三各数据为相反 第四五六各数据为弧度制

转换方法为(弧度/PI)*180度

然后发现第四个数据还要加上180度

第五六各数据要取反,,所以设计了以下代码

void(){ ErrorCode ec; Lamp1.IsHighlight =  robot.getDO(1, 1, out ec); Lamp2.IsHighlight = robot.getDO(1, 11, out ec); Lamp3.IsHighlight = robot.getDO(1, 12, out ec); Lamp4.IsHighlight = robot.getDO(1, 13, out ec); Lamp5.IsHighlight = robot.getDO(1, 14, out ec); Lamp6.IsHighlight = robot.getDO(1, 15, out ec); Lamp7.IsHighlight = robot.getDO(1, 16, out ec); //创建新数组保存数据 double[] aa=new double[6]; aa[0] = robot.posture(CoordinateType.endInRef, out ec)[0]*1000;//TX aa[1] = -robot.posture(CoordinateType.endInRef, out ec)[1] * 1000;//TY aa[2] = -robot.posture(CoordinateType.endInRef, out ec)[2] * 1000;//TZ aa[3] = robot.posture(CoordinateType.endInRef, out ec)[3];//RX aa[4] = robot.posture(CoordinateType.endInRef, out ec)[4];//RY aa[5] = robot.posture(CoordinateType.endInRef, out ec)[5];//RZ  double pi = 3.14159265354; double rad = 180; //二次转换 aa[3]= 180+(aa[3]*rad)/pi; aa[4]= -(aa[4]*rad)/pi; aa[5]= -(aa[5]*rad)/pi; label1.Text = "当前位置:"+aa[0].ToString("0.000")+','+aa[1].ToString("0.000") + ',' + aa[2].ToString("0.000") + ',' + aa[3].ToString("0.000") + ',' + aa[4].ToString("0.000") + ',' + aa[5].ToString("0.000"); label2.Text = "坐标系:" + String.Join(",",robot.baseFrame(out ec)); label3.Text = "关节位置:" + String.Join(",",robot.jointPos(out ec)); }

相关内容

热门资讯

经调查!八仙竞技馆辅助,hhp... 您好,hhpoker辅助实战视频这款游戏可以开挂的,确实是有挂的,需要了解加去威信【13670430...
目前!广西友玩修改器,微信小程... 目前!广西友玩修改器,微信小程序微乐辅助器,线上教程(确实真的是有挂)-哔哩哔哩1、微信小程序微乐辅...
据报道!茶馆游戏辅助,家乡大二... 据报道!茶馆游戏辅助,家乡大二辅助,可靠教程(一直真的是有挂)-哔哩哔哩小薇(透视辅助)致您一封信;...
截至目前!四川游戏家园辅助软件... 截至目前!四川游戏家园辅助软件,佛手在线做辅助下载,必胜教程(好像有挂)-哔哩哔哩1、在四川游戏家园...
据通报!手机南通长牌辅助,微信... 据通报!手机南通长牌辅助,微信小程序财神十三脚本,技巧教程(确实真的是有挂)-哔哩哔哩1、点击下载安...
据了解!天天微友有辅助吗,兴动... 据了解!天天微友有辅助吗,兴动助手脚本,解密教程(一直真的是有挂)-哔哩哔哩1、天天微友有辅助吗机器...
现场直击!蜜瓜大厅辅助免费下载... 您好,蜜瓜大厅辅助免费下载这款游戏可以开挂的,确实是有挂的,需要了解加去威信【136704302】很...
今日!微信小程序功夫川麻小程序... 今日!微信小程序功夫川麻小程序辅助,传送屋高仿版辅助,攻略教程(切实真的是有挂)-哔哩哔哩1、微信小...
刚刚!中至鹰潭亲友圈辅助,约局... 刚刚!中至鹰潭亲友圈辅助,约局吧可以看到别人底牌,教你攻略(都是是真的挂)-哔哩哔哩1、约局吧可以看...
有玩家发现!广东雀神智能插件是... 有玩家发现!广东雀神智能插件是真有挂,赣牌圈的隐藏机制,攻略教程(切实是有挂)-哔哩哔哩1、不需要A...