[发明专利]一种机器人液压驱动转动关节闭环控制系统

摘要

本发明公开了一种机器人液压驱动转动关节闭环控制系统，驱动机构包括直流电机，直流电机与齿轮泵相连，执行机构包括液压转动关节，控制机构包括上位机，上位机通过USB接口与下位机相连，三位四通电磁换向阀的进油管路和出油管路上装有压力变送器，压力变送器与信号采集卡相连，电位传感器与信号采集卡相连，信号采集卡进一步与上位机相连，上位机与电机驱动器之间通过CAN总线通信模块连接。本发明对进油口、出油口压力值的检测并相应调节PWM占空比，对液压驱动液压转动关节转动角度、进油口和出油口压力的实时检测，对电机转速进行适时调节，从而形成闭环反馈回路，保证转动过程的平稳性，实现了运动控制的精确性。

主权项

1.一种机器人液压驱动转动关节闭环控制系统，包括驱动机构、执行机构和控制机构，电源模块为系统供电，其特征在于：驱动机构包括直流电机，直流电机与齿轮泵相连，执行机构包括液压转动关节，控制机构包括上位机，控制系统还包括电机驱动器、信号采集卡、三位四通电磁换向阀，上位机通过USB接口与下位机相连，齿轮泵与三位四通电磁换向阀相连，三位四通电磁换向阀的油路与液压转动关节相连，三位四通电磁换向阀的进油管路和出油管路上装有压力变送器，压力变送器与信号采集卡相连，液压转动关节上设有电位传感器，电位传感器与信号采集卡相连，信号采集卡进一步与上位机相连，上位机与电机驱动器之间通过CAN总线通信模块连接；所述电机通过联轴器与齿轮泵相连，齿轮泵的输出流量模型为Q＝q*n*v/60，其中Q为流量；q为齿轮泵平均每转流量；n为齿轮泵转速；v为容积效率；当液压系统的负载不变时，齿轮泵的输出流量决定了液压转动关节的转动速度；当负载发生改变时，液压转动关节的移动速度受到影响，相应地改变齿轮泵输出流量便可抵消此影响以提高液压转动关节转动的平稳性；所述上位机收到进油口和出油口压力值后，计算压力差△P＝Pi‑Po，Pi为进油口压力值，Po为出油口压力值；根据压力差△P，判断负载是否发生变化，并根据负载的变化实时调整用于控制电机转速的PWM的占空比D的值，上位机将占空比D的值通过CAN总线通信模块发送给电机驱动器，电机驱动器根据得到的PWM值控制直流电机转速。