运动平台控制系统和运动平台误差计算方法
【技术领域】
[0001] 本发明涉及工业运动控制技术领域,具体涉及一种运动平台控制系统和运动平台 误差计算方法。
【背景技术】
[0002] 在精密加工领域,人们通常使用高精度加工平台对物料进行加工,其二维运动平 台的定位精度对高精度加工平台的整体精度有很大影响。二维运动平台的误差来自于运动 平台的机械误差,例如导轨的安装精度,伺服电机的运动精度等,该些误差属于固定值,可 W对其进行误差校正,进而提高二维运动平台的定位精度。传统的校正方法通常采用激光 干涉仪或者标准量块对运动平台进行校正,采用激光干涉仪校正方法,其操作步骤繁琐,操 作时间长,数据处理量大,并且激光干涉仪容易受到外部环境的影响;采用标准量块校正方 法,受标准量块的尺寸及被测平台的形状影响,其使用范围受到一定限制。
[0003] 针对上述缺陷,人们开发了利用机器视觉系统来对运动平台进行误差校正的装 置。机器视觉系统就是利用机器代替人眼来对被测物体进行测量和判断,机器视觉系统通 过机器视觉产品(即图像摄取装置,分CMOS和CCD两种类型)将被摄取目标转换成图像信 号,并将上述图像信号传送给专用的图像处理系统,根据图像信号中像素分布、亮度和颜色 等信息,将图像信号转变成数字信号,图像系统对该些数字信号进行各种运算来抽取目标 的特征,进而对被测物体进行测量和判断,并根据判别的结果来控制现场的设备动作。一 个典型的工业机器视觉系统包括;光源、镜头、相机(包括CCD相机和C0MS相机)、图像处理 单元(或图像捕获卡)、图像处理软件、监视器、通讯/输入输出单元等。但是由于机器视觉 系统中图像摄取装置的取景范围小,现有的机器视觉误差校正装置对被测物体的尺寸有要 求,只能适用于小尺寸运动平台的误差校正,对大尺寸运动平台无法进行误差校正。
[0004] 鉴于此,有必要提供一种新的运动平台控制系统和运动平台误差计算方法W解决 上述不足。
【发明内容】
[0005] 本发明的主要目的在于提供一种运动平台控制系统和运动平台误差计算方法,使 采用该运动平台控制系统的大尺寸加工平台具有良好的误差校正精度。
[0006] 为实现该目的,本发明提供一种运动平台控制系统,包括:二维运动平台和运动控 制模块;
[0007] 上述二维运动平台与上述运动控制模块连接,上述运动控制模块测量上述二维运 动平台的位移误差,并控制上述二维运动平台的位移。
[0008] 进一步的,上述运动控制模块包括误差标定模块和误差计算模块;
[0009] 上述误差标定模块与上述误差计算模块连接,上述误差计算模块与上述二维运动 平台连接。
[0010] 进一步的,上述误差标定模块包括载物台和标定板,上述误差计算模块包括机器 视觉模块和数据处理模块;
[0011] 上述载物台设置在上述二维运动平台下方;
[0012] 上述标定板放置在上述载物台上;
[0013] 上述机器视觉模块设置在上述二维运动平台上,与上述二维运动平台同步运动;
[0014] 上述数据处理模块与上述机器视觉模块连接。
[0015] 进一步的,上述二维运动平台包括X向导轨、与上述X向导轨垂直放置的Y向导 轨、X向伺服电机、Y向伺服电机、运动头;
[0016] 上述运动头与上述X向导轨和上述Y向导轨连接,上述X向伺服电机与上述X向 导轨连接,上述Y向伺服电机与上述Y向导轨连接。
[0017] 进一步的,上述二维运动平台上设置有与上述运动头同步运动的机器视觉模块。
[0018] 进一步的,上述标定板为具有固定间距图案阵列的平板,上述固定间距图案设置 有定位标记点、仿射变换参考标记点和平台数据采集标记点。
[0019] 本发明还提供一种运动平台误差计算方法,包括W下步骤:
[0020] 生成标定板的标准图像;
[0021] 获取上述标定板的序列图像;
[0022] 将上述序列图像进行拟合,获取上述标定板在运动平台全部运动范围内的完整图 像;
[0023] 将上述完整图像与上述标准图像进行对比,获取上述运动平台在上述标定板上的 定位标记点处的误差值。
[0024] 进一步的,上述获取上述标定板的序列图像的步骤具体为:
[0025] 将上述标定板固定在载物台的左半部,获取上述标定板的第一幅图像;
[0026] 将上述标定板固定在上述载物台的右半部,获取上述标定板的第二幅图像。
[0027] 进一步的,上述第一幅图像和上述第二幅图像部分重合。
[0028] 进一步的,上述获取上述标定板的序列图像的步骤具体为:
[0029] 将上述标定板固定在载物台的上半部,获取上述标定板的第H幅图像;
[0030] 将上述标定板固定在上述载物台的下半部,获取上述标定板的第四幅图像。
[0031] 进一步的,上述第H幅图像和上述第四幅图像部分重合。
[0032] 进一步的,上述获取上述标定板的序列图像的步骤具体为:
[0033] 将上述标定板固定在载物台的左上部,获取上述标定板的第五幅图像;
[0034] 将上述标定板固定在上述载物台的左下部,获取上述标定板的第六幅图像;
[0035] 将上述标定板固定在上述载物台的右下部,获取上述标定板的第走幅图像;
[0036] 将上述标定板固定在上述载物台的右上部,获取上述标定板的第八幅图像。
[0037] 进一步的,上述第五幅图像、上述第六幅图像、上述第走幅图像和上述第八幅图像 彼此部分重合。
[0038] 进一步的,上述生成标定板的标准图像的步骤具体为:
[0039] 按标定板的标定参数和载物台的尺寸范围,生成尺寸与上述运动平台运动范围相 同的上述标定板的标准图像。
[0040] 上述运动平台控制系统利用机器视觉系统对大尺寸加工平台进行误差校正,校正 过程简单,校正精度高,并且校正的结果稳定性高,重复性强。上述运动平台误差计算方法 对样本的采样条件要求简单,误差计算过程中收敛速度快,并且可w通过多次迭代,提高误 差的计算精度。
【附图说明】
[0041] 图1为本发明提供的运动平台控制系统的结构框图。
[0042] 图2为为本发明提供的运动平台误差计算方法的流程图。
[0043] 图3为Bezier曲面拼接示意图。
[0044] 图4为两张H次Bezier曲面的拼接示意图。
【具体实施方式】
[0045] 下文将结合附图详细描述本发明的实施例。应当注意的是,下述实施例中描述的 技术特征或者技术特征的组合不应当被认为是孤立的,它们可W被相互组合和相互结合从 而达到更好的技术效果。
[0046] 如图1所示,为本发明提供的运动平台控制系统的结构框图。
[0047] 在本实施例中,运动平台控制系统包括二维运动平台100和运动控制模块200 ;二 维运动平台100与运动控制模块200连接,运动控制模块200测量二维运动平台100的位 移误差,并控制二维运动平台100的位移。
[0048] 二维运动平台100固定在加工平台的本体上,并可W在加工平台的本体上作二维 平面运动。二维运动平台100接收运动控制模块200发出的运动指令信息,并按上述运动 指令信息进行移动。
[0049] 在本实施例中,运动控制模块200包括误差标定模块201和误差计算模块202 ;误 差标定模块201与误差计算模块202连接,误差计算模块202与二维运动平台100连接。
[0050] 误差标定模块201用于标定二维运动平台100的位移误差,应当说明的是,在本实 施例中,误差标定模块201标定的二维运动平台100的位移误差是W图像形式反映的。误差 计算模块202用于将上述误差标定模块201标定的W图像形式反映的二维运动平台100的 位移误差转换为数字信息,并将上述数字信息处理为二维运动平台100在各标记点处的位 移误差值。在本实施例中,误差计算模块202还可W根据计算得到的位移误差值,对二维运 动平台100在对应标记点处的坐标值进行校正,即对二维运动平台的位移进行误差校正。
[0051] 在本实施例中,误差标定模块201包括载物台2012和标定板2011,误差计算模块 202包括机器视觉模块2021和数据处理模块2022 ;载物台2012设置在二维运动平台100 下方;标定板2011放置在载物台2012上;机器视觉模块2021设置在二维运动平台100上, 与二维运动平台100同步运动;数据处理模块2022与机器视觉模块2021连接。
[0052] 机器视觉系统就是利用机器代替人眼来对被测物体进行测量和判断。机器视觉系 统通过机器视觉产品(即图像摄取装置,分CMOS和CCD两种类型)将被摄取目标转换成图像 信号,并将上述图像信号传送给专用的图像处理系统,根据图像信号中像素分布、亮度和颜 色等信息,将图像信号转变成数字信号,图像系统对该些数字信号进行各种运算来抽取目 标的特征,进而对被测物体进行测量和判断,并根据判别的结果来控制现场的设备动作。一 个典型的工业机器视觉系统包括;光源、镜头、相机(包括CCD相机和C0MS相机)、图像处理 单元(或图像捕获卡)、图像处理软件、监视器、通讯/输入输出单元等。
[0053] 在本实施例中,二维运动平台100包括X向导轨、
与上述X向导轨垂直放置的Y向 导轨、X向伺服电机、Y向伺服电机、运动头;上述运动头与上述X向导轨和上述Y向导轨连 接,上述X向伺服电机与上述X向导轨连接,上述Y向伺服电机与上述Y向导轨连接。X向 导轨和Y向导轨为运动头的二维平面运动提供位移轨道,X向伺服电机和Y向伺服电机分 别为运动头在X向导轨和Y向导轨上的位移提供动力。
[0054] 应当说明的是,X向伺服电机和Y向伺服电机分别与运动控制模块200连接,接收 运动控制模块200发出的运动指令信息,并按上述运动指令信息控制运动头的位移,在本 实施例中,二维运动平台100的运动反映为运动头的二维运动。运动头上设置有外设接口, 可W安装激光头、刀具、喷砂头等加工设备,本发明对运动头上可安装的加工设备的类型不 作限制。
[0055] 在本实施例中,载物台是固定在加工平台本体上的,其相对于加工平台的坐标是 固定不变的,载物台2012上还设置有固定装置,上述固定装置可W将标定板2011固定在载 物台2012上,使标定板2011在误差校正过程中不会发生移动。机器视觉模块2021设置在 二维运动平台100上,机器视觉模块2021可W与二维运动平台100同步运动,即机器视觉 模块2021与运动头同步运动,机器视觉模块2021与运动头之间的相对位置是固定不变的。 载物台2012设置在二维运动平台100下方,二维运动平台100可W在载物台2012的上部空 间中作二维平面运动。应当说明的是,载物台2012的尺寸范围大于等于二维运动平台100 的运动范围,W保证机器视觉模块2021在随二维运动平台100同步运动时,在二维运动平 台100的整个运动范围内都可W获取标定板2011的图像。
[0056] 在本实施例中,标定板2011为具有固定间距图案阵列的平板,上述固定间距图案 上设置有定位标记点、仿射变换参考标记点和平台数据采集标记点。标定板2011可W采用 市场上现有的标准标定板,也可W根据加工平台的实际情况进行制作,本发明对此不作限 制。
[0057] 应当说明的是,在其它实施例中,也可W将二维运动平台100和载物台2012的运 动状态调换,即设置二维运动平台100固定在加工平台的本体上不作运动,载物台2012作 二维平面内运动,此时X向导轨、Y向导轨分别与载物台2012连接,X向伺服电机和Y向伺 服电机分别与运动控制模块200连接,接收运动控制模块200发出的运动指令信息,并按上 述运动指令信息控制载物台2012的位移。
[005引如图2所示,为本发明提供的运动平台误差计算方法的流程图,包括W下步骤:
[0059]S201;生成标定板的标准图像。
[0060]由于标定板2011为具有固定间距图案阵列的平板,所W可W利用实际取用的标 定板2011上的图案排列规则,由运动控制模块200合成无限大尺寸的标定板2011的标准 图像。
[0061] 应当说明的是,上述标准图像并不是机器视觉模块2021实际拍摄的标定板2011 的图像,而是利用标定板2011上的图案排列规则合成的理论图像,上述标准图像上的图案 排列规则与实际取用的标定板2011上的图案排列规则完全相同,并且上述标准图像上的 定位标记点、仿射变换参考标记点和平台数据采集标记点也与实际取用的标定板2011上 的完全相同。
[0062]S202;获取标定板的序列图像。
[0063] 将标定板2011固定在载物台2012上,二维运动平台100按设定的运动轨迹运动, 带动运动头按规定的运动轨迹运动,设置在二维运动平台100上的机器视觉模块2021获取 标定板2011的序列图像。
[0064] 应当说明的是,在获取标定板2011的序列图像的整个过程中,机器视觉模块2021 获取的标定板2011的图像与二维运动平台100的理论坐标值是对应的。即二维运动平台 100接收一个位移指令,并按上述位移指令移动到理论位置,此时二维运动平台100上的运 动头获得一个理论坐标值,机器视觉模块2021获取此时标定板2011的一幅图像,在上述图 像与上述理论坐标值之间建立映射关系;二维运动平台100接收另一个位移指令,并按上 述位移指令移动到另一个理论位置,此时二维运动平台100上的运动头获得另一个理论坐 标值,机器视觉模块2021获取此时标定板2011的另一幅图像,在上述另一幅图像与上述 另一个理论坐标值之间建立映射关系;W此类推,在机器视觉模块2021获取的所有标定板 2011的图像与运动头的理论坐标值之间建立映射关系。
[0065] 应当说明的是,在本实施例中,W二维运动平台100的最大运动范围来设定二维 运动平台100的运动轨迹,W保证机器视觉模块2021在随二维运动平台100运动时,在二 维运动平台100的最大运动范围内都可W获取标定板2011的图像,误差计算模块202可W 对二维运动平台100的全部运动范围进行误差校正。
[0066] S203 ;将上述序列图像进行拟合,获取标定板在运动平台全部运动范围内的完整 图像。
[0067] 图像的拟合可W利用Bezier曲面拼接原理来实现。
[0068] 设两张mXn次Bezier曲面
【主权项】
1. 一种运动平台控制系统,其特征在于,包括:二维运动平台和运动控制 模块; 所述二维运动平台与所述运动控制模块连接,所述运动控制模块测量所述二维运动平 台的位移误差,并控制所述二维运动平台的位移。
2. 如权利要求1所述的运动平台控制系统,其特征在于,所述运动控制模块包括误差 标定模块和误差计算模块; 所述误差标定模块与所述误差计算模块连接,所述误差计算模块与所述二维运动平台 连接。
3. 如权利要求2所述的运动平台控制系统,其特征在于,所述误差标定模块包括载物 台和标定板,所述误差计算模块包括机器视觉模块和数据处理模块; 所述载物台设置在所述二维运动平台下方; 所述标定板放置在所述载物台上; 所述机器视觉模块设置在所述二维运动平台上,与所述二维运动平台同步运动; 所述数据处理模块与所述机器视觉模块连接。
4. 如权利要求3所述的运动平台控制系统,其特征在于,所述二维运动平台包括X向导 轨、与所述X向导轨垂直放置的Y向导轨、X向伺服电机、Y向伺服电机、运动头; 所述运动头与所述X向导轨和所述Y向导轨连接,所述X向伺服电机与所述X向导轨 连接,所述Y向伺服电机与所述Y向导轨连接。
5. 如权利要求4所述的运动平台控制系统,其特征在于,所述标定板为具有固定间距 图案阵列的平板,所述固定间距图案上设置有定位标记点、仿射变换参考标记点和平台数 据采集标记点。
6. -种运动平台误差计算方法,其特征在于,包括以下步骤: 生成标定板的标准图像; 获取所述标定板的序列图像; 将所述序列图像进行拟合,获取所述标定板在运动平台全部运动范围内的完整图像; 将所述完整图像与所述标准图像进行对比,获取所述运动平台在所述标定板上的定位 标记点处的误差值。
7. 如权利要求6所述的运动平台误差计算方法,其特征在于,所述获取所述标定板的 序列图像的步骤具体为: 将所述标定板固定在载物台的左半部,获取所述标定板的第一幅图像; 将所述标定板固定在所述载物台的右半部,获取所述标定板的第二幅图像。
8. 如权利要求7所述的运动平台误差计算方法,其特征在于,所述第一幅图像和所述 第二幅图像部分重合。
9. 如权利要求6所述的运动平台误差计算方法,其特征在于,所述获取所 述标定板的序列图像的步骤具体为: 将所述标定板固定在载物台的上半部,获取所述标定板的第三幅图像; 将所述标定板固定在所述载物台的下半部,获取所述标定板的第四幅图像。
10. 如权利要求9所述的运动平台误差计算方法,其特征在于,所述第三幅图像和所述 第四幅图像部分重合。
11. 如权利要求6所述的运动平台误差计算方法,其特征在于,所述获取所 述标定板的序列图像的步骤具体为: 将所述标定板固定在载物台的左上部,获取所述标定板的第五幅图像; 将所述标定板固定在所述载物台的左下部,获取所述标定板的第六幅图像; 将所述标定板固定在所述载物台的右下部,获取所述标定板的第七幅图像; 将所述标定板固定在所述载物台的右上部,获取所述标定板的第八幅图像。
12. 如权利要求11所述的运动平台误差计算方法,其特征在于,所述第五幅图像、所述 第六幅图像、所述第七幅图像和所述第八幅图像彼此部分重合。
13. 如权利要求6所述的运动平台误差计算方法,其特征在于,所述生成标定板的标准 图像的步骤具体为: 按标定板的标定参数和运动平台的运动范围,生成尺寸与所述运动平台运动范围相同 的所述标定板的标准图像。
【专利摘要】本发明提供一种运动平台控制系统和运动平台误差计算方法,上述运动平台控制系统利用机器视觉系统对大尺寸加工平台进行误差校正,校正过程简单,校正精度高,并且校正的结果稳定性高,重复性强。上述运动平台误差计算方法对样本的采样条件要求简单,误差计算过程中收敛速度快,并且可以通过多次迭代,提高误差的计算精度。
【IPC分类】G05B19-404
【公开号】CN104865893
【申请号】CN201410061768
【发明人】贾鹏程, 李强, 翟学涛, 杨朝晖, 高云峰
【申请人】大族激光科技产业集团股份有限公司, 深圳市大族数控科技有限公司
【公开日】2015年8月26日
【申请日】2014年2月24日