[发明专利]四轴共平面对位平台的回归原点方法

说明书

技术领域

本发明涉及对位平台的控制领域，特别是指一种应用设置于象限角的平移旋转单元进行原点复归的四轴共平面对位平台的回归原点方法。

背景技术

四轴共平面对位平台发展的基础是基于三轴共平面对位平台(以下简称XXY对位平台)而来，其架构于将四座平移旋转单元架设于固定平台，并通过驱动器提供动力进而带动测量平台，其优点在于能够准确控制平移旋转单元的移动量，然而，测量平台的自由度都由驱动器所驱动，因此，在运动控制上较XXY对位平台复杂许多。

尤其当四轴共平面对位平台进行搜寻工作原点时，所述的四轴共平面对位平台除需对X、Y轴向复归外，还需对已存在的角度θ的偏移量作复归。由于其自由度都已被马达动力所控制，故应用XXY对位平台的搜寻工作原点的方法，并不适合应用于四轴共平面对位平台中。

换言之，如何控制四轴共平面对位平台的平移旋转单元使其应用于搜寻对位平台原点的方法，以增加工作效率，并减少机械卡死的情况，是业界重要的讨论课题。

本案发明人鉴于上述现有XXY对位平台回归原点不足以应用于四轴共平面对位平台，乃亟思加以改良创新，并经多年苦心孤诣潜心研究后，终于成功研发完成本件四轴共平面对位平台的回归原点方法。

发明内容

本发明的目的即在于提供一种四轴共平面对位平台的回归原点方法，使四轴共平面对位平台能够回归原点，同时避免因原点复归时四轴不同步运动造成平台卡死的状况。

为实现上述目的，本发明采用的技术方案是：

一种四轴共平面对位平台的回归原点方法，由一固定平台的象限角各设置一平移旋转单元，各象限角的各所述的平移旋转单元上共同设置一测量平台，各所述的平移旋转单元并受驱动装置带动，所述的驱动装置以矩形的位移路径设置有原点、正负极限感测器以及用来操控的控制器；其特征在于，所述回归原点方法的步骤包含有：

步骤1：控制器驱动沿着X轴向平行设置的两个驱动装置往负轴向移动，直到任一驱动装置受负极限感测器侦测，所述的控制器停止X轴向的两个驱动装置，并记录侦测的负极限感测器；

步骤2：控制器驱动沿着Y轴向平行设置的两个驱动装置往负轴向移动，直到任一驱动装置受负极限感测器侦测，所述的控制器停止Y轴向的两个驱动装置，并记录侦测的负极限感测器；

步骤3：控制器依据X轴与Y轴的负极限感测器进行逻辑组合，判断所述的测量平台角度偏移方向与角度，以控制所述的测量平台进行顺时针或逆时针角度旋转的复归程序；

步骤4：控制器驱动两个相邻且直角设置的驱动装置往负轴向移动，并以对角线的象限角为旋转中心，然后，施以顺时针角度旋转，直到任一驱动装置受负极限感测器侦测，所述的控制器停止驱动装置，即完成顺时针θ轴向复归；

步骤5：控制器驱动远离步骤4的驱动装置的两个相邻且直角设置的驱动装置往负轴向移动，并以对角线的象限角为旋转中心，然后，施以逆时针角度旋转，直到任一驱动装置受负极限感测器侦测，所述的控制器停止驱动装置，即完成逆时针θ轴向复归；

如此，完成所述的四轴共平面对位平台的工作原点回归动作。

所述的四轴共平面对位平台的回归原点方法，其中：还包含有一原点复归步骤，该步骤包含有控制器驱动所述的沿着X轴向平行设置的两个驱动装置往正轴向移动，直到任一驱动装置受原点感测器侦测，所述的控制器停止X轴向的两个驱动装置；接着驱动所述的沿着Y轴向平行设置的两个驱动装置往正轴向移动，直到任一驱动装置受原点感测器侦测，所述的控制器停止Y轴向的两个驱动装置；而控制器判断任三个原点感测器产生反应即完成原点复归步骤。

与现有技术相比较，本发明具有的有益效果是：如此，无论四轴共平面对位平台的测量平台6产生X、Y及θ的复合偏移量时，都可通过上述的控制方是回归原点，且不会造成机械卡死的情况发生。

附图说明

图1为本发明四轴共平面对位平台的俯视图；说明本发明结构概要；

图2为所述的四轴共平面对位平台的回归原点方法的流程方块图；

图3~图7为所述的四轴共平面对位平台产生顺时针角度误差时回归工作原点方法的动作示意图；

图8~11为所述的四轴共平面对位平台产生逆时针角度误差时回归工作原点方法的动作示意图；

图12为所述的四轴共平面对位平台回归原点的动作示意图。