[发明专利]一种流机的自动控制方法、设备及介质

权利要求书

1.一种流机的自动控制方法，其特征在于，所述方法包括：

通过设置于流机上的姿态传感器，获取所述流机对应的当前姿态信息，以及通过设置于所述流机的上位机和下位机之间的角度传感器，获取所述流机对应的当前角度信息；

根据所述当前姿态信息以及当前角度信息，建立所述流机对应的三维模型，并从所述三维模型中，提取所述流机对应的关键点数据；其中，所述关键点数据至少包括：大臂、小臂和铲斗对应的油缸伸缩量，以及所述上位机和所述下位机之间的旋转角度值；

根据各关键点对应的油缸伸缩量以及旋转角度值，规划所述流机对应的目标位置，并根据所述流机的所处位置，确定各所述关键点运动至所述目标位置的运动轨迹；

根据所述运动轨迹对应的控制参数，生成所述流机对应的控制指令，并通过所述上位机，将所述对应的控制指令发送至所述下位机；

通过所述下位机，对所述控制指令进行解析，并根据解析后的控制指令，控制所述流机旋转以及铲斗伸缩，以实现对所述流机的自动控制。

2.根据权利要求1所述的一种流机的自动控制方法，其特征在于，根据各关键点对应的油缸伸缩量以及旋转角度值，规划所述流机对应的目标位置，具体包括：

根据所述大臂、小臂和铲斗对应的油缸伸缩量，以及所述上位机和所述下位机之间的旋转角度值，计算所述流机当前时刻的工作状态；

基于所述流机当前时刻的工作状态，确定所述流机对应的待挖掘任务，并在所述待挖掘任务对应的挖掘平面上铺设等距栅格；

在所述等距栅格上，确定出完成挖掘任务时对应的挖掘平面，并将完成所述挖掘任务时对应的挖据平面作为当前挖掘位置；

在所述等距栅格上，确定出与所述当前挖掘位置相邻的多个栅格交点，并计算各所述栅格交点对应的挖掘代价；

从所述多个栅格交点中，确定出挖掘代价最小的栅格交点，并将挖掘代价最小的所述栅格交点对应的挖据平面，规划为所述流机对应的目标位置。

3.根据权利要求1所述的一种流机的自动控制方法，其特征在于，根据所述流机的所处位置，确定各所述关键点运动至所述目标位置的运动轨迹，具体包括：

提取所述流机在所述三维模型中的坐标位置信息，以及所述三维模型的特征参数，并根据所述坐标位置信息以及所述三维模型的特征参数，实时得到所述流机在所述三维模型中的所处位置；

根据所述流机在所述三维模型中的所处位置，预测出所述流机的各关键点从所述所处位置运动到所述目标位置的多条运动轨迹；

确定所述多条运动轨迹分别对应的多个路段，以及各路段是否包括障碍物，并在所述路段存在障碍物时，确定所述障碍物在所述三维模型中的坐标信息；

基于所述障碍物在所述三维模型中的坐标信息，规划出所述流机的各所述关键点避开所述障碍物，运动至所述目标位置的运动轨迹。

4.根据权利要求1所述的一种流机的自动控制方法，其特征在于，根据所述运动轨迹对应的控制参数，生成所述流机对应的控制指令，具体包括：

接收所述流机对应的待挖掘任务的更新信息，并确定出所述更新信息对应的修改指令；

根据所述修改指令，对所述运动轨迹对应的控制参数进行更新，并根据更新后的所述控制参数，生成所述流机对应的控制指令。

5.根据权利要求1所述的一种流机的自动控制方法，其特征在于，根据所述运动轨迹对应的控制参数，生成所述流机对应的控制指令之后，所述方法还包括：

根据所述流机对应的当前姿态信息，确定所述流机在所述三维模型中的坐标位置信息，并将所述坐标位置信息对应的预设半径范围，作为所述流机对应的当前工作范围；

基于预先确定出的所述流机对应的运动学模型，以及所述流机对应的当前姿态信息，确定所述流机对应的下一工作范围；

确定所述流机对应的当前工作范围与所述流机对应的下一工作范围之间的相似度，并在所述相似度小于预设阈值时，通过所述流机的上位机，将所述流机对应的下一工作范围发送至所述下位机；

通过所述下位机对接收到的所述下一工作范围进行解析，并根据所述解析结果，控制所述流机在所述下一工作范围内工作。