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

相关内容

热门资讯

今日焦点!新九方辅助,樱花之盛... 您好:樱花之盛辅助软件下载这款游戏可以开挂的,确实是有挂的,很多玩家在这款游戏中打牌都会发现很多用户...
实测教程!九游破解辅助插件官方... 实测教程!九游破解辅助插件官方,新荣耀辅助软件,安装教程(有挂秘笈)是一款可以让一直输的玩家,快速成...
科技通报!神兽h5平台反杀,道... 科技通报!神兽h5平台反杀,道游互娱透视辅助截图,玩家教你(了解有挂);1、科技通报!神兽h5平台反...
科技通报!新道游辅助器免费版,... 科技通报!新道游辅助器免费版,随意玩app下载开挂辅助,黑科技教程(果真有挂)是一款可以让一直输的玩...
玩家科普!人海大厅挂件怎么买,... 您好,人海大厅挂件怎么买这款游戏可以开挂的,确实是有挂的,需要了解加微【136704302】很多玩家...
教程辅助!青龙辅助3.0,道游... 您好,道游互娱辅助这款游戏可以开挂的,确实是有挂的,需要了解加微【136704302】很多玩家在这款...
我来教大家!财神13章脚本安全... 您好,财神13章脚本安全吗这款游戏可以开挂的,确实是有挂的,需要了解加微【136704302】很多玩...
技巧知识分享!新西部辅助是什么... 技巧知识分享!新西部辅助是什么意思,微信财神十三张脚本,透视教程(有挂透视)是一款可以让一直输的玩家...
科普攻略!三哥玩摆头注可以控制... 科普攻略!三哥玩摆头注可以控制,新九哥辅助开挂,科技教程(有挂分享)是一款可以让一直输的玩家,快速成...
我来教教大家!九酷众游辅助,新... 我来教教大家!九酷众游辅助,新星游辅助真的假的,2025新版教程(有挂解密)是一款可以让一直输的玩家...