双直流电机驱动器电子差速防止车体倾覆控制系统及方法与流程

本发明涉及速度智能控制领域，更具体而言，涉及一种双直流电机驱动器电子差速防止车体倾覆控制系统及方法。

背景技术：

车体在运行过程中，如何保证车体在转弯的时候不发生倾覆，成为双机直流驱动的一个重要安全指标；尤其在车体的中心会发生变化时，采用固定设定参数方式，是很难在前进速度和快速转弯之间难以取得平衡；尤其在一部分轮式车和履带车平台安装上装后，运行路面情况复杂，更容易导致倾覆事故发生；尤其在排爆、消防、危险源侦测等应用中采用人遥控方式进行控制车体，更难以保障转弯的安全性。

专利申请号为cn105490594a的发明专利公开了双无刷低压直流电机驱动控制系统及方法，其描述的方法采用根据给定速度信号ssp和差速信号ssd直接计算分配两个电机速度speeda和speedb，根据该公式，当车辆发生转弯控制时，计算当ssp给定速度为超过一定车速时，ssd给定值超过零点值一定值后，会导致speeda和speedb产生很大速度差，大的速度差会引起一个非常小的转弯半径r；由于车体的重心位置高于地面，将会产生非常大的离心力f，根据离心力计算公式：r:转弯半径，v：当前线性车速，m：车体质量，f：离心力，

可以看到，当速度v达到一定值，r小于一定值时，f值会达到甚至超过导致车体倾覆的临界值，导致车体倾倒甚至翻车事故。因此发明专利号cn105490594a，专利名“双无刷低压直流电机驱动控制系统及方法”所述的差速控制方法是存在重大安全隐患。

综上所述，有必要对现有的发明专利“cn105490594a”混控模式下的差速控制进行改进。

技术实现要素：

为了克服上述现有技术中所存在的不足，本发明提供了双直流电机驱动器电子差速防止车体倾覆控制系统及方法，该系统及方法能够根据实时控制两路电机的负载特征进行量化，根据量化后数据进行调整车体等效前进速度v，保证车体转弯安全的前提下，获得最快的行进速度，可以有效避免车体发生倾覆的重大安全隐患。

为了解决上述技术问题，本发明采用的技术方案为：

双直流电机驱动器电子差速防止车体倾覆控制系统，包括核心控制器cpu、电源、电机a和电机b，所述核心控制cpu连接有用户输入输出接口、通信接口、电机a控制与驱动模块和电机b控制与驱动模块，所述电机a与电机a控制与驱动模块连接，所述电机b与电机b控制与驱动模块连接，所述电机a上设置有电机a速度反馈装置，所述电机b上设置有电机b速度反馈装置，所述电机a速度反馈装置连接有电机a速度检测模块，所述电机b速度反馈装置连接有电机b速度检测模块。

所述核心控制器cpu连接有电机a电流电压检测模块和电机b电流电压检测模块。

所述电源连接有检测控制电源模块和功率电源模块。

所述检测控制电源模块与用户输出输入接口、通信接口、电机a速度检测模块、电机a电流电压检测模块、电机b电流电压检测模块和电机b速度检测模块连接，所述功率电源模块与电机a控制与驱动模块、电机a、电机b控制与驱动模块和电机b连接。

所述电机a速度反馈装置和电机b速度反馈装置可以是霍尔编码器、增量编码器、绝对位置编码器或测速发电机中的一种。

双直流电机驱动器电子差速防止车体倾覆控制方法，包括如下步骤：

a.用户通过电源模块将电源接入设备，检测控制电源模块和功率电源模块将电源转化为设备需要的各种等级电源，设备开始启动；

b.用户通过用户输出输入接口或者通信接口给设备发送运行指令传动到核心控制器cpu，核心控制器cpu根据用户指令，对电机a控制与驱动模块和电机b控制与驱动模块实现功率输出；

c.电机a和电机b开始工作后,电机a电流电压检测模块实时检测电机a的运行电压v1(该电压信号不是一个电压值，是多个电压数据集合)、电流信号i1(该电流信号不是一个电流值，是多个电流数据集合)，电机a速度反馈装置将电机转速信号传输到电机a速度检测模块，由电机a速度检测模块将电机a速度信号传输到核心控制器cpu，由核心控制器cpu解析出当前实时速度speed1；电机b电流电压检测模块部分实时检测电机b的运行电压v2(该电压信号不是一个电压值，是多个电压数据集合)、电流信号i2(该电流信号不是一个电流值，是多个电流数据集合)，电机b速度反馈装置将电机转速信号传输到电机b速度检测模块，由电机b速度检测模块将电机a速度信号传输到核心控制器cpu，由核心控制器cpu解析出当前实时速度speed2；

d.核心控制器cpu根据对当前电机工作反馈信号处理，根据控制算法实现对电机a和电机b的控制。

所述步骤d中核心控制器cpu根据公式δx＝k1×|k2×x1-(1-k2)×x2|+l，进行分析车身是否具有倾覆危险，所述公式δx＝k1×|k2×x1-(1-k2)×x2|+l中x1为电机1的运行输出特性参量，x1＝f(v1,i1,speed1)的功率计算函数；x2为电机2的运行输出特性参量，x2＝f(v2,i2,speed2)的功率计算函数；k1为两个电机速度差的运算系数，k2为两个电机转弯负载变化运算系数；根据车体中心设置的一个浮点数，l为两电机运行时负载不均时调解补偿量；δx为两个电机参量差值量化后的数据。

所述公式δx＝k1×|k2×x1-(1-k2)×x2|+l和可得公式可得当speed1和speed2运行速度差值在允许范围δspeed之内时，δx不超过需要调节范围；当δx超过安全值，根据公式进行差速调节，t为信号处理周期，s为一个周期内信号需要叠加量，fi信号的滤波系数，δxi为i时刻得到的δx值，p为δx与速度之间计算系数。

所述公式中的f(δx)为δx转化为速度修正的传输函数，其公式为

与现有技术相比本发明所具有的有益效果为：

该设备可以同时驱动两台电机，并对两台电机实现开环、速度闭环、位置闭环控制；

该设备在驱动两台电机时，根据控制两台电机的速度不同实现车体转弯：

该设备具有保证车体稳定运行控制算法；

该控制算法在驱动两台电机进行电子差速转弯时，可以根据两台电机负载变化情况，保证车体运行中避免发生倾覆的事故；

该方法保证车体转弯安全的前提下，获得最快的行进速度，可以有效避免车体发生倾覆的重大安全隐患。

附图说明

图1为本发明的双直流电机驱动器电子差速防止车体倾覆控制系统的原理图；

图2为本发明的软件运行流程图。

图中：1为核心控制器cpu、2为用户输出输入接口、3为通信接口、4为监测控制电源模块、5为电源、6为功率电源模块、7为电机a速度检测模块、8为电机a控制与驱动模块、9为电机a电流电压检测模块、10为电机b电流电压检测模块。11为电机b控制与驱动模块、12为电机b速度检测模块、13为电机a、14为电机a速度反馈装置、15为电机b、16为电机b速度反馈装置。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护地范围。

如图1所示，双直流电机驱动器电子差速防止车体倾覆控制系统，包括核心控制器cpu1、电源5、电机a13和电机b15，核心控制器cpu1连接有用户输入输出接口2、通信接口3、电机a控制与驱动模块8和电机b控制与驱动模块11，用户输出输入接口2实现对驱动器双机的控制，通信接口3实现对驱动参数读取及启停、速度的控制，核心控制器cpu1控制将指令发送到电机a控制与驱动模块8和电机b控制与驱动模块11，电机a13与电机a控制与驱动模块8连接，电机b15与电机b控制与驱动模块11连接，控制与驱动模块控制电机的运转，电机a13上设置有电机a速度反馈装置14，电机b15上电机b速度反馈装置16，电机a速度反馈装置连接有电机a速度检测模块7，电机b速度反馈装置连接有电机b速度检测模块12，通过速度检测模块将电机a13和电机b15的速度信息反馈给核心控制器cpu1，核心控制器cpu1根据所收集的信息，处理之后将控制信号传输到电机a控制与驱动模块8和电机b控制与驱动模块11，实现闭环控制。

优选的，核心控制器cpu1连接有电机a电流电压检测模块9和电机b电流电压检测模块10，电流电压检测模块对电机a13和电机b15实时检测，为cpu控制策略提供电流反馈信号。

优选的，电源5连接有检测控制电源模块4和功率电源模块6，检测控制电源模块4与用户输出输入接口2、通信接口3、电机a速度检测模块7、电机a电流电压检测模块9、电机b电流电压检测模块10和电机b速度检测模块12连接，实现对控制检测部分电流的供电，功率电源模块6与电机a控制与驱动模块8、电机a13、电机b控制与驱动模块11和电机b15连接，实现对电机驱动功率部分供电和电源滤波处理功能，降低电机运行中对电源波动的影响。

优选的，电机a速度反馈装置14和电机b速度反馈装置16可以是霍尔编码器、增量编码器、绝对位置编码器或测速发电机中的一种。

如图2所示，本发明的双直流电机驱动器电子差速防止车体倾覆控制方法，包括如下步骤：

a.用户通过电源模块5将电源接入设备，检测控制电源模块4和功率电源模块6将电源转化为设备需要的各种等级电源，给各单元供电，设备开始启动，设备自检完成后，设备处于等待用户控制状态。

b.用户通过用户输出输入接口2或者通信接口3给设备发送运行指令传动到核心控制器cpu1，核心控制器cpu1根据用户指令，经过软件算法开始输出pwm信号，pwm信号对电机a控制与驱动模块(8)和电机b控制与驱动模块11实现功率输出，电机a控制与驱动模块8和电机b控制与驱动模块13分别驱动电机a13和电机b15.

c.电机a13和电机b15开始工作后,电机a电流电压检测模块9实时检测电机a13的运行电压v1(该电压信号不是一个电压值，是多个电压数据集合)、电流信号i1(该电流信号不是一个电流值，是多个电流数据集合)，电机a速度反馈装置14将电机转速信号传输到电机a速度检测模块7，由电机a速度检测模块7将电机a13速度信号传输到核心控制器cpu1，由核心控制器cpu1解析出当前实时速度speed1；电机b电流电压检测模块10部分实时检测电机b15的运行电压v2(该电压信号不是一个电压值，是多个电压数据集合)、电流信号i2(该电流信号不是一个电流值，是多个电流数据集合)，电机b速度反馈装置16将电机转速信号传输到电机b速度检测模块12，由电机b速度检测模块12将电机a13速度信号传输到核心控制器cpu1，由核心控制器cpu1解析出当前实时速度speed2。

d.核心控制器cpu1根据对当前电机工作反馈信号处理，根据控制算法实现对电机a13和电机b15的控制。

步骤d中核心控制器cpu1根据公式δx＝k1×|k2×x1-(1-k2)×x2|+l，进行分析车身是否具有倾覆危险，公式δx＝k1×|k2×x1-(1-k2)×x2|+l中x1为电机1的运行输出特性参量，x1＝f(v1,i1,speed1)的功率计算函数；x2为电机2的运行输出特性参量，x2＝f(v2,i2,speed2)的功率计算函数；k1为两个电机速度差的运算系数，k2为两个电机转弯负载变化运算系数，根据车体中心设置的一个浮点数。l为两电机运行时负载不均时调节补偿量；δx为两个电机参量差值量化后的数据。

当设备运行到差速状态时，计算δx值，当设备第一次进入差速计算时，由于检测的电压电流值为非差速下数据，因此第一次计算δx不会触发δx超差，而直接进入了差速速度计算，根据给定的速度值给定速度值speedv以及差速值speedd计算当前需要给定电机的新的speed1和speed2得速度值，然后差速速度给定两个电机速度完成电机给定数据，然后运行到“更新两个电机速度值”。

然后设备进入对电机控制状态，执行完毕控制状态程序后，进入电压电流检测程序，然后进入电机速度检测部分程序；检测完毕电压电流和速度后，电机进入是否有启停指令判断部分；如果设备没有停机指令，设备继续执行然后再次进入差速控制部分。

公式δx＝k1×|k2×x1-(1-k2)×x2|+l和可得公式可得当speed1和speed2运行速度差值在允许范围δspeed之内时，δx不超过需要调节范围，则不需要对电机进行差速减速调节；当δx超过安全值，根据公式进行差速调节，t为信号处理周期，s为一个周期内信号需要叠加量，fi信号的滤波系数，δxi为i时刻得到的δx值，p为δx与速度之间计算系数。

公式中的f(δx)为δx转化为速度修正的传输函数，其公式为计算差速给定两个电机速度，然后将更新两个电机的速度值，对两台电机实现速度闭环控制。车体将要发生倾覆时通过f(δx)降低车体运行的speed1和speed2速度，添加了δx计算的参数；在差速过程中也可以根据数据参量变化，对车体的车身稳定进行优化。可以提高在使用该算法的双机直流驱动器中得到车身运行的稳定性，降低车体倾覆的危险发生。

上面仅对本发明的较佳实施例作了详细说明，但是本发明并不限于上述实施例，在本领域普通技术人员所具备的知识范围内，还可以在不脱离本发明宗旨的前提下作出各种变化，各种变化均应包含在本发明的保护范围之内。