中国机器人网 App
手机扫码下载 · 或点击查看
现场一台发那科R-30iB,手动示教完一个点,把光标打到位置行一看,XYZ数值跟我手摇示教器走的距离对得上,但旁边PR[姿态]那行的W、P、R跟关节角算出来的姿态差了快15度,重新示教一次还是这样。
不是新机子,用了三年多,一直没问题,最近换了一次抓手,碰撞复位后就这样。点位数据是从别的机型备份导过来的,会不会是这个原因?有人碰到过类似情况吗?
姿态行差15度基本就是四元数被改了。打开那个点位,看一下PR[1]到PR[9]前几位,正常前三位是正负1之间的数(cos分量),要是被改成大于1或者接近0的离谱值,就是导数据的时候坐标系被处理过。
处理办法两条:
1、直接在示教器里把这个点位删掉,重新示教一遍,最省事;
2、如果点位很多不想重教,进变量界面把PR行那9个数手动改回去,用别的正常的点位作参照,把WPR回填进去然后系统会自己算四元数。
另外碰撞复位后姿态漂移我也遇到过,机械手撞击后编码器零点实际偏了零点几度,单纯重示教短期能糊弄,但建议查一下零点。
兄弟你导数据的时候用的FSSB参数带没带过来?如果带了老机型的SOP文件,PR[姿态]行的解释规则不一样,30iB和30iA、30iB Mate的格式是有差别的。你可以先在系统变量里查一下$SCR_GRP[1].$M_POS_ENB这个参数,确认姿态是用PR存还是用JPOS存。
直接说,不一定是软件问题。你换完抓手之后,是不是动过工具坐标系?工具坐标系不对的话,TCP实际位置和你算出来的姿态对不上,XY看着差不多但姿态偏差大是常见的。把工具坐标系重新标一下,跑一下精度验证程序再说。