一种智能流体传动伺服反馈控制系统及方法技术方案

本发明专利技术属于使用数字处理装置技术领域，公开了一种智能流体传动伺服反馈控制系统及方法，所述智能流体传动伺服反馈控制系统包括：转动行程检测模块、电流检测模块、负载检测模块、主控模块、电机复位模块、反馈模块、调整模块、同步模块。本发明专利技术通过电机复位模块能够在不安装各种类型辅助设备及配件的同时，有效并准确的对电机进行复位，降低了安装各种辅助设备及配件带来的成本，以及维护难度，同时简化了功能，节省了空间，使其应用领域更加广泛；同时通过同步模块以响应时间最短伺服驱动器的主地址作为所有伺服控制器的辅地址，可以使所有伺服控制器所控制的伺服电机实现同步。

【技术实现步骤摘要】
一种智能流体传动伺服反馈控制系统及方法
本专利技术属于使用数字处理装置
，尤其涉及一种智能流体传动伺服反馈控制系统及方法。
技术介绍
伺服控制系统用来精确地跟随或复现某个过程的反馈控制系统。在很多情况下，伺服系统专指被控制量(系统的输出量)是机械位移或位移速度、加速度的反馈控制系统，其作用是使输出的机械位移(或转角)准确地跟踪输入的位移(或转角)。伺服系统的结构组成和其他形式的反馈控制系统没有原则上的区别。然而，传统伺服电机复位功能，无法通过单纯的程序控制，需要单独在外部安装，传感器，光电开关等辅助设备及配件来帮助实现复位功能，这些设备及配件安装过程繁琐，功能复杂，成本高，稳定性差，并且提高了设备维护的难度；同时现有不同的伺服驱动器接收到主控制器所发出的位置指令时间是不一样的，因此时间延迟将导致伺服驱动器所控制的伺服电机启动一开始就不同步，特别是延迟时间太大或要求定位速度快，伺服电机的同步误差就更高。综上所述，现有技术存在的问题是：(1)传统伺服电机复位功能，无法通过单纯的程序控制，需要单独在外部安装，传感器，光电开关等辅助设备及配件来帮助实现复位功能，这些设备及配件安装过程繁琐，功能复杂，成本高，稳定性差，并且提高了设备维护的难度；同时现有不同的伺服驱动器接收到主控制器所发出的位置指令时间是不一样的，因此时间延迟将导致伺服驱动器所控制的伺服电机启动一开始就不同步，特别是延迟时间太大或要求定位速度快，伺服电机的同步误差就更高。(2)现有的伺服电机的控制器的控制精度低、成本高。
技术实现思路
针对现有技术存在的问题，本专利技术提供了一种智能流体传动伺服反馈控制系统及方法。本专利技术是这样实现的，一种智能流体传动伺服反馈控制方法，所述智能流体传动伺服反馈控制方法包括：(1)检测伺服电机的转动行程，并且输出表示转动行程的脉冲反馈信号；所述转动行程的液压油泄漏量表示为：式中：d为液压缸内径，h为活塞与缸壁间缝隙高度，Δp为缝隙两端压力差，μ为液压油动力黏度，l为缝隙长度；液压缸的油液动力黏度表示为：式中:μ0为1个大气压下，温度为t0时纯油的动力黏度；μ为压力为p、温度为t、油液中混入气体量为B时的油液动力黏度；λ为黏温系数，α为黏压系数；(2)通过霍尔感应器检测伺服电机的电流，并且输出表示该电流的电流反馈信号；(3)当伺服电机在指定转动行程下且到达指定转动行程时，获取基于霍尔感应器以输出的惯性负载电流；当伺服电机在指定转动行程下，获取基于编码器以输出的惯性脉冲数；(4)通过主控制器控制各个模块正常工作；(5)确定伺服电机参数，对伺服电机采用增量式数字PID增量式算法计算横向位置进行复位操作；所述伺服电机参数的确定方法包括：(1)目标位置值的确定，R＝512×4＝2084计数值/圈；P＝R×2000＝4168000计数值；将P转为16进制为P＝003F9940H。(2)速度值的确定V＝RT×50＝26.675200计数值/采样周期；载入的速度值：V＝V×65536＝1748185.90取整V＝1748185；将V转为16进制V＝001AACD9H；(3)加速度值的确定A＝RTT×10＝0.000136577；载入的加速度值：A＝A×65536＝8.950711844；取整A＝8；将A转为16进制，A＝00000008H；所述复位操作采用增量式数字PID增量式算法计算横向位置，调整横向位置；所述采用增量式数字PID增量式算法的数学模型为：Δu(k)＝Kp[e(k)-e(k-1)]+Kie(k)+Kd[e(k)-e(k-1)+e(k-2)]；式中，Δu(k)为当前控制量u(k)和此前时刻控制量u(k-1)的变化量Kp、Ki、Kd分别为比例、积分和微分控制参数，e(k)、e(k-1)、e(k-2)分别为当前测量、前次测量和前两次测量的偏差值；(6)接收主控制器发送的位置扫描指令，并对位置扫描指令向所述主控制器反馈响应时间以及对应的主地址；(7)接收主控制器所发送的写辅地址指令和写脉冲位置差指令，并将所接收到的写辅地址指令中的辅地址写入其辅地址寄存器中；将写脉冲位置差指令中的脉冲位置差写入其位置差寄存器中；(8)接收来自主控制器的包含辅地址以及指定启动位置信息的伺服启动命令，以其各自脉冲位置差和预定位方法对指定启动位置进行调整，并控制其伺服电机在调整后的启动位置上进行启动，以实现所有伺服电机的同步运动。进一步，所述预定位方法包括：将短时间脉冲电压矢量V1、V4通入电机绕组，电度角相差180°，脉冲周期为30μs；在电压矢量结束时检测电流I1、I4，如果I1＞I4，且|I1－I4|＞ΔI，ΔI为电流比较阈值)，则可知转子的N极在将转子位置定位在180°电度角内；V1、V4作用时转子位置可能会出现使|I1－I4|＜ΔI的情况，无法区分转子所在区域；通入电压矢量V2、V5，检测I2、I5可重新将转子定位在180°电度角内；在180°电度角范围确定后，再给绕组通入短时间脉冲电压矢量V2、V6，检测电流I2、I6，如果I1＞I2且I1＞I6，则转子的位置可以进一步缩小到60°以内的阴影区域；I2＞I1且I2＞I6时，转子则位于逆时钟方向30°～90°区间。进一步，所述电机复位方法如下：步骤一：按下电机复位开关，所述电机复位开关启动；步骤二：所述电机沿顺时针或逆时针方向旋转，直到触碰到第一限位开关；步骤三：碰触到步骤二中所述第一限位开关持续一定时间后，所述电机停止转动，并向系统发送电机停止信号；步骤四：系统接收到步骤三中所述电机停止信号后，记录所述电机当前所在位置A，并向所述电机发送运动指令，所述电机沿逆时针或顺时针方向旋转，直到触碰到第二限位开关；步骤五：触碰到步骤四中所述第二限位开关持续一定时间后，所述电机停止转动，并向系统发送电机停止信号；步骤六：系统接收到步骤五中所述电机停止信号后，记录所述电机当前所在位置B，并向所述电机发送运动指令，同时按照一定的计算公式，计算所述电机复位所在位置C；步骤七：所述电机顺时针或逆时针旋转到步骤六中所述位置C，并向系统发送复位完成信号。进一步，同步方法如下：首先，对所述多个伺服驱动器发送位置扫描指令，并接收所述多个伺服驱动器对所述位置扫描指令分别反馈的响应时间以及反馈对应的主地址；然后，根据所接收到的多个伺服驱动器分别反馈的主地址以及响应时间，将响应时间最短伺服驱动器的主地址作为辅地址，以及根据每一伺服驱动器响应时间与最短响应时间之间的差值，为每一伺服驱动器确定其对应的脉冲位置差，并将所述辅地址以及脉冲位置差发送给相应的伺服驱动器；最后，伺服驱动器向所述多个伺服驱动器同时发送具有辅地址以及指定启动位置信息的执行指令，使得所述多个伺服驱动器以其各自脉冲位置差对所述指定启动位置进行调整，并控制其伺服电机在调整后的启动位置上进行启动，以实现所有伺服电机的同步运动。进一步，所述根据每一伺服驱动器响应时间与最短响应时间之间的差值，为每一伺服驱动器生成其对应的脉冲位置差的步骤具体为：通过公式(Ti-Tj)*V计算来获得伺服驱动器每一伺服驱动器与所述响应时间最短伺服驱动器之间的脉冲位置差是；其中，Tj为所述响应时间最短伺服驱动器的响应时间，Ti为伺服驱动器每一伺服驱动器的响应时间，V为所述响应时间最本文档来自技高网...

【技术保护点】
1.一种智能流体传动伺服反馈控制方法，其特征在于，所述智能流体传动伺服反馈控制方法包括：(1)检测伺服电机的转动行程，并且输出表示转动行程的脉冲反馈信号；所述转动行程的液压油泄漏量表示为：

【技术特征摘要】
1.一种智能流体传动伺服反馈控制方法，其特征在于，所述智能流体传动伺服反馈控制方法包括：(1)检测伺服电机的转动行程，并且输出表示转动行程的脉冲反馈信号；所述转动行程的液压油泄漏量表示为：式中：d为液压缸内径，h为活塞与缸壁间缝隙高度，Δp为缝隙两端压力差，μ为液压油动力黏度，l为缝隙长度；液压缸的油液动力黏度表示为：式中:μ0为1个大气压下，温度为t0时纯油的动力黏度；μ为压力为p、温度为t、油液中混入气体量为B时的油液动力黏度；λ为黏温系数，α为黏压系数；(2)通过霍尔感应器检测伺服电机的电流，并且输出表示该电流的电流反馈信号；(3)当伺服电机在指定转动行程下且到达指定转动行程时，获取基于霍尔感应器以输出的惯性负载电流；当伺服电机在指定转动行程下，获取基于编码器以输出的惯性脉冲数；(4)通过主控制器控制各个模块正常工作；(5)确定伺服电机参数，对伺服电机采用增量式数字PID增量式算法计算横向位置进行复位操作；所述伺服电机参数的确定方法包括：(1)目标位置值的确定，R＝512×4＝2084计数值/圈；P＝R×2000＝4168000计数值；将P转为16进制为P＝003F9940H；(2)速度值的确定V＝RT×50＝26.675200计数值/采样周期；载入的速度值：V＝V×65536＝1748185.90取整V＝1748185；将V转为16进制V＝001AACD9H；(3)加速度值的确定A＝RTT×10＝0.000136577；载入的加速度值：A＝A×65536＝8.950711844；取整A＝8；将A转为16进制，A＝00000008H；所述复位操作采用增量式数字PID增量式算法计算横向位置，调整横向位置；所述采用增量式数字PID增量式算法的数学模型为：Δu(k)＝KP[e(k)-e(k-1)]+Kie(k)+Kd[e(k)-e(k-1)+e(k-2)]；式中，Δu(k)为当前控制量u(k)和此前时刻控制量u(k-1)的变化量Kp、Ki、Kd分别为比例、积分和微分控制参数，e(k)、e(k-1)、e(k-2)分别为当前测量、前次测量和前两次测量的偏差值；(6)接收主控制器发送的位置扫描指令，并对位置扫描指令向所述主控制器反馈响应时间以及对应的主地址；(7)接收主控制器所发送的写辅地址指令和写脉冲位置差指令，并将所接收到的写辅地址指令中的辅地址写入其辅地址寄存器中；将写脉冲位置差指令中的脉冲位置差写入其位置差寄存器中；(8)接收来自主控制器的包含辅地址以及指定启动位置信息的伺服启动命令，以其各自脉冲位置差和预定位方法对指定启动位置进行调整，并控制其伺服电机在调整后的启动位置上进行启动，以实现所有伺服电机的同步运动。2.如权利要求1所述的智能流体传动伺服反馈控制方法，其特征在于，所述预定位方法包括：将短时间脉冲电压矢量V1、V4通入电机绕组，电度角相差180°，脉冲周期为30μs；在电压矢量结束时检测电流I1、I4，如果I1＞I4，且|I1－I4|＞ΔI，ΔI为电流比较阈值)，则可知转子的N极在将转子位置定位在180°电度角内；V1、V4作用时转子位置可能会出现使|I1－I4|＜ΔI的情况，无法区分转子所在区域；通入电压矢量V2、V5，检测I2、I5可重新将转子定位在180°电度角内；在180°电度角范围确定后，再给绕组通入短时间脉冲电压矢量V2、V6，检测电流I2、I6，如果I1＞I2且I1＞I6，则转子的位置可以进一步缩小到60°以内的阴影区域；I2＞I1且I2＞I6时，转子则位于逆时钟方向30°～90°区间。3.如权利要求1所述的智能流体传动伺服反馈控制方法，其特征在于，所述电机复位方法如下：步骤一：按下电机复位开关，所述电机复位开关启动；...

【专利技术属性】
技术研发人员：周小鹏，李良，杨永刚，
申请(专利权)人：重庆科技学院，
类型：发明
国别省市：重庆,50