专利名称：一种基于psd的工业机器人自标定方法及装置的制作方法
技术领域：
本发明属于エ业机器人的标定技术领域，尤其涉及一种基于PSD和激光虚拟约束线的6自由度エ业机器人零位偏差及空间位姿自标定方法及装置。
背景技术：
随着工业机器人在エ业生产中应用范围以及所完成任务复杂程度的不断扩大，对エ业机器人位姿精度的要求也越来越高。目前，大多数商品化的机器人重复精度很高，能达到0. Imm数量级，但其定位精度却很差，只能达到Cm数量级，这样的定位精度远远不能满足现代エ业发展的要求。导致エ业机器人定位精度不高的原因有很多，例如机器人运动学模型的參数偏差、机器人杆件的弹性变形、齿轮传动误差、关节间隙以及环境因素等，对于不同结构、不同用途的机器人，以上各因素的影响也不尽相同。但一般来讲，机器人运动学模 型中几何结构參数偏差所引起的定位误差占机器人总误差的80%左右。因此，对机器人运动学模型进行偏差标定补偿进而提高其定位精度是目前机器人技术领域内急需解决的问题。所谓标定就是应用先进的测量手段和基于模型的參数识别方法辨识出机器人模型的准确參数，从而提高机器人定位精度的过程。标定的结果是一组被识别的机器人參数，这些參数可以供机器人生产厂家作为产品质量检验指标，也可以帮助机器人用户提高机器人的定位精度。近年来，为了提高工业机器人的定位精度，国内外学者相继提出了一些标定方法，这些方法大致可以分为以下三种第一种方法是利用ー些高精度的测量设备来获取机器人末端精准的位置与姿态，例如三坐标测量机、电子经纬仪、球杆仪等。上述这些测量仪器在精度、成本及是否容易使用等方面有很大差异，但均具有需要专业的技术人员来操作这些仪器、数据采集费时费力、难以实现自动化、成本高、測量方法繁琐等缺点；第二种方法是增加外部冗余传感器，通过传感器提供的信息来实现机器人运动学參数的自标定，例如利用安装于机器人末端的摄像头对机器人运动学參数进行了自标定，但是使用视觉传感器的问题在于摄像机本身需要标定，而且由于视野和分辨率之间的矛盾导致很难获得较高的測量精度。第三种方法通过在机器人工作空间施加位置已知或形状已知的物理约束，利用机器人末端与这些约束接触，形成运动学闭合链并建立约束方程来求解运动学參数，例如中国发明专利号为CN101968341A所公开的ー种エ业机器人零位自标定方法及装置，其首先将ー个PSD器件任意放置在机器人可达工作空间，然后仅依赖于通过机器人末端的一束激光以不同位置自动定位投射在该PSD的中心点即可实现机器人的标定任务，但采用此种方法只能进行零位偏差自标定，不能进行机器人空间位姿的自标定，并且进行零位偏差自标定时，需要机器人末端或激光器从至少7个不同的方位将光斑投射到PSD的中心，因此标定过程复杂。由上述可见，研发适合机器人工作现场、便于携带并且成本低廉的机器人自标定方法及装置，已经成为机器人应用企业迫切需要解决的难题。
发明内容
本发明的目的就是为了解决上述现有技术存在的问题，提供一种基于PSD的エ业机器人自标定装置，其结构简単，价格便宜，安装与操作简单，定位精度高，可同时实现机器人空间位姿与零位偏差的自标定；本发明还提供一种基于PSD的エ业机器人自标定方法。为实现上述目的，本发明的基于PSD的エ业机器人自标定装置包·括机器人；安装在机器人末端的激光器；设置于机器人可达工作空间内的V形夹具；分别安装在V形夹具的两个板上的两个位置敏感器件PSD，即第一 PSD和第二 PSD，其中，机器人在不同位置吋，激光器发出的激光束投射在第一 PSD或第二 PSD上，以便形成投射光斑和反射光束，且反射光束投射到第二 PSD或第一 PSD上，形成反射光斑；与第一 PSD和第二 PSD分别连接的机器人闭环控制単元，其将所述投射光斑和反射光斑分别定位在第一 PSD或第二 PSD的中心点位置，并确定对应的机器人末端的位置和机器人的6个关节角度值，以便通过点线关系，建·立两条虚拟约束线的几何方程组，从而实现机器人零位偏差自标定和空间位姿自标定；其中，所述两条虚拟约束线为第一 PSD和第二 PSD中心点连线分别在第一 PSD和第二 PSD表面反射所形成的反射线。其中，所述机器人闭环控制単元包括与所述第一 PSD和第二 PSD分别连接的信号处理电路，其对两个PSD的输出信号进行处理，并反馈投射光斑和反射光斑在对应PSD上的ニ维坐标位置；通过数据采集卡与信号处理电路连接的エ业控制计算机，其基于所述投射光斑和反射光斑在PSD上的ニ维坐标位置的反馈，发送指令给机器人控制器，使机器人控制器控制机器人带动激光器将所述投射光斑和反射光斑分别定位在对应PSD的中心点位置，同时传送对应位置时机器人的关节角度值。 特别是，所述数据采集卡通过无线通讯或机器人通讯接ロ方式与所述エ业控制计算机连接。优选的，所述激光器通过连接装置安装在机器人末端。本发明还提供一种基于PSD的エ业机器人自标定方法，该方法包括A)安装在机器人末端的激光器将发出的激光束投射在第一 PSD或第二 PSD上，形成投射光斑和反射光束，通过将反射光束投射到第二 PSD或第一 PSD上，形成反射光斑；B)通过闭环控制，使所述投射光斑定位在第一 PSD或第二 PSD的中心点位置，使所述反射光斑定位在第二 PSD或第一 PSD的中心点位置，然后将此时机器人末端所处位置标记为第一位置Pl ;C)根据机器人末端所处位置，确定机器人在当前位置的6个关节角度值；D)改变机器人末端所处位置，按照步骤A)—步骤C)的处理方式，分别得到基于第一位置的第二位置P2、第三位置P3和第四位置P4，以及与第二位置P2、第三位置P3和第四位置P4分别对应的机器人6个关节角度值；E)通过机器人末端所处的第一位置Pl和第二位置P2及机器人末端所处的第三位置P3和第四位置P4，以及确定的与上述各位置所对应的机器人6个关节角度值，分别通过点线关系，建立由两个PSD的中心点连线分别在两个PSD表面反射所形成的两条虚拟约束线的几何方程组，从而实现机器人零位偏差自标定和空间位姿自标定。
特别是，所述B)步骤包括如下进行步骤BI)两个所述PSD的输出信号经所述信号处理电路处理后，给出所述投射光斑和反射光斑在两个所述PSD上的ニ维坐标位置，并将两个所述坐标位置通过数据采集卡反馈给エ业控制计算机；B2)エ业控制计算机基于所述坐标位置的反馈，发送指令给机器人控制器，并控制机器人带动激光器将所述投射光斑和反射光斑分别定位在相应PSD的中心点位置，同时标记机器人末端所处位置。。特别是，所述D)步骤包括如下进行步骤Dl)机器人末端基于第一位置Pl向上或向下移动一定距离，按照步骤A)—步骤C)的处理方式，将机器人末端所处位置标记为第二位置P2，确定机器人在对应位置处的6个关节角度值；
D2)机器人末端基于第二位置向右偏转一定角度，按照步骤A)—步骤C)的处理方式，将机器人末端所处位置标记为第三位置P3，确定机器人在对应位置处的6个关节角度值；D3)机器人末端基于第三位置向上或向下移动一定距离，按照步骤A) —步骤C)的处理方式，将机器人末端所处位置标记为第四位置P4，确定机器人在对应位置处的6个关节角度值。特别是，所述E)步骤包括如下步骤El)通过机器人末端所处的第一位置和第二位置及机器人末端所处的第三位置和第四位置，及所确定的各对应位置处的机器人关节角度值，分别通过点线关系，建立由两个PSD的中心点连线分别在两个PSD表面反射所形成的两条虚拟约束线的几何方程组，并以虚拟约束线中的激光束虚拟线约束建立目标函数，经过迭代运算，进行机器人零位偏差的标定；E2)根据上述步骤所求解出的机器人零位偏差，计算两条所述虚拟约束线分别在V形夹具上的エ件空间坐标系{D}和机器人基座坐标系{B}中的単位向量，以便进行机器人空间位姿自标定。进ー步的，所述El)步骤包括如下进行步骤Ell)通过机器人末端所处的第一至第四位置，以及所确定的四个位置对应处机器人的6个关节角度值，基于机器人运动学误差模型，分别获得第一至第四位置上的机器人末端位置和姿态表达式；E12)通过机器人末端所处的第一位置和第二位置，建立ー组由两个PSD的中心点连线在ー个PSD表面反射所形成的虚拟约束线的几何方程组，通过机器人末端所处的第三位置和第四位置，建立另ー组由两个PSD的中心点连线在另ー个PSD表面反射所形成的虚拟约束线的几何方程组；E13)以两条虚拟约束线建立目标函数，通过迭代算法捜索机器人标定參数，完成机器人零位偏差的标定。优选的，所述E2)步骤包括如下进行步骤E21)根据求解出的机器人零位偏差，计算エ件空间坐标系{D}相对于机器人基座坐标系{B}的旋转变换矩阵R ；
E22)计算エ件空间坐标系{D}相对于机器人基座坐标系{B}的平移向量t ；E23)根据步骤E21)和步骤E22)所分别得到的旋转变换矩阵R和平移向量t，通过计算得到エ件空间坐标系{D}相对于机器人基座坐标系{B}的齐次变换矩阵BTD，从而完成机器人空间位姿的自标定。与现有技术相比，本发明的基于PSD的エ业机器人自标定装置具有如下显著优点I)本发明的自标定装置只需要一个激光器和两个PSD器件及信号处理、采集电路，因此结构简单，价格便宜；2)本发明的自标定装置中采用两个PSD建立机器人末端的虚拟约束线，因此标定过程中不需知道PSD与机器人之间的相对空间位姿及进行物理接触，因此测量精度高；
3)本发明的自标定装置通过PSD、信号处理电路及数据采集卡将激光光斑位姿反馈给机器人控制器，实现机器人的自动定位，机器人在不同位姿下均可自动完成定位任务，不需要人工干预，自动化程度高，安装与操作简单；4)采用本发明的自标定装置进行标定时，只需要机器人完成4次自动定位即可完成机器人空间位姿与零位偏差的自标定，标定过程简单，耗时短；5)本发明的自标定装置将机器人的空间位姿自标定过程和零位偏差自标定过程集成与一体，因此使用更加方便。以下结合附图对本发明进行详细说明。
图I是本发明的エ业机器人自标定装置结构示意图。附图标记说明1_机器人；2_机器人末端；3_连接装置；4_激光器；5、6_反射线；7-第一 PSD ;8_第二 PSD ;9-V形夹具；10-信号处理电路；11_数据采集卡；12-エ业控制计算机；13-机器人控制器。
具体实施例方式如图I所示，为本发明的基于PSD的エ业机器人自标定装置的结构示意图，其包括机器人I ;安装在机器人末端2的激光器4 ;设置于机器人I可达工作空间内的V形夹具9 ;分别安装在V形夹具9的两个板上的两个位置敏感器件PSD，即第一PSD7和第二PSD8，其中，机器人在不同位置时，激光器发出的激光束投射在第一 PSD或第二 PSD上，以便形成投射光斑和反射光束，且反射光束投射到第二 PSD或第一 PSD上，形成反射光斑 ，与第一 PSD7和第二 PSD8分别连接的机器人闭环控制単元，其将投射光斑和反射光斑分别定位在第一PSD7或第二 PSD8的中心点位置，并确定对应的机器人末端2的位置和机器人的关节角度值，以便通过点线关系，建立两条虚拟约束线的几何方程组，从而实现机器人零位偏差自标定和空间位姿自标定；其中，两条虚拟约束线为第一PSD和第二PSD中心点连线分别在第一PSD和第二 PSD表面反射所形成的反射线5、6，并且这两条反射线5、6与激光器所发出的分别投射在第一 PSD或第二 PSD中心点位置上的激光束重合。其中，机器人闭环控制単元包括与第一 PSD7和第二 PSD8分别连接的信号处理电路10，其对两个PSD的输出信号进行处理，并反馈投射光斑和反射光斑在对应PSD上的ニ维坐标位置；通过数据采集卡11与信号处理电路10连接的エ业控制计算机12，其基于投射光斑和反射光斑在PSD上的ニ维坐标位置的反馈，发送指令给机器人控制器13，使机器人控制器13控制机器人I带动激光器4将投射光斑和反射光斑分别定位在对应PSD的中心点位置，同时传送对应位置时机器人I的关节角度值。本发明中，数据采集卡通过无线通讯或机器人通讯接ロ方式与エ业控制计算机连接，并且激光器采用可调焦距的精密半导体激光器，其功率为lmW，波长为670nm，光斑直径为2. 5mm,将激光器通过连接装置3安装在机器人末端2后，相对关系确定且保证安装精度，可以实现激光器与机器人末端的坐标系{E}的X轴方向一致。本发明中，第一 PSD7和第二 PSD8选用分段式高精度光电元件，分辨率达0. I y m，有效表面直径为10mm，其输出信号经信号处理电路11可给出激光光斑在两个PSD表面的ニ维位置坐标，从而作为反馈信号精确控制机器人的姿态。本发明还提供了一种基于PSD的エ业机器人自标定方法，其标定过程如下 A)安装在机器人末端的激光器将发出的激光束投射在第一 PSD或第二 PSD上，形成投射光斑和反射光束，通过将反射光束投射到第二 PSD或第一 PSD上，形成反射光斑；B)通过闭环控制，使所述投射光斑定位在第一 PSD或第二 PSD的中心点位置，使所述反射光斑定位在第二 PSD或第一 PSD的中心点位置，然后将此时机器人末端所处位置标记为第一位置Pl ;C)根据机器人末端所处位置，确定机器人在当前位置的6个关节角度值；D)改变机器人末端所处位置，按照步骤A)—步骤C)的处理方式，分别得到基于第一位置的第二位置P2、第三位置P3和第四位置P4，以及与第二位置P2、第三位置P3和第四位置P4分别对应的机器人6个关节角度值；E)通过机器人末端所处的第一位置Pl和第二位置P2及机器人末端所处的第三位置P3和第四位置P4，以及确定的与上述各位置所对应的机器人6个关节角度值，分别通过点线关系，建立由两个PSD的中心点连线分别在两个PSD表面反射所形成的两条虚拟约束线的几何方程组，从而实现机器人零位偏差自标定和空间位姿自标定。具体的，以ABB的IRB120机器人为例，对本发明的自标定装置进行空间位姿和零位偏差的自标定方法进行详细说明将安装在机器人末端的激光器所发出的激光束投射在第一 PSD表面上,形成投射光斑和反射光束，当该反射光束投射到第二 PSD表面上吋，形成反射光斑。两个PSD的输出信号经机器人闭环控制単元中的信号处理电路处理后，给出投射光斑和反射光斑在两个PSD上的ニ维坐标位置，并将两个坐标位置通过数据采集卡反馈给エ业控制计算机；而エ业控制计算机基于上述两个坐标位置的反�。⑺椭噶罡魅丝刂破鳎⒖刂苹魅舜す馄鹘渡涔獍吆头瓷涔獍叻直鸲ㄎ辉诘谝� PSD和第二 PSD的中心点位置，同时将机器人末端所处位置标记为第一位置。精确定位后，エ业控制计算机通过无线通讯或机器人通讯接ロ从机器人控制器读取机器人在第一位置处的6个关节角度值，并且每个关节的角度值可读取两次以上，再取其平均值作为第一位置的机器人的6个关节角度值，从而确定了机器人在当前位置的6个关节角度值。机器人末端载着激光器基于第一位置沿着反射线5向上或向下移动一定距离，重复上述第一、第二和第三步骤，使投射光斑和反射光斑分别定位在第一 PSD和第二 PSD的中心点位置，同时将机器人末端所处位置标记为第二位置，从机器人控制器中读取当前位置所对应的机器人6个关节角度值；然后，机器人末端载着激光器基于第二位置向右偏转ー定角度至反射线6上的某处，按照上述三个步骤的处理方式，使激光器所发出的激光束投射在第二 PSD表面上，以形成投射光斑和反射光束，当反射光束投射到第一 PSD表面上吋，形成反射光斑；再通过闭环控制，使投射光斑和反射光斑分别定位在第二 PSD和第一PSD的中心点位置，同时将机器人末端所处位置标记为第三位置，从机器人控制器中读取当前位置所对应的机器人6个关节角度值；最后，机器人末端载着激光器基于第三位置沿反射线6向上或向下移动一定距离，按照上述三个步骤的处理方式，使激光器所发出的激光束投射在第二 PSD表面上，以形成投射光斑和反射光束，当反射光束投射到第一 PSD表面上吋，形成反射光斑；再通过闭环控制，使投射光斑和反射光斑分别定位在第二 PSD和第一 PSD的中心点位置，将机器人末端所处位置标记为第四位置，并从机器人控制器中读取当前位置所对应的机器人6个关节角度值。
通过机器人末端所处的第一至第四位置，以及所确定的四个位置对应处机器人的6个关节角度值，并考虑到机器人存在的关节零位偏差8 ,，基于机器人运动学误差模型，获得第一至第四位置上的机器人末端位置和姿态表达式。依据Denavit-Hartenberg (D-H)模型建立的机器人运动学误差模型如下
c Oi -S 0. Cai s Gi SY/, CiiC 0,
权利要求
1.一种基于PSD的工业机器人自标定装置，其特征在于，包括 机器人(I); 安装在机器人末端(2)的激光器(4)； 设置于机器人(I)可达工作空间内的V形夹具(9)； 分别安装在V形夹具(9)的两个板上的两个位置敏感器件PSD，即第一 PSD (7)和第二PSD (8)，其中，机器人在不同位置时，激光器发出的激光束投射在第一 PSD或第二 PSD上，以便形成投射光斑和反射光束，且反射光束投射到第二 PSD或第一 PSD上,形成反射光斑； 与第一 PSD (7)和第二 PSD (8)分别连接的机器人闭环控制单元，其将所述投射光斑和反射光斑分别定位在第一 PSD或第二 PSD的中心点位置,并确定对应的机器人末端的位置和机器人的6个关节角度值，以便通过点线关系，建立两条虚拟约束线的几何方程组，从而实现机器人零位偏差自标定和空间位姿自标定； 其中，所述两条虚拟约束线为第一 PSD和第二 PSD中心点连线分别在第一 PSD和第二PSD表面反射所形成的反射线(5、6)。
2.根据权利要求I所述的基于PSD的工业机器人自标定装置，其特征在于，所述机器人闭环控制单元包括 与所述第一 PSD (7)和第二 PSD (8)分别连接的信号处理电路(10)，其对两个PSD的输出信号进行处理，并反馈投射光斑和反射光斑在对应PSD上的二维坐标位置； 通过数据采集卡(11)与信号处理电路(10)连接的工业控制计算机(12)，其基于所述投射光斑和反射光斑在PSD上的二维坐标位置的反�。⑺椭噶罡魅丝刂破�(13)，使机器人控制器控制机器人带动激光器(4)将所述投射光斑和反射光斑分别定位在对应PSD的中心点位置，同时传送对应位置时机器人的关节角度值。
3.根据权利要求I或2所述的基于PSD的工业机器人自标定装置，其特征在于，所述数据采集卡(11)通过无线通讯或机器人通讯接口方式与所述工业控制计算机(12)连接。
4.根据权利要求I或2或3所述的基于PSD的工业机器人自标定装置，其特征在于，所述激光器(4)通过连接装置(3)安装在机器人末端(2)。
5.一种使用权利要求1-4中任一项所述的工业机器人自标定装置的自标定方法，该方法包括 A)安装在机器人末端的激光器将发出的激光束投射在第一PSD或第二 PSD上，形成投射光斑和反射光束，通过将反射光束投射到第二 PSD或第一 PSD上，形成反射光斑； B)通过闭环控制，使所述投射光斑定位在第一PSD或第二 PSD的中心点位置，使所述反射光斑定位在第二 PSD或第一 PSD的中心点位置，然后将此时机器人末端所处位置标记为第一位置Pl ； C)根据机器人末端所处位置，确定机器人在当前位置的6个关节角度值； D)改变机器人末端所处位置，按照步骤A)—步骤C)的处理方式，分别得到基于第一位置的第二位置P2、第三位置P3和第四位置P4，以及与第二位置P2、第三位置P3和第四位置P4分别对应的机器人6个关节角度值； E)通过机器人末端所处的第一位置Pl和第二位置P2及机器人末端所处的第三位置P3和第四位置P4，以及确定的与上述各位置所对应的机器人6个关节角度值，分别通过点线关系，建立由两个PSD的中心点连线分别在两个PSD表面反射所形成的两条虚拟约束线的几何方程组，从而实现机器人零位偏差自标定和空间位姿自标定。
6.根据权利要求5所述的工业机器人自标定方法，其特征在于，所述B)步骤包括如下进行步骤 BI)两个所述PSD的输出信号经所述信号处理电路处理后，给出所述投射光斑和反射光斑在两个所述PSD上的二维坐标位置，并将两个所述坐标位置通过数据采集卡反馈给工业控制计算机； B2)工业控制计算机基于所述坐标位置的反�。⑺椭噶罡魅丝刂破鳎⒖刂苹魅舜す馄鹘鐾渡涔獍吆头瓷涔獍叻直鸲ㄎ辉谙嘤SD的中心点位置，同时标记机器人末端所处位置。。
7.根据权利要求5或6所述的工业机器人自标定方法，其特征在于，所述D)步骤包括如下进行步骤 Dl)机器人末端基于第一位置Pl向上或向下移动一定距离，按照步骤A)—步骤C)的处理方式，将机器人末端所处位置标记为第二位置P2，确定机器人在对应位置处的6个关节角度值； D2)机器人末端基于第二位置向右偏转一定角度，按照步骤A)—步骤C)的处理方式，将机器人末端所处位置标记为第三位置P3，确定机器人在对应位置处的6个关节角度值； D3)机器人末端基于第三位置向上或向下移动一定距离，按照步骤A)—步骤C)的处理方式，将机器人末端所处位置标记为第四位置P4，确定机器人在对应位置处的6个关节角度值。
8.根据权利要求5或6或7所述的工业机器人自标定方法，其特征在于，所述E)步骤包括如下步骤 El)通过机器人末端所处的第一位置和第二位置及机器人末端所处的第三位置和第四位置，及所确定的各对应位置处的机器人关节角度值，分别通过点线关系，建立由两个PSD的中心点连线分别在两个PSD表面反射所形成的两条虚拟约束线的几何方程组，并以虚拟约束线中的激光束虚拟线约束建立目标函数，经过迭代运算，进行机器人零位偏差的标定; E2)根据上述步骤所求解出的机器人零位偏差，计算两条所述虚拟约束线分别在V形夹具上的工件空间坐标系{D}和机器人基座坐标系{B}中的单位向量，以便进行机器人空间位姿自标定。
9.根据权利要求8所述的工业机器人自标定方法，其特征在于，所述El)步骤包括如下进行步骤 Ell)通过机器人末端所处的第一至第四位置，以及所确定的四个位置对应处机器人的6个关节角度值，基于机器人运动学误差模型，分别获得第一至第四位置上的机器人末端位置和姿态表达式； E12)通过机器人末端所处的第一位置和第二位置，建立一组由两个PSD的中心点连线在一个PSD表面反射所形成的虚拟约束线的几何方程组，通过机器人末端所处的第三位置和第四位置，建立另一组由两个PSD的中心点连线在另一个PSD表面反射所形成的虚拟约束线的几何方程组； E13)以两条虚拟约束线建立目标函数，通过迭代算法搜索机器人标定参数，完成机器人零位偏差的标定。
10.根据权利要求8所述的エ业机器人自标定方法，其特征在于，所述E2)步骤包括如下进行步骤 E21)根据求解出的机器人零位偏差，计算エ件空间坐标系{D}相对于机器人基座坐标系{B}的旋转变换矩阵R ； E22)计算エ件空间坐标系{D}相对于机器人基座坐标系{B}的平移向量t; E23)根据步骤E21)和步骤E22)所分别得到的旋转变换矩阵R和平移向量t，通过计算得到エ件空间坐标系{D}相对于机器人基座坐标系{B}的齐次变换矩阵BTD，从而完成机器人空间位姿的自标定。
全文摘要
本发明公开了一种基于PSD的工业机器人自标定装置，其将两个PSD分别安装在V形夹具的两个板上，且V形夹具放置在机器人可达范围内，根据机器人在不同位置时，使固定在机器人末端的激光器发出的激光束的投射光斑和反射光斑分别定位在两个PSD的中心点位置，并通过两条虚拟约束线，进行机器人零位偏差自标定和空间位姿的自标定。本发明的自标定装置结构简单，安装与操作简单，定位精度高，可同时实现机器人空间位姿与零位偏差的自标定；本发明还提供一种基于PSD的工业机器人自标定方法。
文档编号G01B11/26GK102825602SQ201210299130
公开日2012年12月19日 申请日期2012年8月21日 优先权日2012年8月21日
发明者杜必强, 席宁 申请人:华北电力大学(保定)
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
