[发明专利]基于动力学的斗轮堆取料机恒流量取料方法及装置

权利要求书

1.一种基于动力学的斗轮堆取料机恒流量取料方法，其特征在于，所述方法包括：

获取斗轮堆取料机的设备机械参数和基本运行数据；

根据所述设备机械参数和所述基本运行数据，基于机器人动力学理论建立所述斗轮堆取料机的动力学模型，并建立一种基于动力学模型的PID算法；所述动力学模型用于表征回转机构驱动力矩和回转、俯仰驱动机构角速度及角加速度之间的关系；

获取所述斗轮堆取料机的所述回转机构的实际驱动力矩，根据所述实际驱动力矩和所述动力学模型，通过所述PID算法得到所述斗轮堆取料机的所述回转机构所需调整的目标回转角速度和目标回转角加速度；

控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行，以使得所述斗轮堆取料机实现恒流量取料；

所述获取所述斗轮堆取料机的所述回转机构的实际驱动力矩，包括：

根据所述基本运行数据，计算得到驱动力矩和工作电流之间的关系式；

获取所述回转机构的实际工作电流，根据所述实际工作电流和所述关系式，得到所述回转机构的实际驱动力矩；

所述工作电流采用加权电流，其满足下述关系式：

I_W＝I_B+AI_S

其中，I_B为轮斗电机电流、I_S为回转电机电流、A为加权系数；对加权电流I_W采取分级控制模式，分别为设定值I_SV、偏大值I_H、过大值I_HH、保护值I_HHH；

所述控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行，包括：

当I_W∈(0，I_H)时，则根据计算出的所述目标回转角速度和目标回转角加速度进行恒流量回转取料作业，将输出值维持在设定值I_SV附近；

当I_W∈[I_H，I_HH)时，则停止回转动作；待加权电流I_W∈(0，I_H)时继续执行上述恒流量回转取料作业；

当I_W∈[I_HH，I_HHH)时，则调整大车的行走位置，自动后退设定的距离，待加权电流I_W∈(0，I_H)时继续执行上述恒流量回转取料作业，并累加和记录自动后退距离以便至下一个回转取料周期中使用；

在取料过程中发生严重的坍塌时导致I_W≥I_HHH，则紧急停机，停止取料作业。

2.根据权利要求1所述的方法，其特征在于，所述动力学模型满足下述关系式：

其中，S＝sin，C＝cos，m₂为回转机构的质量，m₃为悬臂机构的质量，m₄为斗轮支撑机构的质量，m₅为斗轮中心支架机构的质量，m_w为斗轮机构的质量，l₂为俯仰中心至回转中心的距离，l₃为悬臂长度，l₄为斗轮中心至回转中心的垂直高度，l₅为斗轮中心至悬臂中心的水平距离，θ₂为回转角度，为回转角速度，为回转角加速度，θ₃为悬臂的俯仰角度，为俯仰角速度，为俯仰角加速度。

3.根据权利要求1所述的方法，其特征在于，所述获取所述斗轮堆取料机的所述回转机构的实际驱动力矩，包括：

在所述回转机构上设置转矩测量传感器，根据所述转矩测量传感器得到所述回转机构的实际驱动力矩。