一种基于双轴编码器的二维空间定位方法技术

一种基于双轴编码器的二维空间定位方法，在确定编码器滚轮A和编码器滚轮B的初始位置及初始偏角的基础上，仅通过两个同时或分时移动的编码器滚轮A和编码器滚轮B反馈的脉冲信号及转动方向，计算出编码器滚轮A和编码器滚轮B的坐标偏移量，再分别与编码器滚轮A、编码器滚轮B的初始坐标进行叠加，就获得分别将编码器滚轮A、编码器滚轮B的实时坐标，快速、实时、准确地计算出编码器滚轮A、编码器滚轮B二维空间位置，实现对机械装置任意移动的定位，当应用于超声无损检测时，使得超声换能器能够在被检测工件面做任意自由移动，无需进行复杂的规划路径和仪器设置，极大的提高了换能器移动的灵活性，提高了检测的效率。

【技术实现步骤摘要】
一种基于双轴编码器的二维空间定位方法
本专利技术涉及一种定位方法，尤其涉及一种基于双轴编码器的二维空间定位方法。
技术介绍
在工业超声无损检测领域，需要准确的定位超声换能器在被检测对象上的位置和移动轨迹，才能够将获得的超声图像与被检测对象进行一一对应，实现对缺陷的定位。现有技术中，采用手动或自动方法进行超声无损检测时，传统的方式是采用一个位置传感器与换能器固定在一起，通过获得超声换能器移动的直线距离进而对其定位，限制了超声探头移动的灵活性，降低了超声无损检测的灵活性和效率。在上述手动或自动超声无损检测方法中，多使用编码器作为位置传感器，将其与超声换能器固定在一起实现对换能器的定位。将被检测工件放置在XY直角坐标系中，则需要获得换能器的坐标（X，Y）以实现对其定位。一种方法是使用一个编码器，实现“单轴扫查”。这种方法只能获得换能器在一个坐标轴如X轴的位置，因此叫做“单轴扫查”。由于只能获得一个坐标轴的定位数据，因此换能器就只能沿一个坐标轴做直线运动，无法在整个检测面上实现探头的准确定位。另一种方法是使用两个编码器，实现“双轴扫查”。这种方法现由于无法实时准确的同时处理X轴和Y轴的位置数据进行换能器定位，多采用换能器先沿一个坐标轴移动，待达到预定位置后，再沿另一个坐标轴移动，即换能器做几字型或者光栅型路线移动。上述单轴扫查和双轴扫查均存在如下缺陷：（1）使用不简便，均需要预先规划好换能器移动路径，换能器沿规划路径移动才能保证定位的准确性；（2）换能器无法自由移动，导致在实际工作中容易出现检测不能全部覆盖工件或者重复检测的情况。（3）实际操作、仪器设置等复杂，必须预先规划路径，为了避免不能全覆盖或者重复检测，在仪器上要做复杂的设置和计算，增加了操作的难度。
技术实现思路
本专利技术要解决的技术问题是提供一种基于双轴编码器的二维空间定位方法，这种基于双轴编码器的二维空间定位方法能够快速准确的计算出机械装置在二维空间的位置，实现对机械装置任意移动的定位。采用的技术方案如下：一种基于双轴编码器的二维空间定位方法，其特征在于包括如下步骤：步骤（1）在机械装置的两侧以轴线K同轴设置编码器滚轮A和编码器滚轮B；步骤（2）建立平面坐标系，分别记录编码器滚轮A和编码器滚轮B在初始位置的初始坐标，以及轴线K的初始偏角；步骤（3）通过对编码器脉冲的计数，分别计算编码器滚轮A、编码器滚轮B的实际运动距离，根据编码器滚轮A和编码器滚轮B的正转或翻转判断编码器滚轮A和编码器滚轮B的实时运动方向；步骤（4）通过初始偏角、编码器滚轮A及编码器滚轮B的实际运动距离，以及编码器滚轮A与编码器滚轮B之间的距离，并根据圆弧公式和三角公式分别计算出实时位置的轴线K＇与初始位置的轴线K之间的夹角，以及编码器滚轮A、编码器滚轮B的实时位置相对于初始位置的坐标偏移量；步骤（5）根据编码器滚轮A和编码器滚轮B的实时运动方向，分别将编码器滚轮A、编码器滚轮B的初始坐标与相应的坐标偏移量叠加，得出编码器滚轮A、编码器滚轮B的实时坐标；同时，将实时位置的轴线K＇与初始位置的轴线K之间的夹角与初始偏角叠加，得出实时位置上轴线K的实时偏角；步骤（6）将编码器滚轮A、编码器滚轮B的实时坐标分别设置为初始坐标，将实时偏角设置为初始偏角，并回到步骤（3）以计算下一个位置上编码器滚轮A、编码器滚轮B的实时坐标，以及实时位置上轴线K＇的实时偏角。在确定编码器滚轮A和编码器滚轮B的初始位置及初始偏角的基础上，仅通过两个同时或分时移动的编码器滚轮A和编码器滚轮B反馈的脉冲信号及转动方向，计算出编码器滚轮A和编码器滚轮B的坐标偏移量，再分别与编码器滚轮A、编码器滚轮B的初始坐标进行叠加，就获得分别将编码器滚轮A、编码器滚轮B的实时坐标，快速、实时、准确地计算出编码器滚轮A、编码器滚轮B二维空间位置，实现对机械装置任意移动的定位，当应用于超声无损检测时，使得超声换能器能够在被检测工件面做任意自由移动，无需进行复杂的规划路径和仪器设置，极大的提高了换能器移动的灵活性，提高了检测的效率。作为本专利技术的优选方案，所述步骤（4）具体包括如下步骤：步骤（4）-1通过编码器滚轮A和编码器滚轮B的实际运动距离，以及编码器滚轮A与编码器滚轮B之间的距离，并根据圆弧公式计算出编码器滚轮A和编码器滚轮B的运动半径，并计算出实时位置的轴线K＇与初始位置的轴线K之间的夹角；步骤（4）-2根据三角公式，计算实时位置的编码器滚轮A与初始位置的编码器滚轮A之间的距离，计算实时位置的编码器滚轮B与初始位置的编码器滚轮B之间的距离；步骤（4）-3根据初始偏角、夹角和运动半径分别计算编码器滚轮A、编码器滚轮B的实时位置相对于初始位置的坐标偏移量。作为本专利技术进一步的优选方案，所述步骤（4）-1中，将编码器滚轮A的实际运动距离记为L1，将编码器滚轮B的实际运动距离记为L2，将编码器滚轮A与编码器滚轮B之间的距离记为m，将编码器滚轮A的运动半径设为n，则编码器滚轮B的运动半径为n+m，将实时位置的轴线K＇与初始位置的轴线K之间的夹角记为θ，则根据圆弧公式可得θ=180*L1/（π*n）,θ=180*L2/（π*（n+m）），联立上述两式解得n=L1*m/（L2-L1）,将n代入上式解得θ=180*（L2-L1）/（π*m）；所述步骤（4）-2中，计算实时位置的编码器滚轮A与初始位置的编码器滚轮A之间的距离P1=|n*Sin（θ/2）|，计算实时位置的编码器滚轮B与初始位置的编码器滚轮B之间的距离P2=|（m+n）*Sin（θ/2）|；所述步骤（4）-3中，设初始偏角为θ0，计算编码器滚轮A的实时位置相对于初始位置的坐标偏移量|⊿x1|=|P1*cos（（180-θ）/2-θ0）|，|⊿y1|=|P1*sin（（180-θ）/2-θ0）|,计算编码器滚轮B的实时位置相对于初始位置的坐标偏移量|⊿x2|=|P2*cos（（180-θ）/2-θ0）|，|⊿y2|=|P2*sin（（180-θ）/2-θ0）|。上述编码器滚轮A与编码器滚轮B之间的距离m、初始偏角θ0为已知，编码器滚轮A的实际运动距离L1、编码器滚轮B的实际运动距离L2根据编码器滚轮A、编码器滚轮B的脉冲计数获得。一般情况下，将编码器滚轮A、编码器滚轮B沿逆时针方向运动设置为正向运动，将编码器滚轮A、编码器滚轮B沿顺时针方向运动设置为负向运动。在进行编码器滚轮A、编码器滚轮B的初始坐标与坐标偏移量叠加时，因为坐标偏移量是以绝对值进行计算，因此，需根据编码器滚轮A、编码器滚轮B的初始位置所在的象限以及轴线K的实时偏角，以及编码器滚轮A、编码器滚轮B的运动方向来确定坐标偏移量的增减。本专利技术与现有技术相比，具有如下优点：仅通过两个编码器滚轮反馈的脉冲信号及转动方向，就能够获得两个编码器滚轮的实时坐标，快速、实时、准确地计算出两个编码器滚轮的二维空间位置，实现对机械装置任意移动的定位，当应用于超声无损检测时，使得超声换能器能够在被检测工件面做任意自由移动，无需进行复杂的规划路径和仪器设置，极大的提高了换能器移动的灵活性，提高了检测的效率。附图说明图1是本专利技术优选实施方式的流程图；图2是编码器滚轮A、编码器滚轮B的实际运动距离均不相同的示意图；图3是编码器滚轮A、编码器滚轮B本文档来自技高网...

【技术保护点】
1.一种基于双轴编码器的二维空间定位方法，其特征在于包括如下步骤：步骤（1）在机械装置的两侧以轴线K同轴设置编码器滚轮A和编码器滚轮B；步骤（2）建立平面坐标系，分别记录编码器滚轮A和编码器滚轮B在初始位置的初始坐标，以及轴线K的初始偏角；步骤（3）通过对编码器脉冲的计数，分别计算编码器滚轮A、编码器滚轮B的实际运动距离，根据编码器滚轮A和编码器滚轮B的正转或翻转判断编码器滚轮A和编码器滚轮B的实时运动方向；步骤（4）通过初始偏角、编码器滚轮A及编码器滚轮B的实际运动距离，以及编码器滚轮A与编码器滚轮B之间的距离，并根据圆弧公式和三角公式分别计算出实时位置的轴线K＇与初始位置的轴线K之间的夹角，以及编码器滚轮A、编码器滚轮B的实时位置相对于初始位置的坐标偏移量；步骤（5）根据编码器滚轮A和编码器滚轮B的实时运动方向，分别将编码器滚轮A、编码器滚轮B的初始坐标与相应的坐标偏移量叠加，得出编码器滚轮A、编码器滚轮B的实时坐标；同时，将实时位置的轴线K＇与初始位置的轴线K之间的夹角与初始偏角叠加，得出实时位置上轴线K的实时偏角；步骤（6）将编码器滚轮A、编码器滚轮B的实时坐标分别设置为初始坐标，将实时偏角设置为初始偏角，并回到步骤（3）以计算下一个位置上编码器滚轮A、编码器滚轮B的实时坐标，以及实时位置上轴线K＇的实时偏角。...

【技术特征摘要】
1.一种基于双轴编码器的二维空间定位方法，其特征在于包括如下步骤：步骤（1）在机械装置的两侧以轴线K同轴设置编码器滚轮A和编码器滚轮B；步骤（2）建立平面坐标系，分别记录编码器滚轮A和编码器滚轮B在初始位置的初始坐标，以及轴线K的初始偏角；步骤（3）通过对编码器脉冲的计数，分别计算编码器滚轮A、编码器滚轮B的实际运动距离，根据编码器滚轮A和编码器滚轮B的正转或翻转判断编码器滚轮A和编码器滚轮B的实时运动方向；步骤（4）通过初始偏角、编码器滚轮A及编码器滚轮B的实际运动距离，以及编码器滚轮A与编码器滚轮B之间的距离，并根据圆弧公式和三角公式分别计算出实时位置的轴线K＇与初始位置的轴线K之间的夹角，以及编码器滚轮A、编码器滚轮B的实时位置相对于初始位置的坐标偏移量；步骤（5）根据编码器滚轮A和编码器滚轮B的实时运动方向，分别将编码器滚轮A、编码器滚轮B的初始坐标与相应的坐标偏移量叠加，得出编码器滚轮A、编码器滚轮B的实时坐标；同时，将实时位置的轴线K＇与初始位置的轴线K之间的夹角与初始偏角叠加，得出实时位置上轴线K的实时偏角；步骤（6）将编码器滚轮A、编码器滚轮B的实时坐标分别设置为初始坐标，将实时偏角设置为初始偏角，并回到步骤（3）以计算下一个位置上编码器滚轮A、编码器滚轮B的实时坐标，以及实时位置上轴线K＇的实时偏角。2.如权利要求1所述的二维空间定位的方法，其特征是：所述步骤（4）具体包括如下步骤：步骤（4）-1通过编码器滚轮A和编码器滚轮B的实际运动距离，以及编码器滚轮A与编码器滚轮B之间的距离，并根据圆弧公式计算出编码器滚轮A和编码器滚轮B的运动半径，并计算出实时位置的...

【专利技术属性】
技术研发人员：陈宏龙，李丹，陈智发，谢晓宇，
申请(专利权)人：汕头市超声检测科技有限公司，
类型：发明
国别省市：广东,44