CN113467346A - 一种井下轨道车辆自动驾驶机器人及其控制方法 - Google Patents
一种井下轨道车辆自动驾驶机器人及其控制方法 Download PDFInfo
- Publication number
- CN113467346A CN113467346A CN202110919129.2A CN202110919129A CN113467346A CN 113467346 A CN113467346 A CN 113467346A CN 202110919129 A CN202110919129 A CN 202110919129A CN 113467346 A CN113467346 A CN 113467346A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- vcu
- instruction
- lower computer
- binocular camera
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 15
- 238000004891 communication Methods 0.000 claims abstract description 11
- 238000003860 storage Methods 0.000 claims abstract description 8
- 238000012545 processing Methods 0.000 claims description 13
- 230000001133 acceleration Effects 0.000 claims description 10
- 238000009826 distribution Methods 0.000 claims description 10
- 230000008447 perception Effects 0.000 claims description 10
- 230000009471 action Effects 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims description 3
- 230000004927 fusion Effects 0.000 claims description 3
- 238000007499 fusion processing Methods 0.000 claims description 3
- 230000007246 mechanism Effects 0.000 abstract description 3
- 238000010276 construction Methods 0.000 abstract description 2
- 238000004904 shortening Methods 0.000 abstract 1
- 230000003137 locomotive effect Effects 0.000 description 11
- 238000005516 engineering process Methods 0.000 description 4
- 230000009466 transformation Effects 0.000 description 4
- 230000004888 barrier function Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 3
- 238000004519 manufacturing process Methods 0.000 description 3
- 238000005065 mining Methods 0.000 description 3
- 230000006872 improvement Effects 0.000 description 2
- 230000009545 invasion Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000011897 real-time detection Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000003825 pressing Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/25—Pc structure of the system
- G05B2219/25257—Microcontroller
Abstract
本发明公开了一种井下轨道车辆自动驾驶机器人及其控制方法，机器人包括感知系统、控制系统、执行系统和驱动系统。感知系统包括毫米波雷达、双目相机、惯导和定位标签等，用于感知轨道车辆周围环境，包括障碍物与入侵人员以及实现对车辆的定位；控制系统包括上位机、VCU车载控制器、车载通讯控制器和下位机，用于发送指令控制执行机构；执行系统包括机械手、机械臂、机械腿与伺服电机，用于控制车辆运行；驱动系统包括蓄电池和配电器，负责给上述各系统提供能源。本发明在轨道车辆驾驶室中利用机器人替代驾驶员，实现井下轨道车辆无人驾驶，且四大系统集成于一台机器人，降低改造车辆花费的成本，缩短无人驾驶改造周期，提高矿山智能化建设水平。
Description
技术领域
本发明涉及一种驾驶机器人，具体涉及一种井下轨道车辆自动驾驶机器人及其控制方法。
背景技术
我国矿井辅助运输系统多采用轨道式运输车辆，包括：井下电机车、单轨吊、无极绳绞车、齿轨车等，车辆操作方式目前整体还处于半自动化、半机械化及人工辅助运输的落后现状，其效率以及安全性已经极大限制了矿井的安全高效生产和智能化水平提高。近年来，随着“智慧矿山”建设口号的提出，无人驾驶技术开始被应用到矿山井下有轨运输，其中环境智能感知技术和自动控制技术是实现轨道车辆无人驾驶的重要前提，也是实现无人驾驶轨道车辆安全稳定行驶的重要保障。
目前，井下轨道车辆在无人驾驶远程监控、电车驱动能量管理、系统调度等几个方面已有部分研究。例如，专利申请号为201921053940.1，名称为“一种矿用电机车自动刹车装置”发明专利，公开了一种矿用电机车自动刹车装置，这是一种辅助刹车系统，该方案仅设计了一种刹车装置，未提及到无人驾驶相关技术；专利申请号为202010198239.X，名称为“一种自动驾驶机器人”发明专利，公开了一种路面车辆的自动驾驶机器人，该方案对自动驾驶机器人的感知系统和控制系统的描述非常粗略，仅设计了机器人的外观机械形状，对机器人的控制方法未提及，且该机器人是针对路面行驶汽车设计，不适用井下轨道车辆的行驶工况；专利申请号为202110366179.2，名称为“一种无驾驶舱式井下无人驾驶电机车及其控制方法”发明专利，该发明主要对电机车进行无人化改造，适用于新型电机车制造，但对已使用的有人驾驶电机车进行无人驾驶改造成本较高、周期较长。
在现有技术水平下，人工驾驶轨道车辆在井下环境恶劣的情况下工作效率低下，安全及可靠性较差，但是对井下轨道车辆进行无人化改造的成本过高、周期较长。为此，本发明提出一种井下轨道车辆自动驾驶机器人，可以为上述问题提供更好的解决方案进而提高矿区劳动效率，降低无人驾驶改造成本。
发明内容
针对上述现有技术存在的问题，本发明提供一种井下轨道车辆自动驾驶机器人及其控制方法，无人驾驶轨道车辆应用效果好，同时降低了轨道车辆无人化改造的成本。
为了实现上述目的，本发明采用的技术方案是：一种井下轨道车辆自动驾驶机器人，包括，包括感知定位系统、控制系统、执行系统和驱动系统；执行系统包括躯干、头部、机械腿和两个机械臂；头部和机械腿分别设置在躯干的顶部和底部前面，两个机械臂分别设置在躯干左右两侧面的上部，机械腿、两个机械臂分别与第三伺服电机、第一伺服电机、第二伺服电机连接；感知定位系统包括第一毫米波雷达、第二毫米波雷达、惯导系统、第一双目相机、第二双目相机、第三双目相机和5G定位标签；第一双目相机、第二双目相机、第三双目相机分别设置在头部的前面和左右两个侧面，第一毫米波雷达、第二毫米波雷达分别设置在躯干顶面左右两边缘处，5G定位标签和惯导系统均设置在躯干内；控制系统包括上位机、VCU整车控制器、下位机和车载通讯控制器，上位机、VCU整车控制器、下位机和车载通讯控制器均设置在躯干内，上位机分别与惯导系统、第一双目相机、第二双目相机、第三双目相机、第一毫米波雷达、第二毫米波雷达电连接，上位机与VCU整车控制器、下位机和车载通讯控制器电连接，下位机与第三伺服电机、第一伺服电机、第二伺服电机连接； 驱动系统包括电池配电箱和蓄电池，蓄电池与电池配电箱连接，电池配电箱与感知定位系统、控制系统和执行系统电连接。
进一步的，所述机械腿、两个机械臂与躯干可拆卸连接；用于满足各种类型的井下轨道车辆无人驾驶。
进一步的，还包括第四伺服电机，第四伺服电机设置在躯干内与头部连接，下位机与第四伺服电机连接。
进一步的，所述躯干前面中部设有第四双目相机，第四双目相机与上位机电连接。
进一步的，所述惯导系统与第三伺服电机、第一伺服电机、第二伺服电机和第四伺服电机连接。
进一步的，所述躯干上设有RFID射频标签；用于对机器人实现定位，防止机器人遗失。
一种井下轨道车辆自动驾驶机器人控制方法：
步骤一：启停控制：机器人的第二双目相机和第三双目相机扫描装货地点的识别标签，将到达指定地点的信息传递给机器人，上位机将处理后的数据传递给VCU整车控制器，VCU整车控制器下达指令给下位机控制机械臂按下启停/牵引按钮，完成轨道车辆停车动作；待货物装载完成后，装货地点通知VCU整车控制器，VCU整车控制器下达指令给下位机控制机械臂按下启停/牵引按钮，完成轨道车辆启动；机器人的第二双目相机和第三双目相机扫描装货地点的识别标签，将到达指定地点的信息传递给机器人，上位机将处理后的数据传递给VCU整车控制器，VCU整车控制器下达指令给下位机控制机械臂按下启停/牵引按钮，完成轨道车辆停车动作；
步骤二：行驶控制：当轨道车辆运行时，第一双目相机实时监测车辆前方障碍物信息，第二双目相机、第三双目相机实时检测车辆两侧的障碍物信息，第一毫米波雷达和第二毫米波雷达实时检测车辆两侧有无人员或车辆入侵，检测结果都通过CAN总线传输至上位机进行感知融合，上位机接收这些信号并进行决策融合处理，处理结果为：当前方无障碍物且无弯道时，上位机输出信号为0000；当前方有障碍物，但大于设定的安全距离时，输出信号为0001；当前方有障碍物，小于设定的安全距离但大于设定的危险距离时，输出信号为0101；当前方有障碍物，且小于设定的危险距离时，输出信号为0111；处理结果通过CAN总线传输到VCU整车控制器；
当上位机输出信号为0000时，机器人内部的VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制机械臂推动加速档把，使机械腿维持当前工作状态，加速到轨道车辆规定最高速度，实现轨道车辆直线加速控制；
当输出信号由0000变为0001时，VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制机械臂和机械腿维持当前状态，保持轨道车辆原速动作；
当输出信号由0001变为0101时，VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制机械臂拉下速度档把，机械腿缓慢踏下刹车踏板，实现轨道车辆减速动作；
当输出信号由0101变为0111时，VCU整车控制器下达指令给下位机，下位机（203）解析VCU整车控制器的指令，控制机械腿实现紧急刹车，同时机械臂将速度档把拉至最低，完成轨道车辆紧急制动，实现停车；
等待障碍物被清除，输出信号由0111变为0000时VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制一只机械臂按下启动按钮，另一只机械臂推动加速档把，收回机械腿，加速到轨道车辆规定最高速度，实现轨道车辆直线加速控制；
步骤三：弯道处理：当第一双目相机检测到前方有弯道时，第一双目相机将感知信息传递给上位机：当轨道车辆前方无弯道且无障碍物时，上位机输出信号为0000；当前方有弯道但无障碍物时，上位机输出信号为1000；当前方有弯道且存在障碍物时，若轨道车辆与障碍物间距离大于安全距离，输出信号为1001，若轨道车辆与障碍物间距离小于安全距离大于危险距离，则输出信号为1101，若距离小于危险距离，则输出信号为1111；决策信号经CAN总线传递至VCU整车控制器；
当上位机输出信号由0000变为1000时，VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制机械臂拉下速度档把，机械腿踏下刹车踏板，降低车速至规定转向速度，准备转向；
当输出信号由1000变为1001时，VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制机械臂和机械腿保持原状态，维持低车速；
当输出信号由1001变为1101时，VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制机械臂拉下速度档把，机械腿踏下刹车踏板，降低至最低车速；
当输出信号由1101变为1111时，VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制机械腿实现紧急刹车，同时机械臂将速度档把拉至最低，完成轨道车辆紧急制动，实现停车；
当弯道处障碍物被清除后，上位机输出信号由1111变为1000时，VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制一只机械臂按下启动按钮，另一只机械臂推动加速档把，收回机械腿，加速到轨道车辆规定转向速度，实现轨道车辆转向控制；
当轨道车辆驶过弯道，上位机输出信号由1000变为0000时，VCU整车控制器下达指令给下位机，下位机解析VCU整车控制器的指令，控制机械臂推动加速档把，收回机械腿，加速到轨道车辆规定最高速度，实现轨道车辆直线加速控制；
步骤四：充能处理：当第四双目相机观测到轨道车辆的能源不足时，向VCU整车控制器传递信号，VCU整车控制器处理后发出命令控制机器人驾驶轨道车辆前往充能站。
与现有技术相比，本发明双目相机结合毫米波雷达，可以做到分辨障碍物类型及距离，通过自动驾驶机器人替代驾驶员，对于轨道车辆的改动极少，便于改造，且可以回收利用，普适性高，节约制造成本；本发明能够自主采集，分析处理，并将处理结果应用到后续决策层，控制层，执行层，整个过程无需人员参与，节约了井下轨道车辆的人员成本，提高了工作效率；采用5G传输，传输和控制速度更快；使用5G+UWB定位，定位精度更高且可靠；本发明将轨道车辆无人驾驶与遥控相结合，遇到紧急情况交予地面人员遥控，更加安全；本发明还采用RFID射频标签进行定位与识别，从而实现自主装卸货,同时大大提高安全性；本发明将惯导与伺服电机相连，形成闭环控制系统，实现对速度的精确控制。
附图说明
图1为本发明主视整体结构示意图；
图2为本发明左视整体结构示意图；
图3为本发明的控制流程图；
图4为本发明的机械臂控制流程图；
图5为本发明机器人在轨道车辆中放置示意图；
图中：1、感知定位系统，2、控制系统，3、执行系统，4、驱动系统，101、第一双目相机，102、第一毫米波雷达，103、第二毫米波雷达，104、第二双目相机，105、惯导系统，106、RFID电子标签，107、5G定位标签，108、第四双目相机，201、上位机，202、VCU整车控制器，203、下位机，204、车载通讯控制器，301、机械腿，302、机械手，303、机械臂，304、第一伺服电机，305、第二伺服电机，306、第四伺服电机，307、第三伺服电机，401、电池配电箱，402、蓄电池。
具体实施方式
下面结合附图对本发明作进一步说明。
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
如图1和图2所示，本发明提供一种技术方案：包括感知定位系统1、控制系统2、执行系统3和驱动系统4；
执行系统3整体呈机器人形状，用于代替驾驶员实现轨道车辆安全驾驶；执行系统3包括躯干、头部、机械腿301和两个机械臂303；头部和机械腿301分别设置在躯干的顶部和底部前面，两个机械臂303分别设置在躯干左右两侧面的上部，机械腿301、两个机械臂303分别与第三伺服电机307、第一伺服电机305、第二伺服电机304连接，伺服电机分别用于控制机械臂303、机械腿301的工作；增设第四伺服电机306，第四伺服电机306设置在躯干内与头部连接，用于控制机器人头部旋转，使双目相机的探测角度范围更加广泛。
感知定位系统1包括第一毫米波雷达102、第二毫米波雷达103、惯导系统105、第一双目相机101、第二双目相机104、第三双目相机和5G定位标签107；第一双目相机101、第二双目相机104、第三双目相机分别设置在头部的前面和左右两个侧面，第一毫米波雷达102、第二毫米波雷达103分别设置在躯干顶面左右两边缘处，双目相机和毫米波雷达用于环境感知，5G定位标签107和惯导系统105均设置在躯干内；惯导系统105用于位姿纠正，5G定位标签107用于定位；
控制系统2包括上位机201、VCU整车控制器202、下位机203和车载通讯控制器204，上位机201、VCU整车控制器202、下位机203和车载通讯控制器204均设置在躯干内，上位机201分别与惯导系统105、第一双目相机101、第二双目相机104、第三双目相机、第一毫米波雷达102、第二毫米波雷达103电连接，上位机201与VCU整车控制器202、下位机203和车载通讯控制器204电连接，下位机203与第三伺服电机307、第一伺服电机305、第二伺服电机304、第四伺服电机306连接；
驱动系统4包括电池配电箱401和蓄电池402，蓄电池402与电池配电箱401连接，电池配电箱401与感知定位系统1、控制系统2和执行系统3电连接，为其中各机构提供动力。
如图3所示，轨道车辆（电机车）行驶控制方法，如图5所示，将本申请机器人放置在轨道车辆（电机车）中的驾驶位置上，机械臂303和机械腿301设置在相应的驾驶操作机构上用于操作轨道车辆（电机车）。
步骤一：启停控制：机器人的第二双目相机104和第三双目相机扫描装货地点的识别标签，将到达指定地点的信息传递给机器人，上位机201将处理后的数据传递给VCU整车控制器202，VCU整车控制器202下达指令给下位机203控制机械臂303按下启停/牵引按钮，完成轨道车辆停车动作，为了更加准确的按下按钮，在操作按钮的机械臂303上设置机械手302；待货物装载完成后，装货地点通知VCU整车控制器202，VCU整车控制器202下达指令给下位机203控制机械手302按下启停/牵引按钮，完成轨道车辆启动；机器人的第二双目相机104和第三双目相机扫描装货地点的识别标签，将到达指定地点的信息传递给机器人，上位机201将处理后的数据传递给VCU整车控制器202，VCU整车控制器202下达指令给下位机203控制机械手302按下启停/牵引按钮，完成轨道车辆停车动作；
步骤二：行驶控制：当轨道车辆运行时，第一双目相机101实时监测车辆前方障碍物信息，第二双目相机104、第三双目相机实时检测车辆两侧的障碍物信息，第一毫米波雷达102和第二毫米波雷达103实时检测车辆两侧有无人员或车辆入侵，检测结果都通过CAN总线传输至上位机201进行感知融合，上位机201接收这些信号并进行决策融合处理，处理结果为：当前方无障碍物且无弯道时，上位机201输出信号为0000；当前方有障碍物，但大于设定的安全距离时，输出信号为0001；当前方有障碍物，小于设定的安全距离但大于设定的危险距离时，输出信号为0101；当前方有障碍物，且小于设定的危险距离时，输出信号为0111；处理结果通过CAN总线传输到VCU整车控制器202；
当上位机201输出信号为0000时，机器人内部的VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械臂303推动加速档把，使机械腿301维持当前工作状态，加速到轨道车辆规定最高速度，实现轨道车辆直线加速控制；
当输出信号由0000变为0001时，VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械臂303和机械腿301维持当前状态，保持轨道车辆原速动作；
当输出信号由0001变为0101时，VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械臂303拉下速度档把，机械腿301缓慢踏下刹车踏板，实现轨道车辆减速动作；
当输出信号由0101变为0111时，VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械腿301实现紧急刹车，同时机械臂303将速度档把拉至最低，完成轨道车辆紧急制动，实现停车；
等待障碍物被清除，输出信号由0111变为0000时VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械手302按下启动按钮，另一只机械臂303推动加速档把，收回机械腿301，加速到轨道车辆规定最高速度，实现轨道车辆直线加速控制；
步骤三：弯道处理：当第一双目相机101检测到前方有弯道时，第一双目相机101将感知信息传递给上位机201：当轨道车辆前方无弯道且无障碍物时，上位机201输出信号为0000；当前方有弯道但无障碍物时，上位机201输出信号为1000；当前方有弯道且存在障碍物时，若轨道车辆与障碍物间距离大于安全距离，输出信号为1001，若轨道车辆与障碍物间距离小于安全距离大于危险距离，则输出信号为1101，若距离小于危险距离，则输出信号为1111；决策信号经CAN总线传递至VCU整车控制器202；
当上位机201输出信号由0000变为1000时，VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械臂303拉下速度档把，机械腿301踏下刹车踏板，降低车速至规定转向速度，准备转向；
当输出信号由1000变为1001时，VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械臂303和机械腿301保持原状态，维持低车速；
当输出信号由1001变为1101时，VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械臂303拉下速度档把，机械腿301踏下刹车踏板，降低至最低车速；
当输出信号由1101变为1111时，VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械腿301实现紧急刹车，同时机械臂303将速度档把拉至最低，完成轨道车辆紧急制动，实现停车；
当弯道处障碍物被清除后，上位机201输出信号由1111变为1000时，VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制一只机械手302按下启动按钮，另一只机械臂303推动加速档把，收回机械腿301，加速到轨道车辆规定转向速度，实现轨道车辆转向控制；
当轨道车辆驶过弯道，上位机201输出信号由1000变为0000时，VCU整车控制器202下达指令给下位机203，下位机203解析VCU整车控制器202的指令，控制机械臂303推动加速档把，收回机械腿301，加速到轨道车辆规定最高速度，实现轨道车辆直线加速控制；
步骤四：充能处理：当第四双目相机108观测到轨道车辆的能源不足时，向VCU整车控制器202传递信号，VCU整车控制器202处理后发出命令控制机器人驾驶轨道车辆前往充能站。
如图4所示，上位机201发出信号传递至VCU整车控制器202，VCU整车控制器202下达指令给下位机203控制伺服电机转动带动机械臂303、机械腿301，同时伺服电机与惯导系统105形成一个闭环控制，从而实现井下轨道车辆的精确控制。
对于本领域技术人员而言，显然本发明不限于上述示范性实施例的细节，而且在不背离本发明的精神或基本特征的情况下，能够以其它的具体形式实现本发明。因此，无论从哪一点来看，均应将实施例看作是示范性的，而且是非限制性的，本发明的范围由所附权利要求而不是上述说明限定，因此旨在将落在权利要求的等同要件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。
以上所述，仅为本发明的较佳实施例，并不用以限制本发明，凡是依据本发明的技术实质对以上实施例所作的任何细微修改、等同替换和改进，均应包含在本发明技术方案的保护范围之内。
Claims (7)
1.一种井下轨道车辆自动驾驶机器人，包括感知定位系统（1）、控制系统（2）、执行系统（3）和驱动系统（4）；
其特征在于，执行系统（3）包括躯干、头部、机械腿（301）和两个机械臂（303）；头部和机械腿（301）分别设置在躯干的顶部和底部前面，两个机械臂（303）分别设置在躯干左右两侧面的上部，机械腿（301）、两个机械臂（303）分别与第三伺服电机（307）、第一伺服电机（305）、第二伺服电机（304）连接；
感知定位系统（1）包括第一毫米波雷达（102）、第二毫米波雷达（103）、惯导系统（105）、第一双目相机（101）、第二双目相机（104）、第三双目相机和5G定位标签（107）；第一双目相机（101）、第二双目相机（104）、第三双目相机分别设置在头部的前面和左右两个侧面，第一毫米波雷达（102）、第二毫米波雷达（103）分别设置在躯干顶面左右两边缘处，5G定位标签（107）和惯导系统（105）均设置在躯干内；
控制系统（2）包括上位机（201）、VCU整车控制器（202）、下位机（203）和车载通讯控制器（204），上位机（201）、VCU整车控制器（202）、下位机（203）和车载通讯控制器（204）均设置在躯干内，上位机（201）分别与惯导系统（105）、第一双目相机（101）、第二双目相机（104）、第三双目相机、第一毫米波雷达（102）、第二毫米波雷达（103）电连接，上位机（201）与VCU整车控制器（202）、下位机（203）和车载通讯控制器（204）电连接，下位机（203）与第三伺服电机（307）、第一伺服电机（305）、第二伺服电机（304）连接；
驱动系统（4）包括电池配电箱（401）和蓄电池（402），蓄电池（402）与电池配电箱（401）连接，电池配电箱（401）与感知定位系统（1）、控制系统（2）和执行系统（3）电连接。
2.根据权利要求1所述的一种井下轨道车辆自动驾驶机器人，其特征在于，所述机械腿（301）、两个机械臂（303）与躯干可拆卸连接。
3.根据权利要求1所述的一种井下轨道车辆自动驾驶机器人，其特征在于，还包括第四伺服电机（306），第四伺服电机（306）设置在躯干内与头部连接，下位机（203）与第四伺服电机（306）连接。
4.根据权利要求1所述的一种井下轨道车辆自动驾驶机器人，其特征在于，所述躯干前面中部设有第四双目相机（108），第四双目相机（108）与上位机（201）电连接。
5.根据权利要求3所述的一种井下轨道车辆自动驾驶机器人，其特征在于，所述惯导系统（105）与第三伺服电机（307）、第一伺服电机（305）、第二伺服电机（304）和第四伺服电机（306）连接。
6.根据权利要求1所述的一种井下轨道车辆自动驾驶机器人，其特征在于，所述躯干上设有RFID射频标签（106）。
7.根据权利要求1-6所述的一种井下轨道车辆自动驾驶机器人控制方法，其特征在于，包括以下步骤：
步骤一：启停控制：机器人的第二双目相机（104）和第三双目相机扫描装货地点的识别标签，将到达指定地点的信息传递给机器人，上位机（201）将处理后的数据传递给VCU整车控制器（202），VCU整车控制器（202）下达指令给下位机（203）控制机械臂（303）按下启停/牵引按钮，完成轨道车辆停车动作；待货物装载完成后，装货地点通知VCU整车控制器（202），VCU整车控制器（202）下达指令给下位机（203）控制机械臂（303）按下启停/牵引按钮，完成轨道车辆启动；机器人的第二双目相机（104）和第三双目相机扫描装货地点的识别标签，将到达指定地点的信息传递给机器人，上位机（201）将处理后的数据传递给VCU整车控制器（202），VCU整车控制器（202）下达指令给下位机（203）控制机械臂（303）按下启停/牵引按钮，完成轨道车辆停车动作；
步骤二：行驶控制：当轨道车辆运行时，第一双目相机（101）实时监测车辆前方障碍物信息，第二双目相机（104）、第三双目相机实时检测车辆两侧的障碍物信息，第一毫米波雷达（102）和第二毫米波雷达（103）实时检测车辆两侧有无人员或车辆入侵，检测结果传输至上位机（201）进行感知融合，上位机（201）接收这些信号并进行决策融合处理，处理结果为：当前方无障碍物且无弯道时，上位机（201）输出信号为0000；当前方有障碍物，但大于设定的安全距离时，输出信号为0001；当前方有障碍物，小于设定的安全距离但大于设定的危险距离时，输出信号为0101；当前方有障碍物，且小于设定的危险距离时，输出信号为0111；处理结果传输到VCU整车控制器（202）；
当上位机（201）输出信号为0000时， VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制机械臂（303）推动加速档把，使机械腿（301）维持当前工作状态，加速到轨道车辆规定最高速度，实现轨道车辆直线加速控制；
当输出信号由0000变为0001时，VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制机械臂（303）和机械腿（301）维持当前状态，保持轨道车辆原速动作；
当输出信号由0001变为0101时，VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制机械臂（303）拉下速度档把，机械腿（301）缓慢踏下刹车踏板，实现轨道车辆减速动作；
当输出信号由0101变为0111时，VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制机械腿（301）实现紧急刹车，同时机械臂（303）将速度档把拉至最低，完成轨道车辆紧急制动，实现停车；
等待障碍物被清除，输出信号由0111变为0000时VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制一只机械臂（303）按下启动按钮，另一只机械臂（303）推动加速档把，收回机械腿（301），加速到轨道车辆规定最高速度，实现轨道车辆直线加速控制；
步骤三：弯道处理：当第一双目相机（101）检测到前方有弯道时，第一双目相机（101）将感知信息传递给上位机（201）：当轨道车辆前方无弯道且无障碍物时，上位机（201）输出信号为0000；当前方有弯道但无障碍物时，上位机（201）输出信号为1000；当前方有弯道且存在障碍物时，若轨道车辆与障碍物间距离大于安全距离，输出信号为1001，若轨道车辆与障碍物间距离小于安全距离大于危险距离，则输出信号为1101，若距离小于危险距离，则输出信号为1111；决策信号传递至VCU整车控制器（202）；
当上位机（201）输出信号由0000变为1000时，VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制机械臂（303）拉下速度档把，机械腿（301）踏下刹车踏板，降低车速至规定转向速度，准备转向；
当输出信号由1000变为1001时，VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制机械臂（303）和机械腿（301）保持原状态，维持低车速；
当输出信号由1001变为1101时，VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制机械臂（303）拉下速度档把，机械腿（301）踏下刹车踏板，降低至最低车速；
当输出信号由1101变为1111时，VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制机械腿（301）实现紧急刹车，同时机械臂（303）将速度档把拉至最低，完成轨道车辆紧急制动，实现停车；
当弯道处障碍物被清除后，上位机（201）输出信号由1111变为1000时，VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制一只机械臂（303）按下启动按钮，另一只机械臂（303）推动加速档把，收回机械腿（301），加速到轨道车辆规定转向速度，实现轨道车辆转向控制；
当轨道车辆驶过弯道，上位机（201）输出信号由1000变为0000时，VCU整车控制器（202）下达指令给下位机（203），下位机（203）解析VCU整车控制器（202）的指令，控制机械臂（303）推动加速档把，收回机械腿（301），加速到轨道车辆规定最高速度，实现轨道车辆直线加速控制；
步骤四：充能处理：当第四双目相机（108）观测到轨道车辆的能源不足时，向VCU整车控制器（202）传递信号，VCU整车控制器（202）处理后发出命令控制机器人驾驶轨道车辆前往充能站。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110919129.2A CN113467346A (zh) | 2021-08-11 | 2021-08-11 | 一种井下轨道车辆自动驾驶机器人及其控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110919129.2A CN113467346A (zh) | 2021-08-11 | 2021-08-11 | 一种井下轨道车辆自动驾驶机器人及其控制方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN113467346A true CN113467346A (zh) | 2021-10-01 |
Family
ID=77866309
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110919129.2A Pending CN113467346A (zh) | 2021-08-11 | 2021-08-11 | 一种井下轨道车辆自动驾驶机器人及其控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113467346A (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117201567A (zh) * | 2023-11-06 | 2023-12-08 | 理工雷科智途(北京)科技有限公司 | 一种井工矿场景感知融合技术的出入罐笼控制系统及方法 |
Citations (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN204291244U (zh) * | 2015-01-06 | 2015-04-22 | 山东鲁能智能技术有限公司 | 电力无人直升机可见光精确检测系统 |
| CN107379013A (zh) * | 2017-09-12 | 2017-11-24 | 李从宾 | 一种智能机器人专用的机械臂 |
| CN109091837A (zh) * | 2018-09-06 | 2018-12-28 | 苏州众创时代科创中心 | 一种足球训练方法 |
| CN109933055A (zh) * | 2017-12-15 | 2019-06-25 | 上海仪电数字技术股份有限公司 | 室内路径规划系统 |
| CN110316192A (zh) * | 2019-07-01 | 2019-10-11 | 百度在线网络技术（北京）有限公司 | 自动驾驶方法、装置、车辆及存储介质 |
| CN110774313A (zh) * | 2019-10-11 | 2020-02-11 | 广州供电局有限公司 | 机械臂及其末端推拉杆机构、机器人 |
| CN210072411U (zh) * | 2019-07-30 | 2020-02-14 | 苏州博众机器人有限公司 | 一种机器人避障系统及机器人 |
| CN110849366A (zh) * | 2018-08-20 | 2020-02-28 | 广州弘度信息科技有限公司 | 一种基于视觉和激光雷达融合的导航方法及系统 |
| CN210616580U (zh) * | 2019-06-21 | 2020-05-26 | 拉扎斯网络科技（上海）有限公司 | 一种机械臂及机器人 |
| CN111221020A (zh) * | 2020-03-06 | 2020-06-02 | 上海晶众信息科技有限公司 | 一种室内外定位方法、装置及系统 |
| CN111343571A (zh) * | 2020-03-07 | 2020-06-26 | 郑州联睿电子科技有限公司 | 面向5g的融合uwb的一体化定位系统及定位方法 |
| CN111390922A (zh) * | 2020-03-19 | 2020-07-10 | 深圳国信泰富科技有限公司 | 一种自动驾驶机器人 |
| CN112258886A (zh) * | 2020-10-09 | 2021-01-22 | 北京百度网讯科技有限公司 | 导航方法、装置、电子设备及存储介质 |
| CN112269388A (zh) * | 2020-10-30 | 2021-01-26 | 广东杜尼智能机器人工程技术研究中心有限公司 | 无人驾驶扫地车自动导航控制方法、装置及存储介质 |
| CN112945573A (zh) * | 2021-02-02 | 2021-06-11 | 上汽通用汽车有限公司 | 驾驶机器人的驾驶操控方法、驾驶质量评估方法、电子设备 |
| CN113018748A (zh) * | 2021-04-13 | 2021-06-25 | 安徽相品智能科技有限公司 | 一种巡检消防一体化智能机器人 |
| CN113110434A (zh) * | 2021-04-06 | 2021-07-13 | 中国矿业大学 | 一种无驾驶舱式井下无人驾驶电机车及其控制方法 |
-
2021
- 2021-08-11 CN CN202110919129.2A patent/CN113467346A/zh active Pending
Patent Citations (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN204291244U (zh) * | 2015-01-06 | 2015-04-22 | 山东鲁能智能技术有限公司 | 电力无人直升机可见光精确检测系统 |
| CN107379013A (zh) * | 2017-09-12 | 2017-11-24 | 李从宾 | 一种智能机器人专用的机械臂 |
| CN109933055A (zh) * | 2017-12-15 | 2019-06-25 | 上海仪电数字技术股份有限公司 | 室内路径规划系统 |
| CN110849366A (zh) * | 2018-08-20 | 2020-02-28 | 广州弘度信息科技有限公司 | 一种基于视觉和激光雷达融合的导航方法及系统 |
| CN109091837A (zh) * | 2018-09-06 | 2018-12-28 | 苏州众创时代科创中心 | 一种足球训练方法 |
| CN210616580U (zh) * | 2019-06-21 | 2020-05-26 | 拉扎斯网络科技（上海）有限公司 | 一种机械臂及机器人 |
| CN110316192A (zh) * | 2019-07-01 | 2019-10-11 | 百度在线网络技术（北京）有限公司 | 自动驾驶方法、装置、车辆及存储介质 |
| CN210072411U (zh) * | 2019-07-30 | 2020-02-14 | 苏州博众机器人有限公司 | 一种机器人避障系统及机器人 |
| CN110774313A (zh) * | 2019-10-11 | 2020-02-11 | 广州供电局有限公司 | 机械臂及其末端推拉杆机构、机器人 |
| CN111221020A (zh) * | 2020-03-06 | 2020-06-02 | 上海晶众信息科技有限公司 | 一种室内外定位方法、装置及系统 |
| CN111343571A (zh) * | 2020-03-07 | 2020-06-26 | 郑州联睿电子科技有限公司 | 面向5g的融合uwb的一体化定位系统及定位方法 |
| CN111390922A (zh) * | 2020-03-19 | 2020-07-10 | 深圳国信泰富科技有限公司 | 一种自动驾驶机器人 |
| CN112258886A (zh) * | 2020-10-09 | 2021-01-22 | 北京百度网讯科技有限公司 | 导航方法、装置、电子设备及存储介质 |
| CN112269388A (zh) * | 2020-10-30 | 2021-01-26 | 广东杜尼智能机器人工程技术研究中心有限公司 | 无人驾驶扫地车自动导航控制方法、装置及存储介质 |
| CN112945573A (zh) * | 2021-02-02 | 2021-06-11 | 上汽通用汽车有限公司 | 驾驶机器人的驾驶操控方法、驾驶质量评估方法、电子设备 |
| CN113110434A (zh) * | 2021-04-06 | 2021-07-13 | 中国矿业大学 | 一种无驾驶舱式井下无人驾驶电机车及其控制方法 |
| CN113018748A (zh) * | 2021-04-13 | 2021-06-25 | 安徽相品智能科技有限公司 | 一种巡检消防一体化智能机器人 |
Non-Patent Citations (1)
| Title |
|---|
| 王海涛，仇跃华，梁银川: "《卫星应用技术》", 31 March 2018, pages: 387 - 389 * |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117201567A (zh) * | 2023-11-06 | 2023-12-08 | 理工雷科智途(北京)科技有限公司 | 一种井工矿场景感知融合技术的出入罐笼控制系统及方法 |
| CN117201567B (zh) * | 2023-11-06 | 2024-02-13 | 理工雷科智途(北京)科技有限公司 | 一种井工矿场景感知融合技术的出入罐笼控制系统及方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109542097B (zh) | 红外置顶循迹的井下无人无轨胶轮车及其行驶控制方法 | |
| CN108345305A (zh) | 无轨胶轮车智能车载系统、井下车辆调度系统和控制方法 | |
| CN108773381A (zh) | 一种基于行车电脑控制的矿山轨道机车无人自动驾驶系统 | |
| CN104442452B (zh) | 无人驾驶电动无轨三向堆垛叉车 | |
| CN103412593A (zh) | 潜伏式agv移动搬运机器人 | |
| CN105416259A (zh) | 基于视频识别无人驾驶电机车行车控制系统 | |
| CN101353011A (zh) | 智能全轮电驱动汽车结构 | |
| CN113022408B (zh) | 一种360°自适应装卸载无人驾驶矿用自卸车及其控制方法 | |
| CN112947496A (zh) | 一种无人驾驶的无轨胶轮车标准化运输平台及其控制方法 | |
| CN210852627U (zh) | 一种可自动控制行驶的车辆 | |
| CN108622145A (zh) | 一种悬挂式单轨机车运输系统 | |
| CN110727279A (zh) | 一种agv小车控制系统 | |
| CN113467346A (zh) | 一种井下轨道车辆自动驾驶机器人及其控制方法 | |
| CN110588768A (zh) | 一种可自动控制行驶的车辆 | |
| CN113085917B (zh) | 一种轮-轨复合式无人驾驶井下连续运输车及其控制方法 | |
| CN111913477A (zh) | 一种无人驾驶矿用电传动自卸车 | |
| CN212921527U (zh) | 一种隧道渣土有轨运输工矿车无人驾驶系统 | |
| CN110803009A (zh) | 一种可自动驾驶的双向行驶电动卡车 | |
| CN112141072A (zh) | 一种路面加速加载试验无人驾驶车 | |
| CN106274552A (zh) | 汽车控制系统 | |
| CN203441536U (zh) | 煤矿井下矿车运输监控系统 | |
| CN113460049A (zh) | 一种机器人驾驶的井下顺槽运输无轨胶轮车及其控制方法 | |
| EP3778334A1 (en) | Operating mode control system and method for container track power flatcar | |
| CN203164762U (zh) | 一种小车自动导引和避障系统 | |
| CN114017264A (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 | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20211001 |
|
| RJ01 | Rejection of invention patent application after publication |