CN113043931A - 一种智能驾驶货车的控制方法、装置、设备和存储介质 - Google Patents

一种智能驾驶货车的控制方法、装置、设备和存储介质 Download PDF

Info

Publication number
CN113043931A
CN113043931A CN202110364617.1A CN202110364617A CN113043931A CN 113043931 A CN113043931 A CN 113043931A CN 202110364617 A CN202110364617 A CN 202110364617A CN 113043931 A CN113043931 A CN 113043931A
Authority
CN
China
Prior art keywords
container
angle
frame
cargo box
collected
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110364617.1A
Other languages
English (en)
Other versions
CN113043931B (zh
Inventor
朱早贝
吕金桐
周立岩
黄加勇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Yikong Zhijia Technology Co Ltd
Original Assignee
Beijing Yikong Zhijia Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Yikong Zhijia Technology Co Ltd filed Critical Beijing Yikong Zhijia Technology Co Ltd
Priority to CN202110364617.1A priority Critical patent/CN113043931B/zh
Publication of CN113043931A publication Critical patent/CN113043931A/zh
Application granted granted Critical
Publication of CN113043931B publication Critical patent/CN113043931B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60P—VEHICLES ADAPTED FOR LOAD TRANSPORTATION OR TO TRANSPORT, TO CARRY, OR TO COMPRISE SPECIAL LOADS OR OBJECTS
    • B60P1/00—Vehicles predominantly for transporting loads and modified to facilitate loading, consolidating the load, or unloading
    • B60P1/04—Vehicles predominantly for transporting loads and modified to facilitate loading, consolidating the load, or unloading with a tipping movement of load-transporting element
    • B60P1/16—Vehicles predominantly for transporting loads and modified to facilitate loading, consolidating the load, or unloading with a tipping movement of load-transporting element actuated by fluid-operated mechanisms
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
    • B60R16/00—Electric or fluid circuits specially adapted for vehicles and not otherwise provided for; Arrangement of elements of electric or fluid circuits specially adapted for vehicles and not otherwise provided for
    • B60R16/02—Electric or fluid circuits specially adapted for vehicles and not otherwise provided for; Arrangement of elements of electric or fluid circuits specially adapted for vehicles and not otherwise provided for electric constitutive elements
    • B60R16/023—Electric or fluid circuits specially adapted for vehicles and not otherwise provided for; Arrangement of elements of electric or fluid circuits specially adapted for vehicles and not otherwise provided for electric constitutive elements for transmission of signals between vehicle parts or subsystems
    • B60R16/0231—Circuits relating to the driving or the functioning of the vehicle
    • B60R16/0232—Circuits relating to the driving or the functioning of the vehicle for measuring vehicle parameters and indicating critical, abnormal or dangerous conditions
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
    • B60R16/00—Electric or fluid circuits specially adapted for vehicles and not otherwise provided for; Arrangement of elements of electric or fluid circuits specially adapted for vehicles and not otherwise provided for
    • B60R16/02—Electric or fluid circuits specially adapted for vehicles and not otherwise provided for; Arrangement of elements of electric or fluid circuits specially adapted for vehicles and not otherwise provided for electric constitutive elements
    • B60R16/023—Electric or fluid circuits specially adapted for vehicles and not otherwise provided for; Arrangement of elements of electric or fluid circuits specially adapted for vehicles and not otherwise provided for electric constitutive elements for transmission of signals between vehicle parts or subsystems
    • B60R16/0231—Circuits relating to the driving or the functioning of the vehicle
    • B60R16/0232—Circuits relating to the driving or the functioning of the vehicle for measuring vehicle parameters and indicating critical, abnormal or dangerous conditions
    • B60R16/0233—Vehicle tilting, overturning or roll over
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/60—Other road transportation technologies with climate change mitigation effect
    • Y02T10/72—Electric energy management in electromobility

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Traffic Control Systems (AREA)

Abstract

本公开提供了一种智能驾驶货车的控制方法，该方法包括：采集车架的角度信息、货箱的角度信息、货箱的位置和货箱的运动方向，根据采集到的车架的角度信息和货箱的角度信息判断货箱的状态，根据货箱的状态和采集到的车架的角度信息、货箱的角度信息、货箱的运动方向、货箱的位置控制货箱。本公开时时采集车辆的角度信息，结合货箱的位置信息，不仅可以避免因为货箱角度抖振/误差导致货箱位置反馈失准的情况，能够准确识别货箱位置；还能够实时监测车架状态，在俯仰角或者横滚角超过限制阈值时候停止举升或者降斗，大大提升了智能驾驶车辆的货箱控制的性能。

Description

一种智能驾驶货车的控制方法、装置、设备和存储介质
技术领域
本公开属于智能驾驶领域，具体涉及一种智能驾驶货车的控制方法、装置、设备和存储介质。
背景技术
智能驾驶矿车在智慧矿山中扮演着重要的角色，可以说智能驾驶矿车是智慧矿山最终实现的关键一环。对于矿车而言，其在矿上扮演最终要的角色就是运输作业，其中的核心任务就是装载和卸载。卸载过程中必须要进行货箱的举升，对于智能驾驶矿车而言，由于是无人控制，智能驾驶系统需要在货箱举升过程中实时自动精确识别货箱状态，才能对货箱进行精确控制，避免因为货箱状态识别错误导致的风险。
目前对于举升系统更多的集中在具体的举升系统设计，对于如何精确识别货箱举升状态基本没有设计，但是对于智能驾驶矿车而言，要实现高性能，高安全的货箱举升控制，实时精确识别货箱状态是前提。现有技术中，均只是通过角度传感器采集货箱举升角度，但是均是基于人工驾驶车辆而言，对于智能驾驶矿车而言，由于角度传感器的采集误差和抖振，在实车测试过程中经常出现货箱状态误判现象，要么货箱还未到达举升顶点而提前停止了举升，要么货箱还未降到底部而提前停止降斗导致举着货箱危险行驶，除此以外一旦角度传感器出现故障而失效，则货箱状态将无法识别，当前作业任务将无法完成。而通过振动货箱修正货箱倾斜具有局限性，对于货箱粘结和冰冻导致重心偏移有一定效果，但是对于车辆本身停车地面倾斜无法解决，同时如果卸载过程中因为地面疏松导致的倾斜，振动货箱反而会增大车辆倾翻的风险。
公开内容
(一)要解决的技术问题
针对现有技术的上述不足，本公开的主要目的在于提供一种智能驾驶货车的控制方法，以期至少部分地解决上述技术问题中的至少之一。
(二)技术方案
为了实现上述目的，根据本公开的一个方面，提供了一种智能驾驶货车的控制方法，该方法包括：
采集车架的角度信息、货箱的角度信息、货箱的位置和货箱的运动方向；
根据采集到的车架的角度信息和货箱的角度信息判断货箱的状态；
根据上述货箱的状态和采集到的车架的角度信息、货箱的角度信息、货箱的运动方向、货箱的位置控制货箱。
另一方面，本公开提供了一种智能驾驶货车控制装置，该装置包括：
采集模块，采集车架的角度信息、货箱的角度信息、货箱的位置和货箱的运动方向；
判断模块，根据采集到的车架的角度信息和货箱的角度信息判断货箱的状态；
控制模块，根据上述货箱的状态和采集到的车架的角度信息、货箱的角度信息、货箱的运动方向、货箱的位置控制货箱。
另一方面，本公开提供了一种电子设备，该设备包括：
通信器，用于与服务器通信；
处理器；
存储器，其存储有计算机可执行程序，该程序在被所述处理器执行时，使得处理器执行上述的一种智能驾驶货车的控制方法。
另一方面，本公开提供了一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时实现上述的一种智能驾驶货车的控制方法。
(三)有益效果
(1)本公开实时采集车辆的角度信息，结合货箱的位置信息，可以避免因为车辆角度信息抖振/误差导致货箱位置反馈失准的情况，能够准确识别货箱位置，大大提升了智能驾驶车辆货箱控制性能，解决了货箱位置采集失准导致的货箱误控，甚至角度采集失准导致的可能货箱没有完全举升到顶而没有完成卸载，或者没有降斗到底而举着货箱行驶所带来的风险问题。
(2)本公开实时采集车辆的角度信息，能够实时监测车架状态，在车架俯仰角或者车辆横滚角超过限制阈值时，停止控制货箱举升或者降斗，避免因为车辆卸载位置地面不平或者地面疏松导致举升过程中车架不稳所带来的车辆后翻或者侧翻的危险，提升了智能驾驶车辆货箱控制的安全性能。
(3)本公开基于车架的角度信息、货箱的角度信息、货箱的位置相互作为校验和冗余，大大提升了货箱状态识别的鲁棒性，提升了智能驾驶车辆的安全性能和作业效率。
附图说明
为了更清楚地说明本公开实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本公开中的一些实施例，对于本领域技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他附图。
图1为本公开一实施例提供的智能驾驶货车的控制方法流程示意图；
图2为本公开一实施例提供的智能驾驶货车顶点位置示意图；
图3为本公开一实施例提供的智能驾驶货车底点位置示意图；
图4为本公开一实施例提供的智能驾驶货车的控制装置的结构示意图；
图5示出了一种电子设备的硬件结构图。
附图标记说明
①车体 ②车架倾角仪 ③货箱倾角仪 ④下止点传感器 ⑤上止点传感器
具体实施方式
为使本公开的目的、特征、技术方案和优点更加清楚明白，以下结合具体实施例，并参照附图，对本公开进一步详细说明，显然，所描述的实施例仅仅是本公开一部分实施例，而非全部实施例。基于本公开中的实施例，本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本公开的保护范围。
图1为本公开一实施例提供的智能驾驶货车的控制方法的流程示意图，如图1所示，该方法包括：
S101、采集车架的角度信息、货箱的角度信息、货箱的位置和货箱的运动方向；
如图2所示，利用车架倾角仪获取车架的角度信息，车架倾角仪安装在车架上，用于实时反馈车架的角度信息，比如：车架俯仰角α和车架横滚角β；利用货箱倾角仪获取货箱的角度信息，货箱倾角仪安装在货箱底部，随着货箱的举升和降斗能够实时反馈货箱的角度信息，比如：货箱倾角
Figure BDA0003004744960000041
和货箱倾斜角θ；利用上止点传感器和下止点传感器获取货箱的位置，下止点传感器安装在车架底部，与货箱底部面板垂直，当货箱降斗到底部时，能够触发下止点传感器输出货箱的位置为底点位置；上止点传感器，安装在举升定辅助装置上，能够随着货箱的举升而移动，当货箱举升到顶点时，能够刚好与举升辅助装置上的顶板垂直，从而触发上止点传感器输出货箱的位置为顶点位置。
S102、根据采集到的车架的角度信息和货箱的角度信息判断货箱的状态。
货箱的状态包括：安全状态和危险状态。
安全状态，即在货箱举升过程中所有倾角仪和传感器均正常，且车架俯仰角α和车辆横滚角
Figure BDA0003004744960000042
均没有超过阈值。
危险状态，即在货箱举升过程中出现车架俯仰角α，和/或，车辆横滚角
Figure BDA0003004744960000043
过大的情况，此时如果继续控制货箱举升，则可能导致车辆往后倾翻或者侧翻。
根据采集到的车架的角度信息、货箱的角度信息计算车辆横滚角
Figure BDA0003004744960000044
当车架横滚角β大于货箱倾斜角θ时，车辆横滚角
Figure BDA0003004744960000045
等于车架横滚角β，当车架横滚角β小于货箱倾斜角θ时，车辆横滚角
Figure BDA0003004744960000046
等于货箱倾斜角θ，当无法采集到车架俯仰角α、车架横滚角β，能够采集到货箱倾角
Figure BDA0003004744960000047
和货箱倾斜角θ时，车辆横滚角
Figure BDA0003004744960000048
等于货箱倾斜角θ。
根据车架俯仰角α、车辆横滚角
Figure BDA0003004744960000049
判断货箱的状态；
若车架俯仰角α没有超过第一俯仰角阈值，且车辆横滚角
Figure BDA00030047449600000410
没有超过第一横滚角阈值，则货箱处于安全状态；
若车架俯仰角α超过第一俯仰角阈值，和/或，车辆横滚角
Figure BDA0003004744960000051
超过第一横滚角阈值，则货箱处于危险状态。
S103、根据上述货箱的状态和采集到的车架的角度信息、货箱的角度信息、货箱的运动方向、货箱的位置控制货箱。
若货箱的实际位置为顶点位置或底点位置，则控制货箱停止运动；
若货箱的实际位置为中间位置，则控制货箱沿货箱的运动方向继续运动。
一、安全状态
当货箱处于安全状态时，根据采集到的车架的角度信息、货箱的角度信息、货箱的运动方向和货箱的位置控制货箱；
(一)、顶点位置，即货箱举升到顶部位置，是货箱举升控制的终点，如图2所示。
如果货箱举升到顶点位置却没有被精确识别，则可能出现以下情况：
(1)货箱已经到达顶点位置而没有识别到，此时智能驾驶系统因为判定货箱没有举升到顶点位置，则持续控制发动机输出对货箱进行举升，造成了不必要的浪费，降低了燃油利用率；
(2)货箱没有到达顶点位置就提前识别为已经到顶点位置，此时智能驾驶系统因为判定货箱已经到达顶点位置而停止了举升控制，此时因为货箱没有上升到顶点位置，则可能造成卸载不完全，导致车辆带着没有卸载完的装载物继续作业，不仅增加了油耗，还降低了作业效率。
本公开一实施例提出以下顶点位置识别策略和相应的控制策略：
当车架倾角仪、货箱倾角仪、上/下止点传感器均没有故障时，顶点位置识别策略和相应的控制策略如下：
①当前实际车速小于第一车速阈值(可根据实车测试设定，在本实施例中设定实际车速大于0即可)；
②当前实际档位为空档(对于有P(停车)档的车辆而言，则为P(停车)0档)；
③当前驻车状态为锁止；
④当前货箱的运动方向为向上；
⑤实时货箱举升角大于第一举升角上限阈值(可根据实车货箱举升特性数据确定，在本实施例中设定大于0即可)；
当车架倾角仪和货厢倾角仪均没有故障时，货箱举升角ω等于货箱倾角
Figure BDA0003004744960000061
减去车架俯仰角α，及
Figure BDA0003004744960000062
⑥当前时刻的货箱举升角与上一时刻接收到的货箱举升角之间的变化值小于第一举升角跳动阈值(根据实车测试确定，大于0即可)；
⑦上止点传感器反馈货箱的位置由中间位置转变为了顶点位置。
若满足以上所有条件，且以上条件同时持续第一时间阈值，则判断货箱已经举升到顶点位置，此时智能驾驶系统控制货箱停止运动，货箱的运动方向由向上变为无。
(二)、底点位置，即货箱降斗到底部位置，是货箱降斗控制的终点，如图3所示。
如果货箱举升到底点位置却没有被精确识别会出现两种情况：
(1)货箱已经到达底点位置而没有识别到，此时智能驾驶系统因为判定货箱没有下降到底点位置，则持续控制货箱降斗，造成了不必要的时间浪费，降低了作业效率，并且，当货箱降斗未完成时，车辆是无法行驶的；
(2)货箱没有到达底点位置就提前识别为已经到底点位置，此时智能驾驶系统因为判定货箱已经到达底点位置而停止控制货箱降斗，则会导致车辆举着货箱行驶，一方面因为没有完成降斗，举升液压系统一直处于压力状态，车辆行驶时的颠簸会对举升液压系统造成一定的损伤，缩短液压系统的寿命，另一方面由于货箱没有下降到底点位置，则会导致车辆重心上移，继续行驶会造成额外的行驶安全风险。
本公开一实施例提出以下底点位置识别策略和相应的控制策略：
当车架倾角仪、货箱倾角仪、上/下止点传感器均没有故障时，底点位置识别策略和相应的控制策略如下：
①当前实际车速小于第一车速阈值(可根据实车测试设定，在本实施例中设定实际车速大于0即可)；
②当前实际档位为空档(对于有P(停车)档的车辆而言，则为P(停车)0档)；
③当前驻车状态为锁止；
④当前货箱的运动方向为向下；
⑤实时货箱举升角小于第一举升角下限阈值(可根据实车货箱举升特性数据确定，在本实施例中设定大于0即可)；
当车架倾角仪和货厢倾角仪均没有故障时，货箱举升角ω等于货箱倾角
Figure BDA0003004744960000071
减去车架俯仰角α，及
Figure BDA0003004744960000072
⑥当前时刻的货箱举升角与上一时刻接收到的货箱举升角之间变化小于第二举升角跳动阈值(根据实车测试确定，大于0即可)；
⑦下止点传感器反馈货箱的位置由“中间位置”转变为了“底点位置”；
若满足以上所有条件，且以上条件同时持续第二时间阈值(根据实车测试确定，大于0即可)，则判定货箱已经降斗到底点位置，此时智能驾驶系统控制货箱停止运动，货箱的运动方向由向下变为无。
(三)、中间位置，即货箱处于顶点位置和底点位置之间的位置，本公开一实施例提供以下中间位置的识别策略和相应的控制策略：
(1)当货箱处于底点位置时，货箱的运动方向为向上，则货箱的实际位置为中间位置；
(2)当货箱处于顶点位置时，货箱的运动方向为向下，则货箱的实际位置为中间位置；
(3)当货箱处于中间位置时，无论采集到的货箱的运动方向为向上或向下，货箱的实际位置均为中间位置。
二、危险状态
当货箱处于危险状态时，根据采集到的货箱的运动方向、货箱的角度信息、车架的角度信息控制货箱，具体如下：
1、若采集到的货箱的运动方向为向上
判断车架俯仰角α是否超过第二俯仰角阈值，且车辆横滚角
Figure BDA0003004744960000075
是否超过第二横滚角阈值；
若车架俯仰角α没有超过第二俯仰角阈值，和/或，车辆横滚角
Figure BDA0003004744960000074
没有超过第二横滚角阈值，则控制货箱向下运动，直至货箱的实际位置为底点位置，并在货箱降至底点位置后提示监管平台，更换卸载位置重新控制举升卸载。
若车架俯仰角α超过第二俯仰角阈值，和/或，车辆横滚角
Figure BDA0003004744960000073
超过第二横滚角阈值，则控制货箱停止运动，将危险状态上报监控平台，平台提示人工介入。
2、若采集到的货箱的运动方向为向下
当货箱的运动方向为向下时，控制货箱停止运动，将危险状态上报监控平台，平台提示人工介入。
三、故障状态
当无法采集到车架的角度信息、货箱的角度信息、货箱的位置中任一项时，判断货箱当前处于故障状态，控制货车完成当前卸载任务，并在完成所述当前卸载任务后，停止作业，提示进行检修。
无法采集到车架的角度信息、货箱的角度信息、货箱的位置，即车架倾角仪、货箱倾角仪、上止点传感器和下止点传感器存在故障。控制货车完成当前卸载任务，仍需要控制货箱向上或向下运动，直至完成当前卸载任务。
1、车架倾角仪存在故障
①货箱举升角ω等于货箱倾角
Figure BDA0003004744960000081
②车辆横滚角
Figure BDA0003004744960000082
等于货箱倾斜角θ；
③智能驾驶系统实时输出车架倾角仪故障状态，当智能驾驶系统识别到车架倾角仪故障后，在当前卸载任务完成后，停止车辆作业，提示进行检修。
2、货箱倾角仪存在故障
(1)若当前货箱的运动方向为向上，采用以下顶点位置识别策略和相应的控制策略：
①当前实际车速小于第一车速阈值(在本实施例中设定实际车速大于0即可)；
②当前实际档位为空档(对于有P(停车)档的车辆而言，则为P(停车)0档)；
③当前驻车状态为锁止；
④当前货箱的运动方向为向上；
⑤货箱的位置由中间位置变为顶点位置；
若满足以上所有条件，且以上所有条件同时持续第三时间阈值(根据实车测试确定，大于0即可)，则判定货箱已经举升到顶点位置，此时智能驾驶系统控制货箱停止运动，货箱的运动方向由向上变为无。同时，智能驾驶系统会实时输出货箱倾角仪故障状态，智能驾驶系统识别到该故障后，在当前卸载任务完成后，停止车辆作业，提示进行检修。
(2)若当前货箱的运动方向为向下，采用以下底点位置识别策略和相应的控制策略：
①当前实际车速小于第一车速阈值(可根据实车测试设定，在本实施例中设定大于0即可)；
②当前实际档位为空档(对于有P(停车)档的车辆而言，则为P(停车)0档)；
③当前驻车状态为锁止；
④当前货箱运动方向为向下；
⑤上止点传感器反馈车箱位置由中间位置转变为了底点位置；
若满足以上所有条件，且以上所有条件同时持续第四时间阈值(根据实车测试确定，大于0即可)，则判定货箱已经降斗到底点位置，此时智能驾驶系统控制货箱停止运动，货箱运动方向由向下变为无。同时，智能驾驶系统会实时输出货箱倾角仪故障状态，智能驾驶系统识别到该故障后，在当前卸载任务完成后，停止车辆作业，提示进行检修。
3、上止点传感器或下止点传感器存在故障
(1)当上止点传感器故障失效，车架倾角仪、货箱倾角仪均没有故障时，采用以下顶点位置识别策略和相应的控制策略：
①当前实际车速小于第一车速阈值(可根据实车测试设定，在本实施例中设定实际车速大于0即可)；
②当前实际档位为空档(对于有P(停车)档的车辆而言，则为P(停车)0档)；
③当前驻车状态为锁止；
④当前货箱运动方向为向上；
⑤实时货箱举升角大于第一举升角上限阈值(可根据实车货箱举升特性数据确定，在本实施例中设定大于0即可)；
当车架倾角仪和货厢倾角仪均没有故障时，货箱举升角ω等于货箱倾角
Figure BDA0003004744960000101
减去车架俯仰角α，及
Figure BDA0003004744960000102
⑥当前时刻的货箱举升角与上一时刻接收到的货箱举升角之间的变化值小于第一举升角跳动阈值(根据实车测试确定，大于0即可)；
若满足以上所有条件，且以上所有条件同时持续第一时间阈值(根据实车测试确定，大于0即可)，则判定货箱已经举升到顶点位置，此时智能驾驶系统控制货箱停止运动，货箱运动方向由向上变为无。同时，智能驾驶系统会实时输出上止点传感器故障状态，智能驾驶系统识别到该故障后，在当前卸载任务完成后，停止车辆作业，提示进行检修。
(2)当任一个下止点传感器故障失效，车架倾角仪、货箱倾角仪均没有故障时，采用以下底点位置识别策略和相应的控制策略：
①当前实际车速小于第一车速阈值(可根据实车测试设定，在本实施例中设定大于0即可)；
②当前实际档位为空档(对于有P(停车)档的车辆而言，则为P(停车)0档)；
③当前驻车状态为锁止；
④当前货箱运动方向为向下；
⑤实时货箱举升角小于第一举升角下限阈值(可根据实车货箱举升特性数据确定，在本实施例中设定大于0即可)；
当车架倾角仪和货厢倾角仪均没有故障时，货箱举升角ω等于货箱倾角
Figure BDA0003004744960000103
减去车架俯仰角α，及
Figure BDA0003004744960000104
⑥当前时刻的货箱举升角与上一时刻接收到的货箱举升角之间的变化值小于第二举升角跳动阈值(根据实车测试确定，大于0即可)；
若满足以上所有条件，且以上所有条件同时持续第二时间阈值(根据实车测试确定，大于0即可)，则判定货箱已经降斗到底点位置，此时智能驾驶系统控制货箱停止运动，货箱运动方向由向下变为无。同时，智能驾驶系统会实时输出下止点传感器故障状态，智能驾驶系统识别到该故障后，应该在当前卸载任务完成后，停止车辆作业，提示进行检修。
图4为本公开一实施例提供的智能驾驶货车控制装置的结构示意图，如图3所示，该装置包括：采集模块401、判断模块402、控制模块403。
采集模块401，采集车架的角度信息、货箱的角度信息、货箱的位置和货箱的运动方向；
判断模块402，根据采集到的车架的角度信息和货箱的角度信息判断货箱的状态；
控制模块403，根据上述货箱的状态和采集到的车架的角度信息、货箱的角度信息、货箱的运动方向、货箱的位置控制货箱。
本公开还提供了一种电子设备500，该设备包括：
通信器510，用于与服务器通信；
处理器520；
存储器530，其存储有计算机可执行程序，该程序包含如上文所述智能驾驶货车的控制方法。
图5示意性示出了根据本公开实施例的电子设备框图，如图5所示，所述电子设备500包括通信器510、处理器520和存储器530。该电子设备500可以执行根据本公开实施例的方法。
具体地，处理器520例如可以包括通用微处理器、指令集处理器和/或相关芯片组和/或专用微处理器(例如，专用集成电路(ASIC))，等等。处理器520还可以包括用于缓存用途的板载存储器。处理器520可以是用于执行根据本公开实施例的方法流程的不同动作的单一处理单元或者是多个处理单元。
存储器530，例如可以是能够包含、存储、传送、传播或传输指令的任意介质。例如，可读存储介质可以包括但不限于电、磁、光、电磁、红外或半导体系统、装置、器件或传播介质。可读存储介质的具体示例包括：磁存储装置，如磁带或硬盘(HDD)；光存储装置，如光盘(CD-ROM)；存储器，如随机存取存储器(RAM)或闪存；和/或有线/无线通信链路。其存储有计算机可执行程序，该程序在被所述处理器执行时，使得所述处理器执行如上文所述的智能驾驶货车的控制方法。
本公开还提供了一种计算机可读存储介质，其上存储有计算机程序，该程序包含如上文所述的智能驾驶货车的控制方法。该计算机可读存储介质可以是上述实施例中描述的装置/设备中所包含的；也可以是单独存在，而未装配入该装置/设备中。上述计算机可读存储介质承载有一个或者多个程序，当上述一个或者多个程序被执行时，实现根据本公开实施例的方法。
根据本公开的实施例，计算机可读存储介质可以是计算机可读信号介质或者计算机可读存储介质或者是上述两者的任意组合。计算机可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件，或者任意以上的组合。计算机可读存储介质的更具体的例子可以包括但不限于：具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机访问存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。
在本公开中，计算机可读存储介质可以是任何包含或存储程序的有形介质，该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。而在本公开中，计算机可读的信号介质可以包括在基带中或者作为载波一部分传播的数据信号，其中承载了计算机可读的程序代码。这种传播的数据信号可以采用多种形式，包括但不限于电磁信号、光信号或上述的任意合适的组合。计算机可读的信号介质还可以是计算机可读存储介质以外的任何计算机可读介质，该计算机可读介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。计算机可读介质上包含的程序代码可以用任何适当的介质传输，包括但不限于：无线、有线、光缆、射频信号等等，或者上述的任意合适的组合。
以上所述的具体实施例，对本公开的目的、技术方案和有益效果进行了进一步详细说明，所应理解的是，以上所述仅为本公开的具体实施例而已，并不用于限制本公开，本领域技术人员可以理解，本公开的各个实施例和/或权利要求中记载的特征可以进行多种组合或/或结合，即使这样的组合或结合没有明确记载于本公开中，凡在本公开的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本公开的保护范围之内。

Claims (15)

1.一种智能驾驶货车的控制方法，货车包括货箱和车架，其特征在于，包括：
采集所述车架的角度信息、所述货箱的角度信息、所述货箱的位置和所述货箱的运动方向；
根据采集到的所述车架的角度信息和所述货箱的角度信息判断所述货箱的状态；
根据所述货箱的状态和采集到的所述车架的角度信息、所述货箱的角度信息、所述货箱的运动方向、所述货箱的位置控制所述货箱。
2.根据权利要求1所述的智能驾驶货车的控制方法，其特征在于，
所述货箱的角度信息包括：货箱倾角和货箱倾斜角；
所述车架的角度信息包括：车架俯仰角和车架横滚角；
所述货箱的运动方向包括：相对于所述车架向上和相对于所述车架向下；
所述货箱的位置包括：顶点位置、底点位置和中间位置；
所述货箱的状态包括：危险状态和安全状态。
3.根据权利要求2所述的智能驾驶货车的控制方法，其特征在于，所述根据采集到的所述车架的角度信息和所述货箱的角度信息判断所述货箱的状态，具体包括：
根据采集到的所述车架的角度信息、所述货箱的角度信息计算车辆横滚角；
根据所述车架俯仰角、车辆横滚角判断所述货箱的状态。
4.根据权利要求3所述的智能驾驶货车的控制方法，其特征在于，所述根据采集到的所述车架的角度信息、所述货箱的角度信息计算车辆横滚角，具体包括：
当所述车架横滚角大于所述货箱倾斜角时，所述车辆横滚角等于所述车架横滚角；
当所述车架横滚角小于所述货箱倾斜角时，所述车辆横滚角等于所述货箱倾斜角；
当无法采集到所述车架俯仰角和车架横滚角时，所述车辆横滚角等于所述货箱倾斜角。
5.根据权利要求3所述的智能驾驶货车的控制方法，其特征在于，所述根据所述车架俯仰角、车辆横滚角判断所述货箱状态，具体包括：
若所述车架俯仰角超过第一俯仰角阈值，和/或，所述车辆横滚角超过第一横滚角阈值，则所述货箱处于危险状态；
若所述车架俯仰角没有超过第一俯仰角阈值，且所述车辆横滚角没有超过第一横滚角阈值，则所述货箱处于安全状态。
6.根据权利要求2所述的智能驾驶货车的控制方法，其特征在于，所述根据所述货箱的状态和采集到的所述车架的角度信息、所述货箱的角度信息、所述货箱的运动方向、所述货箱的位置控制所述货箱，具体包括：
当所述货箱处于危险状态时，根据所述货箱的运动方向、所述车架的角度信息、所述货箱的角度信息控制所述货箱；
当所述货箱处于安全状态时，根据采集到的所述车架的角度信息、所述货箱的角度信息、所述货箱的运动方向和所述货箱的位置控制所述货箱。
7.根据权利要求6所述的智能驾驶货车的控制方法，其特征在于，所述当所述货箱处于危险状态时，根据所述货箱的运动方向、所述车架的角度信息、所述货箱的角度信息控制所述货箱，具体包括：
当所述货箱的运动方向为向上时，判断所述车架俯仰角是否超过第二俯仰角阈值，且所述车辆横滚角是否超过第二横滚角阈值；若所述车架俯仰角没有超过第二俯仰角阈值，和/或，所述车辆横滚角没有超过第二横滚角阈值，则控制所述货箱向下运动，直至所述货箱的实际位置为底点位置，并在所述货箱降至底点位置后提示监管平台，更换卸载位置重新控制所述货箱举升卸载；
若所述车架俯仰角超过第二俯仰角阈值，和/或所述车辆横滚角超过第二横滚角阈值，则控制所述货箱停止运动，将危险状态上报监管平台，平台提示人工介入。
当所述货箱的运动方向为向下时，控制所述货箱停止运动，将危险状态上报监管平台，平台提示人工介入。
8.根据权利要求6所述的智能驾驶货车的控制方法，其特征在于，所述当所述货箱处于安全状态时，根据采集到的所述车架的角度信息、所述货箱的角度信息、所述货箱的运动方向和所述货箱的位置控制所述货箱，具体包括：
所述货箱倾角减去所述车架俯仰角得到所述货箱的举升角；
根据采集到的所述货箱的运动方向、所述货箱的位置、所述货箱的举升角判断所述货箱的实际位置；
若所述货箱的实际位置为顶点位置或底点位置，则控制所述货箱停止运动；
若所述货箱的实际位置为中间位置，则控制所述货箱继续沿所述货箱的运动方向运动。
9.根据权利要求8所述的智能驾驶货车的控制方法，其特征在于，当采集到的所述货箱的位置为顶点位置，且所述货箱的运动方向为向上时，所述根据采集到的所述货箱的运动方向、所述货箱的位置、所述货箱的举升角判断所述货箱的实际位置，具体包括：
持续采集预设时长内所述货箱的举升角，得到多个举升角；
计算每两个相邻时刻的举升角的变化值；
判断所述多个举升角是否均满足第一预设条件，且所述多个举升角的变化值是否均满足第二预设条件；
若所述多个举升角均满足第一预设条件，且所述多个举升角的变化值均满足第二预设条件，则所述货箱的实际位置为顶点位置；
若所述多个举升角不满足第一预设条件，和/或，所述多个举升角的变化值不满足第二预设条件，则所述货箱的实际位置为中间位置。
10.根据权利要求8所述的智能驾驶货车的控制方法，其特征在于，当采集到的所述货箱的位置为底点位置，且所述货箱的运动方向为向下时，所述根据采集到的所述货箱的运动方向、所述货箱的位置、所述货箱举升角判断所述货箱的实际位置，具体包括：
持续采集预设时长内所述货箱的举升角，得到多个举升角；
计算每两个相邻时刻的举升角的变化值；
判断所述多个举升角是否均满足第三预设条件，且所述多个举升角的变化值是否均满足第四预设条件；
若所述多个举升角均满足第三预设条件，且所述多个举升角的变化值均满足第四预设条件，则所述货箱的实际位置为顶点位置；
若所述多个举升角不满足第三预设条件，和/或，所述多个举升角的变化值不满足第四预设条件，则所述货箱的实际位置为中间位置。
11.根据权利要求8所述的智能驾驶货车的控制方法，其特征在于，所述根据采集到的所述货箱的运动方向、所述货箱的位置判断所述货箱的实际位置，具体包括：
当采集到的所述货箱的位置为顶点位置时，若采集到的所述货箱的运动方向为向下，则所述货箱的实际位置均为中间位置；
当采集到的所述货箱的位置为底点位置时，若采集到的所述货箱的运动方向为向上，则所述货箱的实际位置均为中间位置；
当采集到的所述货箱的位置为中间位置时，无论采集到的所述货箱的运动方向为向上或向下，所述货箱的实际位置均为中间位置。
12.根据权利要求1所述的智能驾驶货车的控制方法，其特征在于，所述货车的控制方法还包括：
若无法采集到所述车架的角度信息、所述货箱的角度信息、所述货箱的位置中任一项，则所述货箱当前处于故障状态，控制所述货车完成当前卸载任务，并在完成所述当前卸载任务后，停止作业，提示进行检修。
13.一种智能驾驶货车控制装置，货车包括货箱和车架，其特征在于，包括：
采集模块，采集所述车架的角度信息、所述货箱的角度信息、所述货箱的位置和所述货箱的运动方向；
判断模块，根据采集到的所述车架的角度信息和所述货箱的角度信息判断所述货箱的状态；
控制模块，根据所述货箱的状态和采集到的所述车架的角度信息、所述货箱的角度信息、所述货箱的位置、所述货箱的运动方向控制所述货箱。
14.一种电子设备，其特征在于，所述设备包括：
通信器，用于与服务器通信；
处理器；
存储器，其存储有计算机可执行程序，该程序在被所述处理器执行时，使得所述处理器执行如权利要求1-12中所述的智能驾驶货车的控制方法。
15.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，该程序被处理器执行时实现如权利要求1-12中所述的智能驾驶货车的控制方法。
CN202110364617.1A 2021-04-02 2021-04-02 一种智能驾驶货车的控制方法、装置、设备和存储介质 Active CN113043931B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110364617.1A CN113043931B (zh) 2021-04-02 2021-04-02 一种智能驾驶货车的控制方法、装置、设备和存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110364617.1A CN113043931B (zh) 2021-04-02 2021-04-02 一种智能驾驶货车的控制方法、装置、设备和存储介质

Publications (2)

Publication Number Publication Date
CN113043931A true CN113043931A (zh) 2021-06-29
CN113043931B CN113043931B (zh) 2022-07-12

Family

ID=76517393

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110364617.1A Active CN113043931B (zh) 2021-04-02 2021-04-02 一种智能驾驶货车的控制方法、装置、设备和存储介质

Country Status (1)

Country Link
CN (1) CN113043931B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114476897A (zh) * 2022-02-25 2022-05-13 四川中陆嘉诚科技有限公司 一种举升装置

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003095004A (ja) * 2001-09-26 2003-04-03 Shin Meiwa Ind Co Ltd コンテナ荷役車両
CN205468787U (zh) * 2016-04-12 2016-08-17 陕西汽车集团有限责任公司 自卸车主动安全预警与控制系统
EP3141420A1 (de) * 2015-08-20 2017-03-15 Franz Xaver Meiller Fahrzeug- und Maschinenfabrik-GmbH & Co KG Aufbau für wechselbehälter für ein lastentransportfahrzeug mit bewegungsvariation und verfahren dazu
CN106740363A (zh) * 2016-11-16 2017-05-31 湖南汽车制造有限责任公司 自卸车防倾翻系统、方法及自卸车
CN107031487A (zh) * 2017-06-01 2017-08-11 南京云计趟信息技术有限公司 一种基于加速度传感器与陀螺仪的举升识别系统
CN109131005A (zh) * 2018-08-30 2019-01-04 浙江鸿泉电子科技有限公司 车辆举升状态识别方法、系统、电子设备及存储介质
CN109624845A (zh) * 2019-01-07 2019-04-16 西安正昌电子股份有限公司 一种自卸车举升安全监控装置及方法
CN110239462A (zh) * 2019-03-25 2019-09-17 北京理工大学 一种车辆侧翻的预警方法及系统
CN111038355A (zh) * 2019-12-31 2020-04-21 长沙安保行科技有限公司 车厢抗干扰监控系统、方法及自卸车
CN111422122A (zh) * 2020-04-24 2020-07-17 东风商用车有限公司 匹配手动变速箱的车用电控举升控制系统及其方法
CN111452699A (zh) * 2020-04-24 2020-07-28 东风商用车有限公司 自卸车电控举升控制系统及其方法
CN212401012U (zh) * 2020-06-01 2021-01-26 常州工业职业技术学院 一种自动卸车用全自动辅助支撑

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003095004A (ja) * 2001-09-26 2003-04-03 Shin Meiwa Ind Co Ltd コンテナ荷役車両
EP3141420A1 (de) * 2015-08-20 2017-03-15 Franz Xaver Meiller Fahrzeug- und Maschinenfabrik-GmbH & Co KG Aufbau für wechselbehälter für ein lastentransportfahrzeug mit bewegungsvariation und verfahren dazu
CN205468787U (zh) * 2016-04-12 2016-08-17 陕西汽车集团有限责任公司 自卸车主动安全预警与控制系统
CN106740363A (zh) * 2016-11-16 2017-05-31 湖南汽车制造有限责任公司 自卸车防倾翻系统、方法及自卸车
CN107031487A (zh) * 2017-06-01 2017-08-11 南京云计趟信息技术有限公司 一种基于加速度传感器与陀螺仪的举升识别系统
CN109131005A (zh) * 2018-08-30 2019-01-04 浙江鸿泉电子科技有限公司 车辆举升状态识别方法、系统、电子设备及存储介质
CN109624845A (zh) * 2019-01-07 2019-04-16 西安正昌电子股份有限公司 一种自卸车举升安全监控装置及方法
CN110239462A (zh) * 2019-03-25 2019-09-17 北京理工大学 一种车辆侧翻的预警方法及系统
CN111038355A (zh) * 2019-12-31 2020-04-21 长沙安保行科技有限公司 车厢抗干扰监控系统、方法及自卸车
CN111422122A (zh) * 2020-04-24 2020-07-17 东风商用车有限公司 匹配手动变速箱的车用电控举升控制系统及其方法
CN111452699A (zh) * 2020-04-24 2020-07-28 东风商用车有限公司 自卸车电控举升控制系统及其方法
CN212401012U (zh) * 2020-06-01 2021-01-26 常州工业职业技术学院 一种自动卸车用全自动辅助支撑

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114476897A (zh) * 2022-02-25 2022-05-13 四川中陆嘉诚科技有限公司 一种举升装置

Also Published As

Publication number Publication date
CN113043931B (zh) 2022-07-12

Similar Documents

Publication Publication Date Title
JP5372545B2 (ja) パンタグラフ自動昇降装置
CN110419071B (zh) 用于集装箱的自动引导的运输车辆和用于运行该车辆的方法，以及具有自动驾驶的运输车辆的系统
CN113043931B (zh) 一种智能驾驶货车的控制方法、装置、设备和存储介质
CN105217472A (zh) 集装箱堆场轮胎吊自动化作业系统
CN112693924A (zh) 一种基于定位移动下料的智能发运系统装置及其控制系统
CN218431492U (zh) 一种用于铁路机车巡检的agv小车
CN201109688Y (zh) 集装箱起重吊装高速节能安全运行控制系统
CN110697579B (zh) 一种规范岸桥、场桥司机作业操作的方法和装置以及设备
CN113353801A (zh) 一种场桥可记忆位置的吊具半自动倾转控制系统及方法
CN113022405A (zh) 工程运输车的举升控制系统及方法
CN216582260U (zh) 一种智能仓储装卸平台系统
CN208122413U (zh) 一种具备防坠功能的安全性立体停车库
CN213923793U (zh) 基于激光的门式轮胎吊小车速度控制系统
CN217278922U (zh) 一种可升降的三维探地雷达检测车
CN207243367U (zh) 一种汽车维修升降台
CN112645166B (zh) 基于物联网的矿用斜巷提升机综合控制集成系统
CN212313377U (zh) 匹配手动变速箱的车用电控举升控制系统
JP2008265884A (ja) スタッカクレーンの異常検知方法
CN111137700B (zh) 一种适用于火车装车批量制单的方法
CN111439679A (zh) 一种基于视觉的全自动港口吊装车系统及控制方法
CN109720436B (zh) 一种智能物料搬运车的缓冲停车装置及方法
CN114249150A (zh) 利用装车料斗系统转运物料的方法
CN113745797B (zh) 天线高度调节系统及车辆
CN108774970B (zh) 一种立体停车设备限高检测方法及其系统
CN116923326A (zh) 一种火车车厢余煤清理装置、控制方法及系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant