一种用于A3并联动力头的限位保护方法技术

本发明专利技术公开了一种用于A3并联动力头的限位保护方法，包括：步骤1，在每条支链的丝杠行程两端安装超限保护行程开关，行程开关信号输出端接入A3并联动力头数控系统保护电路；步骤2，实时采集A3并联动力头三条支链的长度信息；步骤3，预处理支链长度信息；步骤4，建立动平台位姿限位判据；步骤5，实时限位保护并联动力头。该方法从支链运动超程保护和数控系统限位保护两个方面实现限位保护功能，借助位姿判断简化算法，仅需机构中三条支链长度的求和、求差运算结果即可实现对任意位形下动平台是否超限进行实时判别，该方法计算量小、流程简单。通过软、硬件相结合的方式，实现A3并联动力头的限位保护，提高此类结构机床的操作安全性。

【技术实现步骤摘要】
一种用于A3并联动力头的限位保护方法
本专利技术涉及数控机床
，特别是一种用于A3并联动力头的限位保护方法。
技术介绍
A3并联动力头的拓扑结构为具有一平动两转动自由度的3-RPS并联机构，由固定架、动平台以及空间轴对称均布设置在固定架与动平台之间的三条结构相同的支链构成，每一条支链由支链体组件、丝杠组件、转动副组件构成。其中支链体组件包括球铰、直线导轨、支链伺服电机等，丝杠组件包括丝杠、联轴器等，转动副组件包括转动副、导轨滑块、丝杠螺母等。通过软限位与硬限位相结合的方式实现对机床的限位保护，是串联结构数控机床
的常用方法。软限位是指在数控系统中设定参数对数控机床进给轴进行位置限制，硬限位是指利用行程开关等限定机床进给轴的极限位置。由于A3并联动力头的并联拓扑结构特点，无法通过在运动支链上安装限位开关实现对动平台姿态的硬限位保护；软限位需要通过采集支链伺服电机信号、建模计算得出A3并联动力头机构末端在操作空间中的位姿。由于机构末端在操作空间中的位姿是关节空间伺服电机动作的非线性映射，建模计算过程复杂，占用运动控制器时间长，因此目前在A3并联动力头的数控系统中，是否超限只能通过离线计算的方式判别，而无法实现在机构运行中超限的实时判断与保护操作，机床运行存在安全隐患。
技术实现思路
本专利技术的目的是为了克服现有技术中的不足，提供一种用于A3并联动力头的限位保护方法，实现A3并联动力头的实时限位保护。该方法借助一种位姿判断简化算法实现，计算量小、流程简单，对运动控制器占用时间短。通过软、硬件相结合的方式，实现A3并联动力头的限位保护，提高此类结构机床的操作安全性。本专利技术的目的是通过以下技术方案实现的：一种用于A3并联动力头的限位保护方法，包括以下步骤：步骤1，在每条支链的丝杠行程两端安装超限保护行程开关，行程开关信号输出端接入A3并联动力头数控系统保护电路，用于限制丝杠组件的极限行程；步骤2，实时采集A3并联动力头三条支链的长度信息：实时采集支链伺服电机编码器信号，结合给定的支链滚珠丝杠参数和电机参数计算得出支链长度信息，即支链转动副几何中心到支链球铰几何中心的距离信息，信号的计算处理过程通过数控系统的运动控制器完成；步骤3，预处理支链长度信息：伺服控制系统实时反馈任意位姿状态下三条支链的长度，通过运动控制器进行求和运算，并对任意位姿状态下三条支链中任意两条支链的长度进行求差运算，所得结果存入运动控制器寄存器；步骤4，建立动平台位姿限位判据：在运动控制器中，实时判断求和运算、求差运算结果值是否超出设定的阈值，以此判断A3并联动力头的机构末端是否超出工作空间范围；步骤5，并联动力头实时限位保护：在运动中，若丝杠组件上的行程开关触发，输出触发信号至A3并联动力头数控系统保护电路，控制A3并联动力头停机，实现支链运动超限保护功能；若所得的求和及求差运算值均未超出对应限位区间的设定阈值，则A3并联动力头正常运行，数控系统不报警；求和及求差运算结果中只要有一项超出对应限位区间设定阈值，则输出超限标志位，数控系统报警并停机，从而实现数控系统的位姿限位保护功能。与现有技术相比，本专利技术的技术方案所带来的有益效果是：本专利技术方法可简单、可靠的实现对A3并联动力头的实时限位保护。实时采集支链伺服电机编码器信号获取支链长度信息后，仅需支链长度信息的求和运算、求差运算结果值即可判断A3并联动力头机构末端位姿是否超限，提升了限位保护功能的快速响应能力，提高了A3并联动力头的超限保护可靠性。该方法基于现有数控系统的软、硬件条件，通过软、硬件相结合的方式有效解决并联结构机床实时限位保护问题，提高此类拓扑结构机床的操作安全性。附图说明图1是A3并联动力头的结构示意图。图2是支链系统组成结构示意图。图3支链伺服进给闭环数控系统示意图。图4数控系统限位保护流程示意图。图5是A3并联动力头中各向量位置关系示意图。附图标记：1-动平台，2-支链A，3-固定架，4-支链B，5-支链C，6-球铰，7-直线导轨，8-支链体组件，9-丝杠，10-转动副，11-转动副组件，12-支链伺服电机，13-伺服电机编码器具体实施方式下面结合附图对本专利技术作进一步的描述。如图1和图2所示，A3并联动力头[1-3]通过驱动支链A2、支链B4、支链C5实现动平台1做相对于固定架3的一平动两转动运动，每条支链上的支链伺服电机12驱动丝杠9转动，带动转动副组件11套在支链体组件8上沿直线导轨7做直线相对运动，转动副10和球铰6之间产生相对运动使支链长度发生变化。如图3所示，支链长度是通过数控系统获取支链伺服电机12的码盘信息得到：数控系统IPC输入给定的运动指令，通过运动控制器PMAC内置的机构运动学模块解算得到电机的运动控制指令；运动控制指令通过伺服放大器驱动支链伺服电机12，驱动机构按照设定的轨迹运动；支链伺服电机12上的伺服电机编码器13将伺服电机磁极位置、转角及转速等信息反馈至支链伺服放大器，通过支链伺服放大器的信号变换后经由伺服接口附件发送至运动控制器PMAC，从而形成闭环数控系统精确实现支链的长度变化。运动控制器PMAC通过伺服电机12的反馈信息，得到限位控制中所需要的支链长度信息。支链运动超限保护的具体实施方式为：运动控制器PMAC运行的PLC程序检测行程开关状态信息，经由伺服接口附件ACC-34AA输入行程开关触发状态信号，数控系统保护电路决定数控系统发出支链运动超限保护指令，保护指令一旦发出，限位生效，机构运动停止。数控系统中的保护电路能够实现状态保持，要解除支链运动超限状态，需要通过运动控制器PMAC运行的PLC程序输出一个支链运动超限保护解除脉冲，否则支链运动超限保护将一直起作用使系统停机，以确保机床安全运行。如图4所示，数控系统位姿限位保护的具体实施方式为：数控系统中运动控制器PMAC实时采集伺服控制系统中的伺服电机编码器反馈信号后，获取支链A2、支链B4、支链C5的实时长度信息q1、q2、q3。当A3并联动力头动作时，运动控制器PMAC实时计算出三条支链长度之和Q和三条支链中任意两条支链长度之差Q'1、Q'2、Q'3，即：Q＝q1+q2+q3Q'1＝|q1-q2|，Q'2＝|q2-q3|，Q'3＝|q3-q1|并将Q和Q'1、Q'2、Q'3存入运动控制器寄存器。根据位姿判断简化算法可知，机构在设定的可达空间中运动，需满足动平台位姿限位判据，即：Qmin≤Q≤Qmax，0≤Q′1≤Q′max且0≤Q′2≤Q′max且0≤Q′3≤Q′max其中Qmin、Qmax、Q′max通过如下方法得出：1)如图5所示，得出q1w1+q2w2+q3w3＝a1+a2+a3-(b1+b2+b3)+3o将a1+a2+a3＝0，b1+b2+b3＝0代入取模可得|q1w1+q2w2+q3w3|＝3|o|得出|q1w1|+|q2w2|+|q3w3|≥3|o|即Q≥3|o||o|在动平台动作到最后端时取得最小值为|o|min，故令Qmin＝3|o|min2)如图5所示，利用矢量链法可得出qiwi＝ai-bi+o，i＝1，2，3将i带入后两端取模并求和，得出|q1w1|+|q2w2|+|q3w3|＝|a1-b1+o|+|a2-b2+o|+|a3-b3+o|将|qiwi|本文档来自技高网...

【技术保护点】
1.一种用于A3并联动力头的限位保护方法，其特征在于，包括以下步骤：步骤1，在每条支链的丝杠行程两端安装超限保护行程开关，行程开关信号输出端接入A3并联动力头数控系统保护电路，用于限制丝杠组件的极限行程；步骤2，实时采集A3并联动力头三条支链的长度信息：实时采集支链伺服电机编码器信号，结合给定的支链滚珠丝杠参数和电机参数计算得到支链长度信息，即支链转动副几何中心到支链球铰几何中心的距离信息，信号的计算处理过程通过数控系统的运动控制器完成；步骤3，预处理支链长度信息：伺服控制系统实时反馈任意位姿状态下三条支链的长度，通过运动控制器进行求和运算，并对任意位姿状态下三条支链中任意两条支链的长度进行求差运算，所得结果存入运动控制器寄存器；步骤4，建立动平台位姿限位判据：在运动控制器中，实时判断求和运算、求差运算结果值是否超出设定的阈值，以此判断A3并联动力头的机构末端是否超出工作空间范围；步骤5，并联动力头实时限位保护：在运动中，若丝杠组件上的行程开关触发，输出触发信号至A3并联动力头数控系统保护电路，控制A3并联动力头停机，实现支链运动超限保护功能；若所得的求和及求差运算值均未超出对应限位区间的设定阈值，则A3并联动力头正常运行，数控系统不报警；求和及求差运算结果中只要有一项超出对应限位区间设定阈值，则输出超限标志位，数控系统报警并停机，实现数控系统的位姿限位保护功能。...

【技术特征摘要】
1.一种用于A3并联动力头的限位保护方法，其特征在于，包括以下步骤：步骤1，在每条支链的丝杠行程两端安装超限保护行程开关，行程开关信号输出端接入A3并联动力头数控系统保护电路，用于限制丝杠组件的极限行程；步骤2，实时采集A3并联动力头三条支链的长度信息：实时采集支链伺服电机编码器信号，结合给定的支链滚珠丝杠参数和电机参数计算得到支链长度信息，即支链转动副几何中心到支链球铰几何中心的距离信息，信号的计算处理过程通过数控系统的运动控制器完成；步骤3，预处理支链长度信息：伺服控制系统实时反馈任意位姿状态下三条支链的长度，通过运动控制器进行求和运算，并对任意位姿状态下三条支链中任意两条支链的...

【专利技术属性】
技术研发人员：倪雁冰，贾石磊，王辉，
申请(专利权)人：天津大学，
类型：发明
国别省市：天津,12