一种基于H型精密运动平台的轮廓误差估计方法与流程
本发明属于精密高效数控加工技术领域，涉及一种基于h型精密运动平台的轮廓误差估计方法。
背景技术：
在现代数控机床中，多轴伺服系统的轮廓跟踪运动为一重要应用，且广泛应用于各种类型加工。因此，如何降低轮廓跟踪运动过程中的误差为重点发展技术，而现今主要用于轮廓跟踪精度的指标为追踪误差与轮廓误差，其中追踪误差定义为期望位置点至实际位置点的距离；而轮廓误差定义为实际位置点至整个期望轨迹上的最短距离，因此轮廓误差为判断加工轮廓偏离期望轨迹的重要依据。
现有估计轮廓误差的方法，多以实际位置点至近似轮廓误差发生点的距离为估计值，其余则采取迭代计算的方式；将可能的轮廓误差发生点附近的线段细分为数个命令点比较其距离，反复进行以逼近真实轮廓误差发生点；或离线计算，乃至于数种方式相结合等。以实际位置点至近似轮廓误差发生点的距离为估计值时，若期望轮廓为自由曲线时，其近似轨迹均会偏离实际命令轨迹，导致近似的轮廓误差发生点不准确，使估计误差增加。而迭代比较法其计算时间较长，若想求得更精准的轮廓误差，则所需的迭代次数与所用时间可能超出轮廓跟踪系统的负荷；离线计算的方式，对于需要实时获取轮廓误差大小作为补偿的轮廓跟踪运动控制而言，较不合适。
技术实现要素：
本发明就是针对现有技术存在的缺陷，提供一种基于h型精密运动平台的轮廓误差估计方法，其对于不同曲率变化的自由曲线均可有效提升轮廓误差估计的准确度,进而降低轮廓跟踪运动中产生的轮廓误差。
为实现上述目的，本发明采用如下技术方案，包括以下步骤：
步骤一：计算h型精密运动平台期望加工轮廓上任意一参考点r1(t)处的曲率ρ及曲率半径r；
步骤二：计算h型精密运动平台期望加工轮廓上任意一参考点r1(t)处切线与x轴夹角α；
步骤三：根据几何关系计算内切圆的圆心坐标(oxoy)；
步骤四：利用三角形面积计算圆心角β及其对应的弧长l；
步骤五：以圆弧长l计算r2(t)到r1(t)的运动时间δt；
步骤六：利用二阶泰勒级数展开式计算r2(t)的坐标(r2xr2y)；
步骤七：利用三角形面积计算得到任意轨迹的估计轮廓误差ec。
作为本发明的一种优选方案，所述步骤一中曲率ρ及曲率半径r具体为：
其中，
作为本发明的另一种优选方案，所述步骤二的切线与x轴夹角α具体为：
其中，
作为本发明的另一种优选方案，所述步骤三所述内切圆的圆心坐标(oxoy)具体为：
其中，ox，oy分别为内切圆圆心横坐标和纵坐标；r1x，r1y分别为r1(t)点的横坐标和纵坐标。
作为本发明的另一种优选方案，所述步骤四中圆心角β及其对应的弧长l具体为：
其中，三角形or1(t)p1(t)的面积：
其中，p1x，p1y为p1(t)点的横坐标和纵坐标。
则圆弧长l＝rβ。
作为本发明的另一种优选方案，所述步骤五中r2(t)到r1(t)的运动时间δt具体为：
其中，
作为本发明的另一种优选方案，所述步骤六中r2(t)的坐标具体为：
其中，
作为本发明的另一种优选方案，所述步骤七中估计轮廓误差具体为：
其中，r2x，r2y分别为r1(t)点的横坐标和纵坐标。
与现有技术相比本发明有益效果。
本发明一种基于h型精密运动平台的轮廓误差估计方法属于精密高效数控加工技术领域，涉及一种轮廓跟踪加工过程中基于自由曲线的实时轮廓误差估计方法。本发明为了解决现有轮廓误差估计精确度低，迭代计算时间长的缺点。该方法首先计算在期望点处内切圆的几何参数，并根据几何参数求得反推点到期望点的运动时间；其次，利用二阶泰勒级数展开式计算反推点坐标；最后，为避免引入反正切函数，根据三角形面积计算公式，计算轮廓误差估计值。
本发明对于不同曲率变化的自由曲线均可有效提升轮廓误差估计的准确度，进而降低轮廓跟踪运动中产生的轮廓误差。
附图说明
下面结合附图和具体实施方式对本发明做进一步说明。本发明保护范围不仅局限于以下内容的表述。
图1是本发明轮廓误差估计方法示意图。
图2是本发明圆形轮廓轨迹图。
图3是本发明真实轮廓误差和估计轮廓误差表示图。
具体实施方式
如图1-3所示，下面结合具体实施例对本发明做进一步说明，但本发明不受实施例的限制。
具体实施方式一：任意轨迹的实时轮廓误差估计模型如图1所示，r1(t)为期望运动轨迹位置；r2(t)为反推得到在期望轨迹上的参考点；p1(t)为实际运动轨迹位置；et为轮廓跟踪误差；o、r分别为过r1(t)所作内切圆的圆心和半径；l为角β所对应的圆弧长；α为过r1(t)点处切线与x轴夹角。轮廓估计误差ec为p1(t)到直线r1(t)r2(t)的距离。
步骤一：计算在参考点r1(t)处的曲率ρ及曲率半径r，如下：
其中，
步骤二：计算r1(t)点处切线与x轴夹角α，如下：
其中，
步骤三：根据几何关系计算内切圆的圆心坐标(oxoy)；
由图中几何关系可得：
其中，ox，oy分别为内切圆圆心横坐标和纵坐标；r1x，r1y分别为r1(t)点的横坐标和纵坐标。
步骤四：利用三角形面积计算圆心角β及其对应的弧长l，如下：
其中，三角形or1(t)p1(t)的面积：
其中，p1x，p1y为p1(t)点的横坐标和纵坐标。
则圆弧长l＝rβ；
步骤五：以圆弧长度计算r2(t)到r1(t)的运动时间δt：
其中，
步骤六：利用二阶泰勒级数展开式计算r2(t)的坐标：
其中，
步骤七：利用三角形面积计算可得到任意轨迹的估计轮廓误差：
其中，r2x，r2y分别为r1(t)点的横坐标和纵坐标。
本实施例是以半径50mm的圆为参考轨迹r(t)、以北京慧摩森公司生产的jsm-x360-y360型h型精密运动平台进行实验验证，其中轮廓的进给速率为100mm/s。图2中虚线为期望轨迹，实线实际轨迹；图3中曲线分别表示真实轮廓误差和本发明方法进行估计的轮廓误差，通过对比可见，基于本发明所提出的误差模型计算得到的轮廓误差可以有效的反映真实的轮廓误差。需要说明的是，本发明提出的是对轮廓误差的估计方法而不是控制方法，本方法可以应用到各类做二维运动的机床、平台等设备的轮廓误差跟踪控制中去，主要完成轮廓误差跟踪控制中轮廓误差估计的功能。在应用本发明的过程中，只需要知道参考轨迹r(t)以及机床等设备刀具的当前位置即可对当前位置与参考轨迹之间的误差进行估计，利用此误差可以进行相应的轮廓误差跟踪控制。
虽然本发明已以较佳的实施例公开如上，但其并非用以限定本发明，任何熟悉此技术的人，在不脱离本发明的精神和范围内，都可以做各种改动和修饰，因此本发明的保护范围应该以权利要求书所界定的为准。
- 还没有人留言评论。精彩留言会获得点赞！