一种四轴同平面校正平台及原点回归方法
技术领域
本发明属于对位平台技术领域,具体涉及一种四轴同平面校正平台及原点回归方法。
背景技术
四轴共平面对位校正平台发展的基础是基于三轴共平面对位平台(以下简称XXY对位平台)而来,其架构于将四座平移旋转单元架设于固定平台,并通过驱动器提供动力进而带动测量平台。
现有技术中的四轴共平面对位平台在进行搜寻工作原点时,四轴共平面对位平台除需考虑对X、Y轴向复归外,需还考虑θ轴向复归,其结构复杂,程序设置繁琐。
因此,急需一种只需考虑X、Y轴向复归且结构简单、操作程序简洁的四轴同平面校正平台及原点回归方法。
发明内容
本发明的目的在于提供一种只考虑X、Y轴向复归且结构简单、操作程序简洁的四轴同平面校正平台及原点回归方法。本发明采取了如下技术方案:
一种四轴同平面校正平台,包括:固定平台、设置于所述固定平台上的第一位移旋转单元、第二位移旋转单元、第三位移旋转单元和第四位移旋转单元;
所述固定平台,用于提供测量装置设置或固定;
所述第一位移旋转单元、第二位移旋转单元、第三位移旋转单元和第四位移旋转单元依次分布于所述固定平台四角,且均包括:
固设于所述固定平台的基板;
可沿直线往复移动地设置于所述基板上的下支撑座;
设置于所述基板上的驱动马达,所述驱动马达与所述下支撑座相对设置;
驱动机构,所述驱动机构设置于所述下支撑座的所述驱动马达侧,与所述驱动马达输出端固定连接,用于驱动所述下支撑座相对所述基板移动;
可沿直线往复移动地设置于所述下支撑座上的上支撑座,所述上支撑座的移动方向与所述下支撑座的移动方向垂直;
所述第一位移旋转单元的下支撑座与所述第三位移旋转单元的下支撑座移动方向相同;
所述第二位移旋转单元的下支撑座与所述第四位移旋转单元的下支撑座移动方向相同,且与所述第一位移旋转单元的下支撑座移动方向垂直。
进一步地,所述驱动机构为丝杠运动副;所述下支撑座与所述丝杠运动副的滑块固定连接。
进一步地,所述下支撑座与所述基板之间、所述下支撑座与所述上支撑座之间通过导轨和导槽结构连接。
进一步地,所述固定平台为XY平面,其中,所述第一位移旋转单元的下支撑座移动方向设定为X轴方向,所述第二位移旋转单元的下支撑座移动方向设定为Y轴方向。
进一步地,在对应所述第一位移旋转单元、第二位移旋转单元、第三位移旋转单元和第四位移旋转单元的下支撑座移动方向上,其所述基板分别设置有定位原点、正极限位点和负极限位点,所述正极限位点和负极限位点设置于所述定位原点两端,用于限定所述第一位移旋转单元、所述第二位移旋转单元、所述第三位移旋转单元和所述第四位移旋转单元移动范围;其中,正极限位点设置于所述定位原点的X轴或Y轴正向方向。
进一步地,对应所述第一位移旋转单元的定位原点、正极限位点和负极限位点分别设置为X1原点、X1+极限和X1-极限;对应所述第二位移旋转单元的定位原点、正极限位点和负极限位点分别设置为Y1原点、Y1+极限和Y1-极限;对应所述第三位移旋转单元的定位原点、正极限位点和负极限位点分别设置为X2原点、X2+极限和X2-极限;对应所述第四位移旋转单元的定位原点、正极限位点和负极限位点分别设置为Y2原点、Y2+极限和Y2-极限。
进一步地,对应所述第一位移旋转单元、所述第二位移旋转单元、所述第三位移旋转单元和所述第四位移旋转单元对应设置为X1位移旋转单元、Y1位移旋转单元、X2位移旋转单元和Y2位移旋转单元;所述驱动马达包括:分别对应所述X1位移旋转单元、所述Y1位移旋转单元、所述X2位移旋转单元、所述Y2位移旋转单元设置的X1单元驱动马达、Y1单元驱动马达、X2单元驱动马达、Y2单元驱动马达。
进一步地,所述传动机构为丝杠运动副。
一种四轴同平面校正平台原点回归方法,包括以下步骤:
S1、控制器同时驱动Y1单元驱动马达带动Y1位移旋转单元向Y1+极限和X2单元驱动马达带动X2位移旋转单元向X2+极限位移,直到感应到Y1+极限或X2+极限,即同时停止Y1单元驱动马达和X2单元驱动马达并停留在当前位置;
S2、控制器同时驱动Y2单元驱动马达带动Y2位移旋转单元向Y2+极限和X1单元驱动马达带动X1位移旋转单元向X1+极限位移,直到感应到Y2+极限或X1+极限,即同时停止Y2单元驱动马达和X1单元驱动马达并停留在当前位置;
S3、通过X1+极限、X1-极限、X2+极限、X2-极限、Y1+极限、Y1-极限、Y2+极限和Y2-极限状态来确定下一步复归动作:
1)Y1+极限和Y2+极限同时感应到时:控制器同时驱动X1单元驱动马达带动X1位移旋转单元向X1+极限和X2单元驱动马达带动X2位移旋转单元向X2+极限位移,直到感应到X1+极限或X2+极限,即同时停止X1单元驱动马达和X2单元驱动马达,并停留在当前位置,同时转跳到S6;
2)X1+极限和X2+极限同时感应到时,直接跳到S4;
3)X1+极限、X2+极限、Y1+极限、Y2+极限同时感应时,直接跳到S6;
S4、控制器同时驱动Y1单元驱动马达带动Y1位移旋转单元向Y1+极限和X1单元驱动马达带动X1位移旋转单元向X1-极限位移,直到感应到Y1+极限,即同时停止Y1单元驱动马达和X1单元驱动马达,并停留在当前位置;
S5、控制器同时驱动X1单元驱动马达带动X1位移旋转单元向X1+极限和Y2单元驱动马达带动Y2位移旋转单元向Y2+极限位移,直到感应到Y2+极限,即同时停止Y2单元驱动马达和X1单元驱动马达,并停留在当前位置;
S6、控制器同时驱动X1单元驱动马达带动X1位移旋转单元向X1-极限和X2单元驱动马达带动X2位移旋转单元向X2-极限位移,直到感应到X1原点或X2原点,即同时停止X1和X2单元驱动马达,X轴原点复归完成;
控制器同时驱动Y1单元驱动马达带动Y1位移旋转单元向Y1-极限和Y2单元驱动马达带动Y2位移旋转单元向Y2-极限位移,直到感应到Y1原点或Y2原点,即同时停止Y1和Y2单元驱动马达,Y轴原点复归完成。
本发明有益效果:
本发明提供了一种四轴同平面校正平台及原点回归方法,在四轴共平面校正平台对位时只产生X、Y复合偏移量时,其控制程序简洁,平台结构简单,工作效率高。
附图说明
图1一种四轴同平面校正平台俯视结构示意图
其中,1、X1位移旋转单元;2、X1单元驱动马达;3、Y1位移旋转单元;4、Y1单元驱动马达;5、X2位移旋转单元;6、X2单元驱动马达;7、Y2位移旋转单元;8、Y2单元驱动马达;9、驱动机构;10、固定平台;11、X1-极限;12、X1原点;13、X1+极限;14、Y1+极限;15、Y1原点;16、Y1-极限;17、X2+极限;18、X2原点;19、X2-极限;20、Y2-极限;21、Y2原点;22、Y2+极限。
具体实施方式
实施例1
一种四轴同平面校正平台,包括:固定平台10、设置于固定平台10上的第一位移旋转单元、第二位移旋转单元、第三位移旋转单元和第四位移旋转单元;
固定平台10,用于提供测量装置设置或固定;
第一位移旋转单元、第二位移旋转单元、第三位移旋转单元和第四位移旋转单元依次分布于固定平台10四角,且均包括:
固设于固定平台10的基板;
可沿直线往复移动地设置于基板上的下支撑座;
设置于基板上的驱动马达,驱动马达与下支撑座相对设置;
驱动机构9,驱动机构9设置于下支撑座的驱动马达侧,与驱动马达输出端固定连接,用于驱动下支撑座相对基板移动;
可沿直线往复移动地设置于下支撑座上的上支撑座,上支撑座的移动方向与下支撑座的移动方向垂直;
第一位移旋转单元的下支撑座与第三位移旋转单元的下支撑座移动方向相同;
第二位移旋转单元的下支撑座与第四位移旋转单元的下支撑座移动方向相同,且与第一位移旋转单元的下支撑座移动方向垂直。
本实施例中,驱动机构9为丝杠运动副;下支撑座与丝杠运动副的滑块固定连接。
其中,下支撑座与基板之间、下支撑座与上支撑座之间通过导轨和导槽结构连接。
本实施例中,固定平台10为XY平面,其中,第一位移旋转单元的下支撑座移动方向设定为X轴方向,第二位移旋转单元的下支撑座移动方向设定为Y轴方向。
其中,在对应第一位移旋转单元、第二位移旋转单元、第三位移旋转单元和第四位移旋转单元的下支撑座移动方向上,其基板分别设置有定位原点、正极限位点和负极限位点,正极限位点和负极限位点设置于定位原点两端,用于限定第一位移旋转单元、第二位移旋转单元、第三位移旋转单元和第四位移旋转单元移动范围;其中,正极限位点设置于定位原点的X轴或Y轴正向方向。
对应第一位移旋转单元的定位原点、正极限位点和负极限位点分别设置为X1原点12、X1+极限13和X1-极限11;对应第二位移旋转单元的定位原点、正极限位点和负极限位点分别设置为Y1原点15、Y1+极限14和Y1-极限16;对应第三位移旋转单元的定位原点、正极限位点和负极限位点分别设置为X2原点18、X2+极限17和X2-极限19;对应第四位移旋转单元的定位原点、正极限位点和负极限位点分别设置为Y2原点21、Y2+极限22和Y2-极限20。
对应第一位移旋转单元、第二位移旋转单元、第三位移旋转单元和第四位移旋转单元对应设置为X1位移旋转单元1、Y1位移旋转单元3、X2位移旋转单元5和Y2位移旋转单元7;驱动马达包括:分别对应X1位移旋转单元1、Y1位移旋转单元3、X2位移旋转单元5、Y2位移旋转单元7设置的X1单元驱动马达2、Y1单元驱动马达4、X2单元驱动马达6、Y2单元驱动马达8。
实施例2
一种四轴同平面校正平台原点回归方法,包括以下步骤:
S1、控制器同时驱动Y1单元驱动马达4带动Y1位移旋转单元向Y1+极限14和X2单元驱动马达6带动X2位移旋转单元向X2+极限17位移,直到感应到Y1+极限14或X2+极限17,即同时停止Y1单元驱动马达4和X2单元驱动马达6并停留在当前位置;
S2、控制器同时驱动Y2单元驱动马达8带动Y2位移旋转单元向Y2+极限22和X1单元驱动马达2带动X1位移旋转单元向X1+极限13位移,直到感应到Y2+极限22或X1+极限13,即同时停止Y2单元驱动马达8和X1单元驱动马达2并停留在当前位置;
S3、通过X1+极限13、X1-极限11、X2+极限17、X2-极限19、Y1+极限14、Y1-极限16、Y2+极限22和Y2-极限20状态来确定下一步复归动作:
1)Y1+极限14和Y2+极限22同时感应到时:控制器同时驱动X1单元驱动马达2带动X1位移旋转单元向X1+极限13和X2单元驱动马达6带动X2位移旋转单元向X2+极限17位移,直到感应到X1+极限13或X2+极限17,即同时停止X1单元驱动马达2和X2单元驱动马达6,并停留在当前位置,同时转跳到S6;
2)X1+极限13和X2+极限17同时感应到时,直接跳到S4;
3)X1+极限13、X2+极限17、Y1+极限14、Y2+极限22同时感应时,直接跳到S6;
S4、控制器同时驱动Y1单元驱动马达4带动Y1位移旋转单元向Y1+极限14和X1单元驱动马达2带动X1位移旋转单元向X1-极限11位移,直到感应到Y1+极限14,即同时停止Y1单元驱动马达4和X1单元驱动马达2,并停留在当前位置;
S5、控制器同时驱动X1单元驱动马达2带动X1位移旋转单元向X1+极限13和Y2单元驱动马达8带动Y2位移旋转单元向Y2+极限22位移,直到感应到Y2+极限22,即同时停止Y2单元驱动马达8和X1单元驱动马达2,并停留在当前位置;
S6、控制器同时驱动X1单元驱动马达2带动X1位移旋转单元向X1-极限11和X2单元驱动马达6带动X2位移旋转单元向X2-极限19位移,直到感应到X1原点12或X2原点18,即同时停止X1和X2单元驱动马达6,X轴原点复归完成;
控制器同时驱动Y1单元驱动马达4带动Y1位移旋转单元向Y1-极限18和Y2单元驱动马达8带动Y2位移旋转单元向Y2-极限20位移,直到感应到Y1原点15或Y2原点21,即同时停止Y1和Y2单元驱动马达8,Y轴原点复归完成。
以上所述,仅是本发明较佳实施例而已,并非对本发明的技术范围作任何限制,故凡是依据本发明的技术实质对以上实施例所作的任何细微修改、等同变化与修饰,均仍属于本发明技术方案的范围的。