一种高精密并联平台及其控制器制造技术

技术编号:21476543 阅读:15 留言:0更新日期:2019-06-29 04:29
本发明专利技术公开了一种高精密并联平台及其控制器,该控制器包括通讯模块、数据解析模块、运动学反解模型模块、运动学修正模型模块、轨迹插补模块;通讯模块用于与并联平台的上位机进行通讯,获得动平台的当前位置和目标位置;数据解析模块用于将接收到的动平台的当前位置和目标位置进行数据解析,将字符串转换为浮点数;运动学反解模型模块用于利用运动学反解模型求得每个电机轴的理论进给量;运动学修正模型模块用于利用运动学修正模型求得每个电机轴进给量的修正量;轨迹插补模块用于根据每个电机轴的理论进给量和每个电机轴进给量的修正量得到每个电机轴的实际进给量来驱动每个电机动作。本发明专利技术控制器可大大提高高精密并联平台的定位精度。

【技术实现步骤摘要】
一种高精密并联平台及其控制器
本专利技术涉及机器人
,具体涉及一种高精密并联平台及其控制器。
技术介绍
IC行业的高速发展对高精度高分辨率的定位系统开发提出了迫切的需求。该系统需要满足微米级甚至是纳米级的定位精度,传统的串联机构难以胜任。平面并联机构由于其自身的优点逐渐成为高精密定位平台的主流,但是控制较复杂。究其原因,主要是因为该类机构从加工到装配等环节都存在各种误差,目前仍然没有一套成熟的简便方法对这些误差进行标定和补偿。并联定位平台相较于传统的串联定位平台具有高速、高精度、高负载等优势,使其在精密装配、精密测量等微纳操作领域获得越来越广泛的应用。三自由度或更少自由度的并联机构能解决工程应用中大多数的问题,且驱动元件更少、结构更加紧凑,显然在工业生产中更具有实际应用价值。但是并联机构属于非线性强耦合系统,在实际应用中存在模型不精准、误差难以消除、运动学标定困难等问题,严重影响最终的使用效果。目前市场上的定位平台的控制器只是根据理想的平台结构建立运动学反解模型,实现平台的动作,没有考虑各种误差因素,对平台的精度提高更多依赖于加工装配的水平,限制了平台精度的进一步提高。
技术实现思路
有鉴于此,为了解决现有技术中的上述问题,本专利技术提出一种高精密并联平台及其控制器,该控制器能够对平台不可避免的制造安装误差进行自补偿,最终可实现平台的高速高精度定位。本专利技术通过以下技术手段解决上述问题:一种高精密并联平台,包括底座,底座上设置有X1驱动模组、X2驱动模组、Y驱动模组,X1驱动模组、X2驱动模组、Y驱动模组与底座连接,X1驱动模组、X2驱动模组、Y驱动模组上设置有动平台,X1驱动模组、X2驱动模组、Y驱动模组与动平台连接,底座上靠近动平台的两侧设置有第一相机、第二相机。进一步地,所述X1驱动模组包括X1电机、X1轴柔性联轴器、X1轴丝杆、X1连接装置、第一X1导轨、第二X1导轨、X1交叉滚柱轴环,X1电机的电机轴通过X1轴柔性联轴器连接X1轴丝杆,X1连接装置将X1轴丝杆、第一X1导轨和第二X1导轨相连,第二X1导轨又与X1交叉滚柱轴环的内圈相连,X1交叉滚柱轴环的外圈与动平台相连接。进一步地,所述X2驱动模组包括X2电机、X2轴柔性联轴器、X2轴丝杆、X2连接装置、第一X2导轨、第二X2导轨、X2交叉滚柱轴环,X2电机的电机轴通过X2轴柔性联轴器连接X2轴丝杆,X2连接装置将X2轴丝杆、第一X2导轨和第二X2导轨相连,第二X2导轨又与X2交叉滚柱轴环的内圈相连,X2交叉滚柱轴环的外圈与动平台相连接。进一步地,所述Y驱动模组包括Y电机、Y轴柔性联轴器、Y轴丝杆、Y连接装置、第一Y导轨、第二Y导轨、Y交叉滚柱轴环,Y电机的电机轴通过Y轴柔性联轴器连接Y轴丝杆,Y连接装置将Y轴丝杆、第一Y导轨和第二Y导轨相连,第二Y导轨又与Y交叉滚柱轴环的内圈相连,Y交叉滚柱轴环的外圈与动平台相连接。进一步地,所述X1电机、X2电机、Y电机都采用伺服电机。进一步地,所述高精密并联平台在X1轴、X2轴、Y轴方向上都设置有限位开关。一种高精密并联平台控制器,包括通讯模块、数据解析模块、运动学反解模型模块、运动学修正模型模块、轨迹插补模块;数据解析模块分别与通讯模块、运动学反解模型模块、运动学修正模型模块连接;轨迹插补模块分别与运动学反解模型模块、运动学修正模型模块连接;所述通讯模块用于与并联平台的上位机进行通讯,获得动平台的当前位置和目标位置;所述数据解析模块用于将接收到的动平台的当前位置和目标位置进行数据解析,将字符串转换为浮点数;所述运动学反解模型模块用于利用运动学反解模型求得每个电机轴的理论进给量;所述运动学修正模型模块用于利用运动学修正模型求得每个电机轴进给量的修正量;所述轨迹插补模块用于根据每个电机轴的理论进给量和每个电机轴进给量的修正量得到每个电机轴的实际进给量来驱动每个电机动作。进一步地,所述控制器还包括IO模块和逻辑模块,逻辑模块分别与数据解析模块和IO模块连接;所述IO模块用于接收并联平台在每个运动方向上设置的限位开关的信号;所述逻辑模块用于判断并联平台在每个运动方向上是否达到运动极限位置或分析并联平台是否满足精度要求来判断要不要继续动作。进一步地,所述运动学反解模型计算方法如下:当动平台旋转的角度为δθ时δX1=Rcos(δθ+θX1+θ0)-Rcos(θX1+θ0)δX2=Rcos(δθ+θX2+θ0)-Rcos(θX2+θ0)δY=Rsin(δθ+θY+θ0)-Rsin(θY+θ0)故从A1点(x1,y1,θ0)运动至A2(x2,y2,θ0+δθ)点,各电机的运动情况如下:δX1=Rcos(δθ+θX1+θ0)-Rcos(θX1+θ0)+(x2-x1)δX2=Rcos(δθ+θX2+θ0)-Rcos(θX2+θ0)+(x2-x1)δY=Rsin(δθ+θY+θ0)-Rsin(θX2+θ0)+(y2-y1)即为该平台的反解模型;其中,δX1:X1电机的相对进给量;δX2:X2电机的相对进给量;δY:Y电机的相对进给量;θX1:X1交叉滚柱轴环中心的角度位置;θX2:X2交叉滚柱轴环中心的角度位置;θY:Y交叉滚柱轴环中心的角度位置;θ0:计算前高精密并联平台的角度。进一步地,所述运动学修正模型计算方法如下:在标定之前,首先将动平台运动到原点位置,此时的原点默认为精确的原点位置,也是视觉系统里的原点位置,接下来指定动平台运行到目标点位置,根据理想的运动学反解模型,可计算出理论上的X1电机、X2电机和Y电机的进给量;当电机执行完该进给量后,利用双目摄像机去采集图像,得到动平台的实际位置;上述流程执行不小于9次,即可得到不小于9组电机的实际进给量和平台的实际位置,再利用这不小于9组数据,基于最小二乘法,即可得到运动学修正模型。与现有技术相比,本专利技术的有益效果如下:本专利技术的并联平台结合精度和成本要求,采用伺服驱动的方式,为了进一步提高定位系统的精度,本专利技术的控制器充分考虑了那些不可避免的加工装备误差,在建立运动学模型的基础上,结合双目相机组成闭环反馈系统,再反过来对该模型参数进行自整定,从而大大提高该模型的准确度,可以满足绝大多数的工业要求。本专利技术的控制器在不明显提高成本的前提下,通过简单操作即可大大提高高精密并联平台的定位精度,可实现0.1um级重复定位。附图说明为了更清楚地说明本专利技术实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本专利技术的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。图1是本专利技术高精密并联平台的结构示意图;图2是本专利技术高精密并联平台的简化图;图3是本专利技术运动学自整定流程图;图4是本专利技术高精密并联平台控制器的内部架构图;附图标记说明:1、动平台;2、第一相机;3、X2驱动模组;4、底座;5、X1驱动模组;6、Y驱动模组;7、第二相机。具体实施方式为使本专利技术的上述目的、特征和优点能够更加明显易懂,下面将结合附图和具体的实施例对本专利技术的技术方案进行详细说明。需要指出的是,所描述的实施例仅仅是本专利技术一部分实施例,而不是全部的实施例,基于本专利技术中的实施例,本领域普通技术人员在没有做出创造本文档来自技高网...

【技术保护点】
1.一种高精密并联平台,其特征在于,包括底座,底座上设置有X1驱动模组、X2驱动模组、Y驱动模组,X1驱动模组、X2驱动模组、Y驱动模组与底座连接,X1驱动模组、X2驱动模组、Y驱动模组上设置有动平台,X1驱动模组、X2驱动模组、Y驱动模组与动平台连接,底座上靠近动平台的两侧设置有第一相机、第二相机。

【技术特征摘要】
1.一种高精密并联平台,其特征在于,包括底座,底座上设置有X1驱动模组、X2驱动模组、Y驱动模组,X1驱动模组、X2驱动模组、Y驱动模组与底座连接,X1驱动模组、X2驱动模组、Y驱动模组上设置有动平台,X1驱动模组、X2驱动模组、Y驱动模组与动平台连接,底座上靠近动平台的两侧设置有第一相机、第二相机。2.根据权利要求1所述的高精密并联平台,其特征在于,所述X1驱动模组包括X1电机、X1轴柔性联轴器、X1轴丝杆、X1连接装置、第一X1导轨、第二X1导轨、X1交叉滚柱轴环,X1电机的电机轴通过X1轴柔性联轴器连接X1轴丝杆,X1连接装置将X1轴丝杆、第一X1导轨和第二X1导轨相连,第二X1导轨又与X1交叉滚柱轴环的内圈相连,X1交叉滚柱轴环的外圈与动平台相连接。3.根据权利要求1所述的高精密并联平台,其特征在于,所述X2驱动模组包括X2电机、X2轴柔性联轴器、X2轴丝杆、X2连接装置、第一X2导轨、第二X2导轨、X2交叉滚柱轴环,X2电机的电机轴通过X2轴柔性联轴器连接X2轴丝杆,X2连接装置将X2轴丝杆、第一X2导轨和第二X2导轨相连,第二X2导轨又与X2交叉滚柱轴环的内圈相连,X2交叉滚柱轴环的外圈与动平台相连接。4.根据权利要求1所述的高精密并联平台,其特征在于,所述Y驱动模组包括Y电机、Y轴柔性联轴器、Y轴丝杆、Y连接装置、第一Y导轨、第二Y导轨、Y交叉滚柱轴环,Y电机的电机轴通过Y轴柔性联轴器连接Y轴丝杆,Y连接装置将Y轴丝杆、第一Y导轨和第二Y导轨相连,第二Y导轨又与Y交叉滚柱轴环的内圈相连,Y交叉滚柱轴环的外圈与动平台相连接。5.根据权利要求1所述的高精密并联平台,其特征在于,所述X1电机、X2电机、Y电机都采用伺服电机。6.根据权利要求1所述的高精密并联平台,其特征在于,所述高精密并联平台在X1轴、X2轴、Y轴方向上都设置有限位开关。7.一种高精密并联平台控制器,其特征在于,包括通讯模块、数据解析模块、运动学反解模型模块、运动学修正模型模块、轨迹插补模块;数据解析模块分别与通讯模块、运动学反解模型模块、运动学修正模型模块连接;轨迹插补模块分别与运动学反解模型模块、运动学修正模型模块连接;所述通讯模块用于与并联平台的上位机进行通讯,获得动平台的当前位置和目标位置;所述数据解析模块用于将接收到的动平台的当前位置和目标位置进行数据解析,将字符串转换为浮点...

【专利技术属性】
技术研发人员:蔡君义王卫军张弓侯至丞杨根李友浩张波涛刘杰林
申请(专利权)人:广州中国科学院先进技术研究所深圳市中科德睿智能科技有限公司
类型:发明
国别省市:广东,44

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1