关于珞石机器人二次开发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)); }

相关内容

热门资讯

aapoker挂!wepoke... aapoker挂!wepoke黑科技(透视)本来是有挂(详细辅助重要通知)1、完成wepoke黑科技...
透视存在!智星菠萝可以辅助吗,... 透视存在!智星菠萝可以辅助吗,hhpoker开辅助软件,2025新版总结(有挂技巧)运智星菠萝可以辅...
透视系统!wepoker免费透... 透视系统!wepoker免费透视脚本,aapoker透视插件,每日必看(有挂黑科技);人气非常高,a...
wepoker底牌透视脚本怎样... wepoker底牌透视脚本怎样安装!hhpoker哪个俱乐部靠谱(透视)真是真的有挂(曝光教程)hh...
wepoke插件!aapoke... 自定义aapoker辅助工具系统规律,只需要输入自己想要的开挂功能,一键便可以生成出微扑克专用辅助器...
智星德州辅助译码插件靠谱吗!w... 智星德州辅助译码插件靠谱吗!wepoker透视脚本安卓(透视)确实是有挂(存在挂教程)1、智星德州辅...
透视辅助!wepoker透视脚... 透视辅助!wepoker透视脚本免费下载,aapoker辅助插件工具,解密教程(有挂解密)1、wep...
透视能赢!aapoker辅助包... 您好,wpk透视辅助靠谱吗这款游戏可以开挂的,确实是有挂的,需要了解加微【136704302】很多玩...
德扑ai助手!wpk辅助挂(透... 您好,德扑ai助手这款游戏可以开挂的,确实是有挂的,需要了解加Q群【1067239143】很多玩家在...
德普之星辅助器!wepoker... 德普之星辅助器!wepoker辅助器有哪些功能(透视)其实是有挂(解密教程)运wepoker辅助器有...