一种伺服系统及安全控制方法与流程
本发明属于工业自动化和伺服控制,具体涉及一种伺服系统及安全控制方法。
背景技术:
1、工业机器人、特种装备及提升设备中,伺服电机通常配备机械抱闸(制动器),以防止电机在断电或静止状态下,因重力作用导致负载坠落。现有技术中标准的控制流程为:控制器先向驱动器发送“使能”指令,待功率模块准备就绪后输出“抱闸解脱”信号,最后发送速度或转矩指令驱动电机运行。这是一种典型的开环顺序控制方式,存在以下突出问题:
2、第一,使能失效导致的坠落风险。若“使能”指令未能成功执行(驱动信号异常、功率器件损坏等),但控制系统误判使能已完成并继续执行“抱闸解脱”指令,机械抱闸打开后,电机无法输出抗衡重力的转矩,负载将在重力作用下瞬间坠落。现有技术主要依赖延时或驱动器的状态字反馈判断使能状态,但这种反馈是电气层面的,无法验证驱动器是否实际具备输出电磁转矩的能力。
3、第二,抱闸未解脱导致的堵转风险。若“抱闸解脱”指令发出后,抱闸因机械卡滞、衔铁卡滞、线圈烧毁或供电故障而未能实际打开,控制系统仍按正常流程向驱动器发送速度指令,会导致电机在堵转状态下长时间通电,极易烧毁电机绕组或损坏驱动器功率器件。现有技术中的解决方案主要包括:(a)在抱闸机械结构上安装物理微动开关,通过通断状态判断抱闸是否打开,但存在安装空间受限、触点氧化、机械卡滞等问题;(b)通过增加检测硬件检测抱闸线圈电流判断抱闸状态,但也无法识别“线圈得电但衔铁卡滞”等机械失效情况。
4、第三,抱闸打开瞬间微跌落风险。即使采用零速悬停或前馈补偿,现有方案也往往是在抱闸打开的同时或之后才建立电磁转矩,导致在抱闸打开的瞬间负载突然转移到电机,产生小幅跌落,影响高精度定位。授权公告号为cn119077729b的中国发明专利公开了一种静态平衡力矩补偿方法,但其补偿值依赖预设或历史运行记录,对负载变化或不同起始位置的适应性有限,补偿不精确,需要微跌落后进行修正,无法从根本上消除微跌落风险。
5、第四,缺乏对负载支撑状态的主动验证。现有技术在抱闸打开后直接转入运行,没有验证负载是否被电磁转矩可靠支撑。当出现机械卡滞、角度传感器故障等隐形故障时,系统可能误判安全而继续运行,存在安全隐患。
6、上述四个问题并非孤立存在,而是在“使能-抱闸打开-负载转移-正常运行”的启动过渡过程中依次暴露的。现有技术多针对单一环节进行改进,缺乏贯穿全流程的系统性安全设计,各安全措施之间缺少时序配合和功能互补,难以形成完整的保护闭环。
技术实现思路
1、本发明的目的在于提供一种伺服系统及安全控制方法,用以解决现有技术中多针对“使能-抱闸打开-负载转移-正常运行”中的单一环节进行改进造成的难以形成完整的保护闭环的问题。
2、为解决上述技术问题,本发明第一方面提供了一种伺服系统安全控制方法,该方法包括:
3、控制器向驱动器发出启动指令以使驱动器开始上电自检,在接收到驱动器返回的自检通过状态后,向驱动器发送使能指令进而接收驱动器返回的使能状态;
4、若接收到的使能状态表征使能功能生效,则向驱动器发送零转速指令,进而获取负载角度并确定其对应的驱动器的稳态转矩电流,将该稳态转矩电流作为前馈电流从而得到最终的电流指令来驱动电机;
5、发出抱闸解脱指令,并通过驱动器向电机绕组注入高频电压,获取电机绕组的高频电流响应并从中提取阻抗特性,根据阻抗特性判断抱闸状态;
6、若抱闸状态为完全解脱,则使电机由零转速模式切换为转矩控制模式,并在电流指令上叠加微动探针电流脉冲,进而观测负载角度位移,根据负载角度位移判断负载是否完全由电机电磁转矩支撑,根据判断结果确定系统是否转入正常运行。
7、在一种可能实现的方式中,驱动器的稳态转矩电流与负载角度之间的关系为带偏置的余弦曲线关系,且曲线关系中的拟合参数是采用如下方式确定的:在首次运行或定期执行自学习时,控制电机以极低速旋转,记录不同负载角度下驱动器的稳态转矩电流值,通过曲线拟合得到所述曲线关系。
8、在一种可能实现的方式中,所述阻抗特性包括阻抗幅值和相位角;根据阻抗特性判断抱闸状态的方式为:
9、若电机相电阻较小,则根据阻抗幅值判断抱闸状态:若阻抗幅值大于预设阻抗阈值则抱闸已完全解脱,若阻抗幅值小于等于预设阻抗阈值则抱闸为未解脱或处于半抱死状态;
10、否则根据阻抗幅值和相位角判断抱闸状态:若阻抗幅值大于预设阻抗阈值且相位角大于预设相位角阈值则抱闸已完全解脱,若阻抗幅值小于等于预设阻抗阈值或相位角小于等于预设相位角阈值则抱闸为未解脱或处于半抱死状态。
11、在一种可能实现的方式中,根据负载角度位移判断负载是否完全由电机电磁转矩支撑的方式为:若负载角度位移大于预设位移阈值则表征负载已完全由电机电磁转矩支撑。
12、在一种可能实现的方式中,驱动器上电自检的过程包括:检测直流母线电压是否在允许范围内、电机反馈是否正常和功率链路完整性,若直流母线电压在允许范围内、电机反馈正常和功率链路完整性良好则返回自检通过状态。
13、在一种可能实现的方式中,检测功率链路完整性的方式为:向电机绕组注入一组高频、低幅值的电压检测信号,分析反馈电流响应的纹波斜率是否符合预设特征,若符合则表明功率链路完整性良好。
14、在一种可能实现的方式中,注入的高频电压采用低幅值和短时间的信号。
15、在一种可能实现的方式中,若未接收到驱动器返回的自检通过状态、接收到驱动器返回的使能状态表征使能功能未生效、抱闸状态为未完全解脱、或者负载未完全由电机电磁转矩支撑,则撤销抱闸解脱信号、撤销驱动器的使能信号、封锁pwm脉冲输出,并报相应故障。
16、在一种可能实现的方式中,带偏置的余弦曲线关系的数学表达式为:
17、
18、式中,为驱动器的稳态转矩电流,为负载角度,a和b为拟合参数。
19、为解决上述技术问题,本发明第二方面提供了一种伺服系统,包括控制器、驱动器、伺服电机、减速器和角度传感器,控制器通过驱动器驱动伺服电机,该控制器包括处理器,所述处理器用于执行计算机程序以实现本发明第一方面中任一种可能实现的方式中方法的步骤。
20、本发明的有益效果为:本发明构建了一种贯穿全流程的多维度安全互锁机制,使电机电磁转矩精确平衡负载重力矩、准确辨识抱闸的真实机械状态、主动验证负载已被可靠支撑,从而消除坠落风险、堵转风险和微跌落风险,实现从机械抱闸到电磁转矩支撑的安全无缝转移。其中,通过使能状态自检与闭环确认确保仅在使能真正生效后才允许后续操作,解决了现有技术仅依赖驱动器状态字反馈,无法验证驱动器实际电磁转矩输出能力的缺陷;在抱闸打开前已根据实时角度精确计算并注入负载重力矩对应的电流前馈,使电机在抱闸打开时有电磁转矩承担负载,实现零位移转移;利用高频信号注入法直接辨识抱闸机械状态,无需依赖易失效的物理开关或抱闸线圈电流;并通过微动试探进行冗余确认,形成双重验证,确保抱闸真正解脱后才允许发送运动指令。综上,本发明在同一控制时序中,实现了“使能状态验证、抱闸机械状态辨识、负载支撑状态确认”三个维度的信息相互印证与互锁,使不同安全验证手段相互配合、互为冗余,形成一个各步骤功能互补、时序紧密的有机整体。同时,整个方案完全利用伺服系统现有的硬件架构实现,无需增加任何额外传感器或检查电路。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com