WO2024108439A1 - Driverless forklift obstacle avoidance and obstacle bypassing method and system integrating 3d visual camera and radar - Google Patents

Driverless forklift obstacle avoidance and obstacle bypassing method and system integrating 3d visual camera and radar Download PDF

Info

Publication number
WO2024108439A1
WO2024108439A1 PCT/CN2022/133814 CN2022133814W WO2024108439A1 WO 2024108439 A1 WO2024108439 A1 WO 2024108439A1 CN 2022133814 W CN2022133814 W CN 2022133814W WO 2024108439 A1 WO2024108439 A1 WO 2024108439A1
Authority
WO
WIPO (PCT)
Prior art keywords
obstacle
radar
control unit
detection component
gear
Prior art date
Application number
PCT/CN2022/133814
Other languages
French (fr)
Chinese (zh)
Inventor
张魏魏
Original Assignee
滁州市哈工库讯智能科技有限公司
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 滁州市哈工库讯智能科技有限公司 filed Critical 滁州市哈工库讯智能科技有限公司
Priority to PCT/CN2022/133814 priority Critical patent/WO2024108439A1/en
Publication of WO2024108439A1 publication Critical patent/WO2024108439A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details

Definitions

  • the present invention relates to the technical field of forklifts, and in particular to an obstacle avoidance and circumvention method and system for unmanned forklifts integrating a 3D visual camera and a radar.
  • a forklift refers to a variety of wheeled handling vehicles that are used for loading and unloading, stacking and short-distance transportation of palletized goods.
  • the structural characteristics and working performance of the forklift are indicated by technical parameters such as rated lifting capacity, load center distance, and mast inclination angle. It is usually divided into types such as internal combustion forklifts and electric forklifts.
  • Forklifts are often needed to move goods in factory logistics, but most existing forklifts require manual operation, which takes up a lot of manpower.
  • the purpose of the present invention is to provide an unmanned forklift obstacle avoidance and circumvention method and system that integrates 3D vision camera and radar, which communicates with the host computer under control and can automatically avoid and circumvent obstacles without manual operation, thus saving human resources.
  • the present invention provides the following technical solutions:
  • An unmanned forklift obstacle avoidance and bypassing system integrating 3D vision camera and radar comprising:
  • a vehicle housing comprising a bottom plate and a protective shell connected to the bottom plate;
  • Moving wheels are arranged at the four corners of the bottom plate and extend out from the bottom;
  • a driving assembly is installed inside the vehicle shell, wherein a portion of the driving assembly extends to the top of the protective shell, and another portion is connected to the steering input end of the moving wheel;
  • an obstacle detection assembly located directly above the protective shell and connected to an extended portion of the drive assembly
  • a cargo fork is installed in front of the vehicle body to fork and pick up the cargo
  • the moving wheel drives the vehicle body to move forward according to the instruction of the control unit, and at the same time the obstacle detection component detects whether there is an obstacle in front of the movement;
  • the driving component drives the moving wheel and the obstacle detection component to turn 90° as a whole, and then continue to move forward after the rotation.
  • the obstacle detection component detects whether the above obstacle has been crossed. If it has been crossed, the control unit replans the route according to the instructions of the upper computer and controls the movement of the moving wheel or the driving component.
  • the driving assembly includes a main gear plate, four driven gears surrounding the main gear plate, a driven transmission shaft coaxially arranged with the driven gears, a transmission belt meshing with the driven gears, an active transmission shaft coaxially arranged with the main gear plate, and a steering drive motor installed on the bottom plate and having an output end connected to the active transmission shaft;
  • two symmetrical driven gears are meshed with the main gear plate, one end of the driven transmission shaft is connected to the steering input end of the moving wheel, and the other end is rotatably connected to the top of the inner wall of the protective shell.
  • the obstacle detection component includes a rectangular rotating head connected to the active transmission shaft, a radar detection component installed on one side of the rotating head, and two visual cameras installed on the other side of the rotating head;
  • the mounting surfaces of the two visual cameras are perpendicular to the mounting surface of the radar detection component.
  • the radar detection component includes a radar wave transmitting end and a radar wave receiving end.
  • the seat body includes a first support seat and a second support seat connected to the base by an axle pin and located above the base;
  • the travel assembly includes a rotating disk rotatably connected to the axial hole of the base through a bearing and symmetrically provided with supporting ears at the bottom, a supporting shaft rod arranged between the two supporting ears, a travel wheel coaxially connected to the supporting shaft rod and having a first bevel gear on the side wall, a second bevel gear meshing with the travel wheel, a travel transmission spur gear located above the rotating disk and coaxially connected to the second bevel gear through the shaft rod, and a travel drive motor installed on the first support seat and having a travel drive gear at the output end meshing with the travel transmission spur gear;
  • the steering transmission assembly comprises a reduction motor mounted on the second support seat, a first steering transmission shaft rod and a second steering transmission shaft rod mounted on the second support seat;
  • the output end of the reduction motor is provided with a reduction transmission gear
  • the first steering transmission shaft is provided with a first steering transmission gear and a second steering transmission gear meshing with the reduction transmission gear;
  • the second steering transmission shaft is provided with a third steering transmission gear and a fourth steering transmission gear meshed with the second steering transmission gear, and the fourth steering transmission gear meshes with the tooth groove of the rotating disk through a steering transmission gear belt.
  • the fork includes a rectangular frame, a lifting drive motor installed on the bottom frame of the rectangular frame, a screw rod with one end connected to the output end of the lifting drive motor and the other end connected to the top frame of the rectangular frame, a sliding plate slidably connected to the vertical frame of the rectangular frame and with a moving block on the rear side wall engaged with the screw rod, and a fork frame arranged perpendicular to the sliding plate.
  • a method for unmanned forklift obstacle avoidance and bypassing that integrates 3D vision camera and radar the specific steps are as follows:
  • the control unit of the unmanned forklift drives the moving wheels to move forward according to the walking route planned by the host computer, and adjusts the walking direction of the moving wheels by driving the driving component.
  • the radar detection component of the obstacle detection component emits radar waves forward to detect whether there are obstacles within a certain distance ahead;
  • the control unit controls the moving wheel to stop moving, and sends a steering command to the driving component.
  • the driving component drives the moving wheel and the obstacle detection component to turn 90° as a whole.
  • the radar detection component of the obstacle detection component continues to detect whether there is an obstacle ahead after the turn.
  • the two visual cameras face the previously detected obstacle, obtain the depth image of the obstacle, and construct a three-dimensional model of the road scene of the obstacle ahead, and transmit it to the control unit;
  • control unit sends a walking command to the moving wheel, and the moving wheel continues to move forward after the rotation.
  • control unit determines in real time whether the unmanned forklift bypasses the obstacle based on the three-dimensional model of the road scene of the obstacle in front constructed by the two visual cameras. When it is determined that the unmanned forklift bypasses the obstacle, the control unit continues to move forward according to the planned route.
  • the control unit determines the length of the obstacle based on the acquired depth image of the obstacle, and controls the unmanned forklift to move forward after rotation to a distance equal to the length of the obstacle. At the same time, the control unit determines whether there are any obstacles in the obstacle road scene directly in front of the vehicle constructed by the vision camera. When the distance controlled to move the unmanned forklift forward after rotation is greater than the length of the obstacle, and the obstacle road scene directly in front of the vehicle constructed by the vision camera does not have any obstacles, the control unit determines to bypass the obstacle.
  • the present invention has the following beneficial effects:
  • the present invention integrates 3D visual cameras and radars, and communicates with a host computer to walk along a planned route.
  • the driving component drives the moving wheels and the obstacle detection component to turn 90 degrees as a whole to avoid the obstacle and continue to move forward.
  • the detection component after turning continues to detect the obstacle condition in front after the turning through the radar detection component.
  • the two visual cameras are facing the previously detected obstacles, obtain the depth image of the obstacles, and construct a three-dimensional model of the obstacle road scene ahead.
  • the control unit drives the moving wheels to walk a corresponding distance according to the depth image of the obstacles taken by the visual cameras and the three-dimensional model of the obstacle road scene ahead to see if they can bypass the obstacles.
  • obstacle avoidance and bypassing can be automatically achieved without manual operation, saving human resources.
  • the innovative design of the moving wheel of the present invention is highly integrated and compact, which saves space. It can be driven by itself and can be controlled to turn to drive the unmanned forklift to adjust the walking direction, thereby meeting the movement and turning requirements of the unmanned forklift.
  • FIG1 is a schematic diagram of the overall structure of an unmanned forklift obstacle avoidance and bypassing system that integrates a 3D vision camera and a radar according to the present invention
  • FIG2 is a schematic diagram of a portion of the structure of the unmanned forklift obstacle avoidance and bypassing system integrating a 3D vision camera and a radar for removing a fork according to the present invention
  • FIG3 is an assembly diagram of the bottom plate, moving wheels, driving components and obstacle detection components of the obstacle avoidance and bypassing system for unmanned forklifts integrating 3D vision cameras and radars according to the present invention
  • FIG4 is a schematic diagram of a portion of the structure of FIG3 of the unmanned forklift obstacle avoidance and bypassing system integrating a 3D vision camera and a radar according to the present invention
  • FIG5 is a schematic diagram of the overall structure of the mobile wheels of the obstacle avoidance and bypassing system for an unmanned forklift integrating a 3D vision camera and a radar according to the present invention
  • FIG. 6 is a schematic diagram of the first direction structure of the mobile wheel removal seat of the unmanned forklift obstacle avoidance and circumvention system integrating a 3D vision camera and a radar according to the present invention
  • FIG. 7 is a schematic diagram of the second direction structure of the mobile wheel removal seat of the unmanned forklift obstacle avoidance and circumvention system integrating 3D vision camera and radar according to the present invention
  • FIG8 is a schematic diagram of the third direction structure of the mobile wheel removal seat of the unmanned forklift obstacle avoidance and circumvention system integrating 3D vision camera and radar according to the present invention
  • FIG. 9 is a schematic diagram of the first direction structure of the fork of the unmanned forklift obstacle avoidance and bypassing system integrating the 3D vision camera and the radar of the present invention
  • FIG. 10 is a schematic diagram of the second direction structure of the fork of the unmanned forklift obstacle avoidance and bypassing system integrating 3D vision camera and radar according to the present invention.
  • the present invention provides an obstacle avoidance and circumvention method and system for an unmanned forklift integrating a 3D visual camera and a radar, which is controlled by communication with a host computer and can automatically avoid and circumvent obstacles without manual operation, thus saving human resources.
  • the unmanned forklift obstacle avoidance and obstacle avoidance system integrating 3D vision camera and radar includes a vehicle body 100, moving wheels 200, a driving assembly 300, an obstacle detection assembly 400 and a fork 500.
  • the vehicle housing 100 includes a bottom plate 110 and a protective shell 120 connected to the bottom plate 110 .
  • the bottom plate 110 is used to install the moving wheels 200 , the driving assembly 300 and the fork 500 .
  • the moving wheels 200 are arranged at the four corners of the base plate 110 and extend out from the bottom, and can drive the unmanned forklift to move by itself and be controlled to achieve steering.
  • the driving assembly 300 is installed inside the vehicle body 100 , wherein a portion of the driving assembly 300 extends to the top of the protective shell 120 for connecting with the obstacle detection assembly 400 , and the other portion is connected to the steering input end of the moving wheel 200 .
  • the obstacle detection component 400 is located directly above the protective shell 120 and connected to the extended portion of the driving component 300.
  • it includes a rectangular rotating head 410, a radar detection component 420 installed on one side of the rotating head 410, and two visual cameras 430 installed on the other side of the rotating head 410, wherein the mounting surfaces of the two visual cameras 430 are perpendicular to the mounting surface of the radar detection component 420, and the radar detection component 420 includes a radar wave transmitting end 420a and a radar wave receiving end 420b.
  • the radar detection component 420 transmits a radar detection wave forward. If the radar wave receiving end 420b can receive the reflected radar wave signal, it indicates that there is an obstacle within a certain distance range ahead of the detection.
  • the driving component 300 drives the obstacle detection component 400 to rotate 90°.
  • the two visual cameras 430 are facing the previously detected obstacle, obtain the depth image of the obstacle, and construct a three-dimensional model of the road scene of the obstacle ahead, and transmit it to the control unit.
  • the cargo fork 500 is installed at the front position of the vehicle body 100 to fork the cargo.
  • the cargo fork 500 includes a rectangular frame 510, a lifting drive motor 520 installed on the bottom frame 510a of the rectangular frame 510, a screw rod 530 having one end connected to the output end of the lifting drive motor 520 and the other end connected to the top frame 510c of the rectangular frame 510, a sliding plate 540 slidably connected to the vertical frame 510b of the rectangular frame 510 and having a moving block 540a meshing with the screw rod 530 on the rear side wall, and a fork frame 550 vertically arranged to the sliding plate 540.
  • the lifting drive motor 520 drives the screw rod 530 to rotate.
  • the sliding plate 540 is driven to move up and down through the moving block 540a, thereby driving the fork frame 550 to move up and down to fork and deliver the cargo.
  • the moving wheel 200 drives the vehicle body 100 to move forward by itself according to the instructions of the control unit, and at the same time, the obstacle detection component 400 detects whether there is an obstacle in front of the movement.
  • the driving component 300 drives the moving wheel 200 and the obstacle detection component 400 to turn 90° as a whole, and then continue to move forward after the rotation.
  • the obstacle detection component 400 detects whether the above-mentioned obstacle is crossed. If it is crossed, the control unit re-plans the route according to the instructions of the upper computer and controls the moving wheel 200 or the driving component 300 to move.
  • FIG3 to FIG8 are partial structural schematic diagrams of a second embodiment of the unmanned forklift obstacle avoidance and bypassing system integrating a 3D visual camera and a radar according to the present invention. Please refer to FIG3 to FIG8. Different from the above embodiment, in this embodiment:
  • the driving assembly 300 includes a main gear plate 310, four driven gears 320 surrounding the main gear plate 310, a driven transmission shaft 330 coaxially arranged with the driven gears 320, a transmission belt 340 meshing with the driven gears 320, an active transmission shaft 350 coaxially arranged with the main gear plate 310, and a steering drive motor 360 installed on the base plate 110 and having an output end connected to the active transmission shaft 350, wherein two mutually symmetrical driven gears 320 are meshed with the main gear plate 310, one end of the driven transmission shaft 330 is connected to the steering input end of the moving wheel 200, and the other end is rotatably connected to the top of the inner wall of the protective shell 120, when the steering drive motor 360 drives the active transmission shaft 350, the active transmission shaft 350 drives the obstacle detection assembly 400 to rotate, and at the same time, the main gear plate 310 rotates along with the active transmission shaft 350.
  • the two driven gears 320 meshing therewith are driven to rotate, and under the transmission action of the transmission belt 340 , the four driven gears 320 rotate synchronously together to drive the driven transmission shaft 330 coaxially connected therewith to rotate, thereby driving the moving wheel 200 to turn.
  • the moving wheel 200 includes a base 210 , a traveling assembly 220 mounted on the base 210 , and a steering transmission assembly 230 mounted on the base 210 for driving the traveling assembly 220 to turn.
  • the input end of the steering transmission assembly 230 is connected to the driven transmission shaft 330 .
  • the seat body 210 includes a first support seat 210b and a second support seat 210c connected to the base 210a by an axle pin and located above the base 210a;
  • the walking assembly 220 includes a rotating disk 220a which is rotatably connected to the shaft hole of the base 210a through a bearing and has support ears 220a-2 symmetrically arranged at the bottom, a support shaft 220b arranged between the two support ears 220a-2, a walking wheel 220c which is coaxially connected to the support shaft 220b and has a first bevel gear 220c-1 on the side wall, a second bevel gear 220d meshing with the walking wheel 220c, and a walking wheel 220c which is located above the rotating disk 220a and is coaxially connected to the second bevel gear 220d through the shaft.
  • the transmission spur gear 220e and the walking drive motor 220f are installed on the first support seat 210b and the walking drive gear 220f-1 at the output end is meshed with the walking transmission spur gear 220e.
  • the walking drive motor 220f drives the walking transmission spur gear 220e to rotate through the walking drive gear 220f-1, and the second bevel gear 220d rotates together with the walking transmission spur gear 220e.
  • the second bevel gear drives the walking wheel 220c to move by meshing with the first bevel gear 220c-1.
  • the steering transmission assembly 230 includes a reduction motor 230a installed on the second support seat 210c, a first steering transmission shaft 230b installed on the second support seat 210c, and a second steering transmission shaft 230, the output end of the reduction motor 230a has a reduction transmission gear 230a-1, the first steering transmission shaft 230b has a first steering transmission gear 230b-1 and a second steering transmission gear 230b-2 meshed with the reduction transmission gear 230a-1, the second steering transmission shaft 230 has a third steering transmission gear 230c-1 and a fourth steering transmission gear 230c-2 meshed with the second steering transmission gear 230b-2, the fourth steering transmission gear 230c-2 is connected to the tooth groove of the rotating disk 220a through the steering transmission gear belt 230d 220a-1 is engaged.
  • the input end of the reduction motor 230a is subjected to the steering driving force of the driven transmission shaft 330, and the first steering transmission shaft 230b is driven to rotate through the reduction transmission gear 230a-1 and the first steering transmission gear 230b-1.
  • the first steering transmission shaft 230b rotates
  • the second steering transmission shaft 230 is driven to rotate through the second steering transmission gear 230b-2 and the third steering transmission gear 230c-1.
  • the second steering transmission shaft 230 drives the rotating disk 220a to rotate through the fourth steering transmission gear 230c-2 and the steering transmission gear belt 230d, thereby realizing the steering of the walking component 220.
  • the method of the obstacle avoidance and bypassing system of an unmanned forklift integrating 3D vision camera and radar is as follows:
  • the control unit of the unmanned forklift drives the moving wheel 200 to move forward according to the walking route planned by the upper computer, and adjusts the walking direction of the moving wheel 200 by driving the driving component 300.
  • the radar detection component 420 of the obstacle detection component 400 emits radar waves forward to detect whether there are obstacles within a certain distance ahead;
  • the control unit controls the moving wheel 200 to stop moving, and sends a steering command to the driving component 300.
  • the driving component 300 drives the moving wheel 200 and the obstacle detection component 400 to turn 90° as a whole.
  • the radar detection component 420 of the obstacle detection component 400 continues to detect whether there is an obstacle ahead after the turn.
  • the two visual cameras 430 are facing the previously detected obstacles to obtain the depth image of the obstacles, and construct a three-dimensional model of the road scene of the obstacles ahead, and transmit it to the control unit;
  • the control unit sends a walking command to the moving wheel 200, and the moving wheel 200 continues to move forward after the rotation.
  • the control unit determines in real time whether the unmanned forklift bypasses the obstacle according to the three-dimensional model of the obstacle road scene in front constructed by the two visual cameras 430. When it is determined that the unmanned forklift bypasses the obstacle, the control unit continues to walk forward according to the planned route.
  • the specific steps of the control unit determining in real time whether the unmanned forklift bypasses the obstacle according to the three-dimensional model of the obstacle road scene in front constructed by the two visual cameras 430 are as follows: the visual camera 430 obtains the depth image of the obstacle, and constructs the three-dimensional model of the obstacle road scene in front, and transmits it to the control unit; the control unit determines the length of the obstacle according to the acquired depth image of the obstacle, and controls the unmanned forklift to move forward to the distance of the length of the obstacle after the rotation. At the same time, the control unit determines whether there is still an obstacle in the obstacle road scene in front constructed by the visual camera 430. When the distance controlled to move the unmanned forklift to the front after the rotation is greater than the distance of the length of the obstacle, and the obstacle road scene in front constructed by the visual camera 430 does not have an obstacle, it is determined to bypass the obstacle.

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Structural Engineering (AREA)
  • Civil Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Geology (AREA)
  • Mechanical Engineering (AREA)
  • Forklifts And Lifting Vehicles (AREA)

Abstract

A driverless forklift obstacle avoidance and obstacle bypassing method and system integrating a 3D visual camera (430) and a radar. The driverless forklift obstacle avoidance and obstacle bypassing system integrating a 3D visual camera and a radar comprises a forklift housing (100), moving wheels (200), a driving assembly (300), an obstacle detection assembly (400), and a fork (500). The forklift housing (100) comprises a bottom plate (110) and a protective housing (120) connected to the bottom plate (110). The moving wheels (200) are arranged at four corners of the bottom plate (110), and pass through the bottom plate (110) from the bottom thereof. The driving assembly (300) is mounted inside the forklift housing (100), one part of the driving assembly (300) extends to the top of the protective housing (120), and the other part of the driving assembly (300) is connected to steering input ends of the moving wheels (200). The obstacle detection assembly (400) is located directly above the protective housing (120), and is connected to the extending part of the driving assembly (300). The fork (500) is mounted in front of the forklift housing (100) to fork goods. The driverless forklift obstacle avoidance and obstacle bypassing system integrating a 3D visual camera and a radar communicates with and is controlled by an upper computer, so that manual operation is not needed, and manpower resources are saved.

Description

融合3d视觉相机与雷达的无人叉车避障与绕障方法及系统Unmanned forklift obstacle avoidance and circumvention method and system integrating 3D vision camera and radar 技术领域Technical Field
本发明涉及叉车技术领域,具体为融合3d视觉相机与雷达的无人叉车避障与绕障方法及系统。The present invention relates to the technical field of forklifts, and in particular to an obstacle avoidance and circumvention method and system for unmanned forklifts integrating a 3D visual camera and a radar.
背景技术Background technique
叉车是指对成件托盘货物进行装卸、堆垛和短距离运输作业的各种轮式搬运车辆,用额定起重量、载荷中心距、门架倾角等技术参数来表明叉车的结构特征和工作性能,通常分为内燃叉车、电动叉车等类型。A forklift refers to a variety of wheeled handling vehicles that are used for loading and unloading, stacking and short-distance transportation of palletized goods. The structural characteristics and working performance of the forklift are indicated by technical parameters such as rated lifting capacity, load center distance, and mast inclination angle. It is usually divided into types such as internal combustion forklifts and electric forklifts.
在工厂的物流运输中经常需要用到叉车对货物进行搬运,但现有的叉车大多需要人工操作,其占用大量人力资源。Forklifts are often needed to move goods in factory logistics, but most existing forklifts require manual operation, which takes up a lot of manpower.
发明内容Summary of the invention
本部分的目的在于概述本发明的实施方式的一些方面以及简要介绍一些较佳实施方式。在本部分以及本申请的说明书摘要和发明名称中可能会做些简化或省略以避免使本部分、说明书摘要和发明名称的目的模糊,而这种简化或省略不能用于限制本发明的范围。The purpose of this section is to summarize some aspects of the embodiments of the present invention and briefly introduce some preferred embodiments. Some simplifications or omissions may be made in this section and the specification abstract and the invention title of this application to avoid blurring the purpose of this section, the specification abstract and the invention title, and such simplifications or omissions cannot be used to limit the scope of the present invention.
鉴于上述和/或现有的叉车中存在的问题,提出了本发明。In view of the above problems and/or the problems existing in the existing forklifts, the present invention is proposed.
因此,本发明的目的是提供融合3d视觉相机与雷达的无人叉车避障与绕障方法及系统,与上位机通讯受控,自行实现障碍物的避障和绕障,无需人工操作,节省人力资源。Therefore, the purpose of the present invention is to provide an unmanned forklift obstacle avoidance and circumvention method and system that integrates 3D vision camera and radar, which communicates with the host computer under control and can automatically avoid and circumvent obstacles without manual operation, thus saving human resources.
为解决上述技术问题,根据本发明的一个方面,本发明提供了如下技术方案:To solve the above technical problems, according to one aspect of the present invention, the present invention provides the following technical solutions:
一种融合3d视觉相机与雷达的无人叉车避障与绕障系统,包括:An unmanned forklift obstacle avoidance and bypassing system integrating 3D vision camera and radar, comprising:
车壳体,包括底板和与所述底板连接的防护壳;A vehicle housing, comprising a bottom plate and a protective shell connected to the bottom plate;
移动轮,设置在所述底板的四角,并从底部穿出;Moving wheels are arranged at the four corners of the bottom plate and extend out from the bottom;
驱动组件,安装在所车壳体内部,其中,该驱动组件的一部分延伸至防 护壳的顶部,另一部分与所述移动轮的转向输入端连接;A driving assembly is installed inside the vehicle shell, wherein a portion of the driving assembly extends to the top of the protective shell, and another portion is connected to the steering input end of the moving wheel;
障碍物探测组件,位于所述防护壳的正上方并与驱动组件的延伸部分连接;an obstacle detection assembly, located directly above the protective shell and connected to an extended portion of the drive assembly;
货叉,安装在所述车壳体的前方位置,对货物进行叉取;A cargo fork is installed in front of the vehicle body to fork and pick up the cargo;
其中,在正常状态下,移动轮根据控制单元指令自行驱动车壳体向前方移动,同时障碍物探测组件探测移动前方是否具有障碍物;Among them, in a normal state, the moving wheel drives the vehicle body to move forward according to the instruction of the control unit, and at the same time the obstacle detection component detects whether there is an obstacle in front of the movement;
当障碍物探测组件发现正前方一定距离具有障碍物时,驱动组件驱动移动轮和障碍物探测组件整体转向90°,然后继续向旋转后的前方移动,同时障碍物探测组件检测是否越过上述障碍物,若越过,则控制单元根据上位机的指令重新规划路线,控制移动轮或者驱动组件动作。When the obstacle detection component finds an obstacle at a certain distance in front, the driving component drives the moving wheel and the obstacle detection component to turn 90° as a whole, and then continue to move forward after the rotation. At the same time, the obstacle detection component detects whether the above obstacle has been crossed. If it has been crossed, the control unit replans the route according to the instructions of the upper computer and controls the movement of the moving wheel or the driving component.
作为本发明所述的一种融合3d视觉相机与雷达的无人叉车避障与绕障系统的一种优选方案,其中,所述驱动组件包括主齿轮盘、环绕包围所述主齿轮盘的四个从动齿轮、与所述从动齿轮同轴设置的从动传动轴杆、与所述从动齿轮啮合的传动带、与所述主齿轮盘同轴设置的主动传动轴杆以及安装在所述底板上且输出端与所述主动传动轴杆连接的转向驱动电机;As a preferred solution of the obstacle avoidance and bypassing system for unmanned forklifts integrating 3D vision cameras and radars described in the present invention, the driving assembly includes a main gear plate, four driven gears surrounding the main gear plate, a driven transmission shaft coaxially arranged with the driven gears, a transmission belt meshing with the driven gears, an active transmission shaft coaxially arranged with the main gear plate, and a steering drive motor installed on the bottom plate and having an output end connected to the active transmission shaft;
其中,其中两个相互对称的从动齿轮与所述主齿轮盘啮合,所述从动传动轴杆的一端与所述移动轮的转向输入端连接,另一端与所述防护壳的内壁顶部转动连接。Among them, two symmetrical driven gears are meshed with the main gear plate, one end of the driven transmission shaft is connected to the steering input end of the moving wheel, and the other end is rotatably connected to the top of the inner wall of the protective shell.
作为本发明所述的一种融合3d视觉相机与雷达的无人叉车避障与绕障系统的一种优选方案,其中,所述障碍物探测组件包括与所述主动传动轴杆连接且呈矩形状的旋转头、安装在所述旋转头一侧面的雷达探测部件和安装在所述旋转头另一侧面的两个视觉相机;As a preferred solution of the unmanned forklift obstacle avoidance and circumvention system integrating 3D visual camera and radar described in the present invention, the obstacle detection component includes a rectangular rotating head connected to the active transmission shaft, a radar detection component installed on one side of the rotating head, and two visual cameras installed on the other side of the rotating head;
其中,两个视觉相机的安装面与所述雷达探测部件的安装面垂直。Wherein, the mounting surfaces of the two visual cameras are perpendicular to the mounting surface of the radar detection component.
作为本发明所述的一种融合3d视觉相机与雷达的无人叉车避障与绕障系统的一种优选方案,其中,所述雷达探测部件包括雷达波发射端和雷达波接 收端。As a preferred solution of the unmanned forklift obstacle avoidance and bypassing system integrating a 3D vision camera and a radar described in the present invention, the radar detection component includes a radar wave transmitting end and a radar wave receiving end.
作为本发明所述的一种融合3d视觉相机与雷达的无人叉车避障与绕障系统的一种优选方案,其中,所述移动轮包括座体、安装在所述座体上的行走组件和安装在所述座体驱动所述行走组件转向的转向传动组件,所述转向传动组件的输入端与所述从动传动轴杆连接。As a preferred solution of the unmanned forklift obstacle avoidance and circumvention system integrating a 3D vision camera and a radar as described in the present invention, the moving wheel includes a seat body, a walking assembly installed on the seat body, and a steering transmission assembly installed on the seat body for driving the walking assembly to turn, and the input end of the steering transmission assembly is connected to the driven transmission shaft.
作为本发明所述的一种融合3d视觉相机与雷达的无人叉车避障与绕障系统的一种优选方案,其中,所述座体包括底座通过轴销与所述底座连接且位于所述底座上方的第一支撑座以及第二支撑座;As a preferred solution of the obstacle avoidance and bypassing system for unmanned forklifts integrating 3D vision cameras and radars described in the present invention, the seat body includes a first support seat and a second support seat connected to the base by an axle pin and located above the base;
所述行走组件包括通过轴承与所述底座的轴孔旋转连接且底部对称设置有支撑耳-的旋转盘、设置在两个所述支撑耳之间的支撑轴杆、与所述支撑轴杆同轴连接且侧壁具有第一锥齿轮的行走轮、与所述行走轮啮合的第二锥齿轮、位于所述旋转盘的上方且通过轴杆与所述第二锥齿轮同轴连接的行走传动直齿轮以及安装在所述第一支撑座上且输出端的行走驱动齿轮与所述行走传动直齿轮啮合的行走驱动电机;The travel assembly includes a rotating disk rotatably connected to the axial hole of the base through a bearing and symmetrically provided with supporting ears at the bottom, a supporting shaft rod arranged between the two supporting ears, a travel wheel coaxially connected to the supporting shaft rod and having a first bevel gear on the side wall, a second bevel gear meshing with the travel wheel, a travel transmission spur gear located above the rotating disk and coaxially connected to the second bevel gear through the shaft rod, and a travel drive motor installed on the first support seat and having a travel drive gear at the output end meshing with the travel transmission spur gear;
所述转向传动组件包括安装在所述第二支撑座上的减速电机、安装在所述第二支撑座上的第一转向传动轴杆以及第二转向传动轴杆;The steering transmission assembly comprises a reduction motor mounted on the second support seat, a first steering transmission shaft rod and a second steering transmission shaft rod mounted on the second support seat;
所述减速电机的输出端具有减速传动齿轮,所述第一转向传动轴杆上具有与所述减速传动齿轮啮合的第一转向传动齿轮以及第二转向传动齿轮;The output end of the reduction motor is provided with a reduction transmission gear, and the first steering transmission shaft is provided with a first steering transmission gear and a second steering transmission gear meshing with the reduction transmission gear;
所述第二转向传动轴杆上具有与所述第二转向传动齿轮啮合的第三转向传动齿轮以及第四转向传动齿轮,所述第四转向传动齿轮通过转向传动齿轮带与所述旋转盘的齿槽啮合。The second steering transmission shaft is provided with a third steering transmission gear and a fourth steering transmission gear meshed with the second steering transmission gear, and the fourth steering transmission gear meshes with the tooth groove of the rotating disk through a steering transmission gear belt.
作为本发明所述的一种融合3d视觉相机与雷达的无人叉车避障与绕障系统的一种优选方案,其中,所述货叉包括矩形框架、安装在所述矩形框架的底架上的升降驱动电机、一端部与所述升降驱动电机的输出端连接,另一端与所述矩形框架的顶架连接的丝杆、与所述矩形框架的竖直架滑动连接且后 侧壁具有与所述丝杆啮合的移动块的滑动板以及与所述滑动板垂直设置的叉架。As a preferred solution of the unmanned forklift obstacle avoidance and obstacle bypassing system integrating 3D vision camera and radar described in the present invention, the fork includes a rectangular frame, a lifting drive motor installed on the bottom frame of the rectangular frame, a screw rod with one end connected to the output end of the lifting drive motor and the other end connected to the top frame of the rectangular frame, a sliding plate slidably connected to the vertical frame of the rectangular frame and with a moving block on the rear side wall engaged with the screw rod, and a fork frame arranged perpendicular to the sliding plate.
一种融合3d视觉相机与雷达的无人叉车避障与绕障方法,具体步骤如下:A method for unmanned forklift obstacle avoidance and bypassing that integrates 3D vision camera and radar, the specific steps are as follows:
S1、无人叉车的控制单元根据上位机规划的行走路线驱动移动轮向前方行走,并通过驱动驱动组件调节移动轮的行走方向,同时障碍物探测组件的雷达探测部件向前方发射雷达波探测前方一定距离范围内是否具有障碍物;S1. The control unit of the unmanned forklift drives the moving wheels to move forward according to the walking route planned by the host computer, and adjusts the walking direction of the moving wheels by driving the driving component. At the same time, the radar detection component of the obstacle detection component emits radar waves forward to detect whether there are obstacles within a certain distance ahead;
S2、当障碍物探测组件探测到前方一定距离范围内具有障碍物时,此时,控制单元控制移动轮停止移动,控制单元向驱动组件发出转向指令,驱动组件驱动移动轮和障碍物探测组件整体转向90°,障碍物探测组件的雷达探测部件继续探测转向后的前方是否具有障碍物,同时转向后两个视觉相机正对于之前探测到的障碍物,获取障碍物的深度图像,并构建前方障碍物道路场景的三维模型,并传输给控制单元;S2. When the obstacle detection component detects an obstacle within a certain distance ahead, the control unit controls the moving wheel to stop moving, and sends a steering command to the driving component. The driving component drives the moving wheel and the obstacle detection component to turn 90° as a whole. The radar detection component of the obstacle detection component continues to detect whether there is an obstacle ahead after the turn. At the same time, after the turn, the two visual cameras face the previously detected obstacle, obtain the depth image of the obstacle, and construct a three-dimensional model of the road scene of the obstacle ahead, and transmit it to the control unit;
S3、然后控制单元向移动轮发出行走指令,移动轮继续向旋转后的前方移动,同时,则控制单元根据两个视觉相机根据构建前方障碍物道路场景的三维模型实时的判断无人叉车是否绕过障碍物,当判断无人叉车绕过障碍物时,控制单元根据规划的路线继续行走前进。S3. Then the control unit sends a walking command to the moving wheel, and the moving wheel continues to move forward after the rotation. At the same time, the control unit determines in real time whether the unmanned forklift bypasses the obstacle based on the three-dimensional model of the road scene of the obstacle in front constructed by the two visual cameras. When it is determined that the unmanned forklift bypasses the obstacle, the control unit continues to move forward according to the planned route.
作为本发明所述的一种融合3d视觉相机与雷达的无人叉车避障与绕障方法的一种优选方案,其中,控制单元根据两个视觉相机根据构建前方障碍物道路场景的三维模型实时的判断无人叉车是否绕过障碍物的具体步骤如下:As a preferred solution of the obstacle avoidance and circumvention method for an unmanned forklift integrating a 3D visual camera and a radar described in the present invention, the specific steps of the control unit determining in real time whether the unmanned forklift circumvents the obstacle based on the three-dimensional model of the road scene of the obstacle ahead constructed by two visual cameras are as follows:
视觉相机获取障碍物的深度图像,并构建前方障碍物道路场景的三维模型,并传输给控制单元;The visual camera acquires the depth image of the obstacle, builds a three-dimensional model of the road scene ahead of the obstacle, and transmits it to the control unit;
控制单元根据获取的获取障碍物的深度图像判断障碍物的长度大小,并控制无人叉车向旋转后的前方移动至障碍物的长度大小的距离,同时控制单元判断视觉相机构建的正前方的障碍物道路场景是否还具有障碍物,当控制无人叉车向旋转后的前方移动的距离大于障碍物的长度大小的距离时,且视 觉相机构建的正前方的障碍物道路场景不具具有障碍物时,则判定绕过障碍物。The control unit determines the length of the obstacle based on the acquired depth image of the obstacle, and controls the unmanned forklift to move forward after rotation to a distance equal to the length of the obstacle. At the same time, the control unit determines whether there are any obstacles in the obstacle road scene directly in front of the vehicle constructed by the vision camera. When the distance controlled to move the unmanned forklift forward after rotation is greater than the length of the obstacle, and the obstacle road scene directly in front of the vehicle constructed by the vision camera does not have any obstacles, the control unit determines to bypass the obstacle.
与现有技术相比,本发明具有的有益效果是:Compared with the prior art, the present invention has the following beneficial effects:
1、本发明融合3d视觉相机与雷达,并与上位机通信,按照规划路线行走,在雷达探测部件探测到前方具有障碍物时,驱动组件驱动移动轮和障碍物探测组件整体转向90°实现避障并继续行进,并且转向后的探测组件通过雷达探测部件继续探测转向后前方的障碍物状况,同时转向后两个视觉相机正对于之前探测到的障碍物,获取障碍物的深度图像,并构建前方障碍物道路场景的三维模型,控制单元根据视觉相机取的障碍物的深度图像和构建前方障碍物道路场景的三维模型驱动移动轮行走相应的距离否绕过障碍物,相对于传统的叉车,可自动实现避障与绕障,无需人工操作,节省人力资源。1. The present invention integrates 3D visual cameras and radars, and communicates with a host computer to walk along a planned route. When the radar detection component detects an obstacle ahead, the driving component drives the moving wheels and the obstacle detection component to turn 90 degrees as a whole to avoid the obstacle and continue to move forward. The detection component after turning continues to detect the obstacle condition in front after the turning through the radar detection component. At the same time, after the turning, the two visual cameras are facing the previously detected obstacles, obtain the depth image of the obstacles, and construct a three-dimensional model of the obstacle road scene ahead. The control unit drives the moving wheels to walk a corresponding distance according to the depth image of the obstacles taken by the visual cameras and the three-dimensional model of the obstacle road scene ahead to see if they can bypass the obstacles. Compared with traditional forklifts, obstacle avoidance and bypassing can be automatically achieved without manual operation, saving human resources.
2、本发明创新的设计移动轮,整个移动轮集成度高且紧凑,节省占用空间,可自行驱动行走并受控实现转向以带动无人叉车调节行走方向,满足无人叉车的移动及转向。2. The innovative design of the moving wheel of the present invention is highly integrated and compact, which saves space. It can be driven by itself and can be controlled to turn to drive the unmanned forklift to adjust the walking direction, thereby meeting the movement and turning requirements of the unmanned forklift.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
为了更清楚地说明本发明实施方式的技术方案,下面将将结合附图和详细实施方式对本发明进行详细说明,显而易见地,下面描述中的附图仅仅是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其它的附图。其中:In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the present invention will be described in detail below in combination with the accompanying drawings and detailed embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative labor. Among them:
图1为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统的整体结构示意图;FIG1 is a schematic diagram of the overall structure of an unmanned forklift obstacle avoidance and bypassing system that integrates a 3D vision camera and a radar according to the present invention;
图2为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统拆除货叉的部分结构示意图;FIG2 is a schematic diagram of a portion of the structure of the unmanned forklift obstacle avoidance and bypassing system integrating a 3D vision camera and a radar for removing a fork according to the present invention;
图3为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统的底板、移动轮、驱动组件和障碍物探测组件的装配图;FIG3 is an assembly diagram of the bottom plate, moving wheels, driving components and obstacle detection components of the obstacle avoidance and bypassing system for unmanned forklifts integrating 3D vision cameras and radars according to the present invention;
图4为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统图3中的部分结构示意图;FIG4 is a schematic diagram of a portion of the structure of FIG3 of the unmanned forklift obstacle avoidance and bypassing system integrating a 3D vision camera and a radar according to the present invention;
图5为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统的移动轮的整体结构示意图;FIG5 is a schematic diagram of the overall structure of the mobile wheels of the obstacle avoidance and bypassing system for an unmanned forklift integrating a 3D vision camera and a radar according to the present invention;
图6为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统的移动轮拆除座体的第一方向结构示意图;6 is a schematic diagram of the first direction structure of the mobile wheel removal seat of the unmanned forklift obstacle avoidance and circumvention system integrating a 3D vision camera and a radar according to the present invention;
图7为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统的移动轮拆除座体的第二方向结构示意图;7 is a schematic diagram of the second direction structure of the mobile wheel removal seat of the unmanned forklift obstacle avoidance and circumvention system integrating 3D vision camera and radar according to the present invention;
图8为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统的移动轮拆除座体的第三方向结构示意图;FIG8 is a schematic diagram of the third direction structure of the mobile wheel removal seat of the unmanned forklift obstacle avoidance and circumvention system integrating 3D vision camera and radar according to the present invention;
图9为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统的货叉第一方向结构示意图;9 is a schematic diagram of the first direction structure of the fork of the unmanned forklift obstacle avoidance and bypassing system integrating the 3D vision camera and the radar of the present invention;
图10为本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统的货叉第二方向结构示意图。10 is a schematic diagram of the second direction structure of the fork of the unmanned forklift obstacle avoidance and bypassing system integrating 3D vision camera and radar according to the present invention.
具体实施方式Detailed ways
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明的具体实施方式做详细的说明。In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, the specific embodiments of the present invention are described in detail below with reference to the accompanying drawings.
其次,本发明结合示意图进行详细描述,在详述本发明实施方式时,为便于说明,表示器件结构的剖面图会不依一般比例作局部放大,而且所述示意图只是示例,其在此不应限制本发明保护的范围。此外,在实际制作中应包含长度、宽度及深度的三维空间尺寸。Secondly, the present invention is described in detail with reference to schematic diagrams. When describing the embodiments of the present invention in detail, for the sake of convenience, the cross-sectional diagrams showing the device structure will not be partially enlarged according to the general scale, and the schematic diagrams are only examples, which should not limit the scope of protection of the present invention. In addition, in actual production, the three-dimensional dimensions of length, width and depth should be included.
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明的实施方式作进一步地详细描述。In order to make the objectives, technical solutions and advantages of the present invention more clear, the embodiments of the present invention will be further described in detail below with reference to the accompanying drawings.
本发明提供一种融合3d视觉相机与雷达的无人叉车避障与绕障方法及系统,与上位机通讯受控,自行实现障碍物的避障和绕障,无需人工操作,节 省人力资源。The present invention provides an obstacle avoidance and circumvention method and system for an unmanned forklift integrating a 3D visual camera and a radar, which is controlled by communication with a host computer and can automatically avoid and circumvent obstacles without manual operation, thus saving human resources.
实施例1Example 1
图1-图2、图9-图10示出的是该融合3d视觉相机与雷达的无人叉车避障与绕障系统第一种实施方式的结构示意图,请参阅图1-图2,该种融合3d视觉相机与雷达的无人叉车避障与绕障系统,其包括车壳体100、移动轮200、驱动组件300、障碍物探测组件400和货叉500。1-2 and 9-10 show the structural schematic diagrams of the first embodiment of the unmanned forklift obstacle avoidance and obstacle avoidance system integrating 3D vision camera and radar. Please refer to FIG1-2. The unmanned forklift obstacle avoidance and obstacle avoidance system integrating 3D vision camera and radar includes a vehicle body 100, moving wheels 200, a driving assembly 300, an obstacle detection assembly 400 and a fork 500.
车壳体100包括底板110和与底板110连接的防护壳120,底板110用于安装移动轮200、驱动组件300和货叉500。The vehicle housing 100 includes a bottom plate 110 and a protective shell 120 connected to the bottom plate 110 . The bottom plate 110 is used to install the moving wheels 200 , the driving assembly 300 and the fork 500 .
移动轮200设置在底板110的四角,并从底部穿出,可自行驱动无人叉车移动并受控驱动实现转向。The moving wheels 200 are arranged at the four corners of the base plate 110 and extend out from the bottom, and can drive the unmanned forklift to move by itself and be controlled to achieve steering.
驱动组件300安装在所车壳体100内部,其中,该驱动组件300的一部分延伸至防护壳120的顶部用于与、障碍物探测组件400连接,另一部分与移动轮200的转向输入端连接。The driving assembly 300 is installed inside the vehicle body 100 , wherein a portion of the driving assembly 300 extends to the top of the protective shell 120 for connecting with the obstacle detection assembly 400 , and the other portion is connected to the steering input end of the moving wheel 200 .
障碍物探测组件400,位于防护壳120的正上方并与驱动组件300的延伸部分连接,在本实施方式中,该包括呈矩形状的旋转头410、安装在旋转头410一侧面的雷达探测部件420和安装在旋转头410另一侧面的两个视觉相机430,其中,两个视觉相机430的安装面与雷达探测部件420的安装面垂直,雷达探测部件420包括雷达波发射端420a和雷达波接收端420b,在使用时,雷达探测部件420向前方发射雷达探测波,如果雷达波接收端420b能接收到反射回来的雷达波信号,则说明探测前方一定距离范围内具有障碍物,此时,驱动组件300将驱动障碍物探测组件400旋转90°,转向后两个视觉相机430正对于之前探测到的障碍物,获取障碍物的深度图像,并构建前方障碍物道路场景的三维模型,并传输给控制单元。The obstacle detection component 400 is located directly above the protective shell 120 and connected to the extended portion of the driving component 300. In the present embodiment, it includes a rectangular rotating head 410, a radar detection component 420 installed on one side of the rotating head 410, and two visual cameras 430 installed on the other side of the rotating head 410, wherein the mounting surfaces of the two visual cameras 430 are perpendicular to the mounting surface of the radar detection component 420, and the radar detection component 420 includes a radar wave transmitting end 420a and a radar wave receiving end 420b. When in use, the radar detection component 420 transmits a radar detection wave forward. If the radar wave receiving end 420b can receive the reflected radar wave signal, it indicates that there is an obstacle within a certain distance range ahead of the detection. At this time, the driving component 300 drives the obstacle detection component 400 to rotate 90°. After turning, the two visual cameras 430 are facing the previously detected obstacle, obtain the depth image of the obstacle, and construct a three-dimensional model of the road scene of the obstacle ahead, and transmit it to the control unit.
货叉500安装在车壳体100的前方位置,对货物进行叉取,在本实施方式中,货叉500包括矩形框架510、安装在矩形框架510的底架510a上的升 降驱动电机520、一端部与升降驱动电机520的输出端连接,另一端与矩形框架510的顶架510c连接的丝杆530、与矩形框架510的竖直架510b滑动连接且后侧壁具有与丝杆530啮合的移动块540a的滑动板540以及与滑动板540垂直设置的叉架550,在使用时,升降驱动电机520驱动丝杆530旋转,在丝杆530旋转时,通过移动块540a带动滑动板540上下移动,进而带动叉架550上下移动升降,对货物叉取和投放。The cargo fork 500 is installed at the front position of the vehicle body 100 to fork the cargo. In the present embodiment, the cargo fork 500 includes a rectangular frame 510, a lifting drive motor 520 installed on the bottom frame 510a of the rectangular frame 510, a screw rod 530 having one end connected to the output end of the lifting drive motor 520 and the other end connected to the top frame 510c of the rectangular frame 510, a sliding plate 540 slidably connected to the vertical frame 510b of the rectangular frame 510 and having a moving block 540a meshing with the screw rod 530 on the rear side wall, and a fork frame 550 vertically arranged to the sliding plate 540. When in use, the lifting drive motor 520 drives the screw rod 530 to rotate. When the screw rod 530 rotates, the sliding plate 540 is driven to move up and down through the moving block 540a, thereby driving the fork frame 550 to move up and down to fork and deliver the cargo.
该种融合3d视觉相机与雷达的无人叉车避障与绕障系统,在正常状态下,移动轮200根据控制单元指令自行驱动车壳体100向前方移动,同时障碍物探测组件400探测移动前方是否具有障碍物,当障碍物探测组件400发现正前方一定距离具有障碍物时,驱动组件300驱动移动轮200和障碍物探测组件400整体转向90°,然后继续向旋转后的前方移动,同时障碍物探测组件400检测是否越过上述障碍物,若越过,则控制单元根据上位机的指令重新规划路线,控制移动轮200或者驱动组件300动作。In this unmanned forklift obstacle avoidance and circumvention system that integrates 3D vision cameras and radars, under normal conditions, the moving wheel 200 drives the vehicle body 100 to move forward by itself according to the instructions of the control unit, and at the same time, the obstacle detection component 400 detects whether there is an obstacle in front of the movement. When the obstacle detection component 400 finds that there is an obstacle at a certain distance in front, the driving component 300 drives the moving wheel 200 and the obstacle detection component 400 to turn 90° as a whole, and then continue to move forward after the rotation. At the same time, the obstacle detection component 400 detects whether the above-mentioned obstacle is crossed. If it is crossed, the control unit re-plans the route according to the instructions of the upper computer and controls the moving wheel 200 or the driving component 300 to move.
实施例2Example 2
图3-图8示出的是本发明融合3d视觉相机与雷达的无人叉车避障与绕障系统的第二种实施方式的部分结构示意图,请参阅图3-图8,与上述实施方式不同给的是,本实施方式中:FIG3 to FIG8 are partial structural schematic diagrams of a second embodiment of the unmanned forklift obstacle avoidance and bypassing system integrating a 3D visual camera and a radar according to the present invention. Please refer to FIG3 to FIG8. Different from the above embodiment, in this embodiment:
驱动组件300包括主齿轮盘310、环绕包围主齿轮盘310的四个从动齿轮320、与从动齿轮320同轴设置的从动传动轴杆330、与从动齿轮320啮合的传动带340、与主齿轮盘310同轴设置的主动传动轴杆350以及安装在底板110上且输出端与主动传动轴杆350连接的转向驱动电机360,其中,其中两个相互对称的从动齿轮320与主齿轮盘310啮合,从动传动轴杆330的一端与移动轮200的转向输入端连接,另一端与防护壳120的内壁顶部转动连接,在转向驱动电机360驱动主动传动轴杆350时,主动传动轴杆350带动障碍物探测组件400旋转,同时,主齿轮盘310跟随主动传动轴杆350一同旋转, 带动与其啮合的两个从动齿轮320旋转,并且在传动带340的传动作用下,四个从动齿轮320一同同步旋转带动与其同轴连接的从动传动轴杆330旋转,进而对移动轮200转向驱动。The driving assembly 300 includes a main gear plate 310, four driven gears 320 surrounding the main gear plate 310, a driven transmission shaft 330 coaxially arranged with the driven gears 320, a transmission belt 340 meshing with the driven gears 320, an active transmission shaft 350 coaxially arranged with the main gear plate 310, and a steering drive motor 360 installed on the base plate 110 and having an output end connected to the active transmission shaft 350, wherein two mutually symmetrical driven gears 320 are meshed with the main gear plate 310, one end of the driven transmission shaft 330 is connected to the steering input end of the moving wheel 200, and the other end is rotatably connected to the top of the inner wall of the protective shell 120, when the steering drive motor 360 drives the active transmission shaft 350, the active transmission shaft 350 drives the obstacle detection assembly 400 to rotate, and at the same time, the main gear plate 310 rotates along with the active transmission shaft 350. The two driven gears 320 meshing therewith are driven to rotate, and under the transmission action of the transmission belt 340 , the four driven gears 320 rotate synchronously together to drive the driven transmission shaft 330 coaxially connected therewith to rotate, thereby driving the moving wheel 200 to turn.
移动轮200包括座体210、安装在座体210上的行走组件220和安装在座体210驱动行走组件220转向的转向传动组件230,转向传动组件230的输入端与从动传动轴杆330连接。The moving wheel 200 includes a base 210 , a traveling assembly 220 mounted on the base 210 , and a steering transmission assembly 230 mounted on the base 210 for driving the traveling assembly 220 to turn. The input end of the steering transmission assembly 230 is connected to the driven transmission shaft 330 .
座体210包括底座210a通过轴销与底座210a连接且位于底座210a上方的第一支撑座210b以及第二支撑座210c;The seat body 210 includes a first support seat 210b and a second support seat 210c connected to the base 210a by an axle pin and located above the base 210a;
行走组件220包括通过轴承与底座210a的轴孔旋转连接且底部对称设置有支撑耳220a-2的旋转盘220a、设置在两个支撑耳220a-2之间的支撑轴杆220b、与支撑轴杆220b同轴连接且侧壁具有第一锥齿轮220c-1的行走轮220c、与行走轮220c啮合的第二锥齿轮220d、位于旋转盘220a的上方且通过轴杆与第二锥齿轮220d同轴连接的行走传动直齿轮220e以及安装在第一支撑座210b上且输出端的行走驱动齿轮220f-1与行走传动直齿轮220e啮合的行走驱动电机220f,在正常行走时,行走驱动电机220f通过行走驱动齿轮220f-1驱动行走传动直齿轮220e旋转,第二锥齿轮220d跟随行走传动直齿轮220e一同旋转,第二锥齿通过与第一锥齿轮220c-1啮合带动行走轮220c移动。The walking assembly 220 includes a rotating disk 220a which is rotatably connected to the shaft hole of the base 210a through a bearing and has support ears 220a-2 symmetrically arranged at the bottom, a support shaft 220b arranged between the two support ears 220a-2, a walking wheel 220c which is coaxially connected to the support shaft 220b and has a first bevel gear 220c-1 on the side wall, a second bevel gear 220d meshing with the walking wheel 220c, and a walking wheel 220c which is located above the rotating disk 220a and is coaxially connected to the second bevel gear 220d through the shaft. The transmission spur gear 220e and the walking drive motor 220f are installed on the first support seat 210b and the walking drive gear 220f-1 at the output end is meshed with the walking transmission spur gear 220e. During normal walking, the walking drive motor 220f drives the walking transmission spur gear 220e to rotate through the walking drive gear 220f-1, and the second bevel gear 220d rotates together with the walking transmission spur gear 220e. The second bevel gear drives the walking wheel 220c to move by meshing with the first bevel gear 220c-1.
转向传动组件230包括安装在第二支撑座210c上的减速电机230a、安装在第二支撑座210c上的第一转向传动轴杆230b以及第二转向传动轴杆230,减速电机230a的输出端具有减速传动齿轮230a-1,第一转向传动轴杆230b上具有与减速传动齿轮230a-1啮合的第一转向传动齿轮230b-1以及第二转向传动齿轮230b-2,第二转向传动轴杆230上具有与第二转向传动齿轮230b-2啮合的第三转向传动齿轮230c-1以及第四转向传动齿轮230c-2,第四转向传动齿轮230c-2通过转向传动齿轮带230d与旋转盘220a的齿槽 220a-1啮合,在使用时,减速电机230a的输入端受到从动传动轴杆330转向驱动力,通过减速传动齿轮230a-1和第一转向传动齿轮230b-1带动第一转向传动轴杆230b转动,在第一转向传动轴杆230b转动时,通过第二转向传动齿轮230b-2和第三转向传动齿轮230c-1带动第二转向传动轴杆230转动,第二转向传动轴杆230通过四转向传动齿轮230c-2和转向传动齿轮带230d带动旋转盘220a转动,进而实现行走组件220转向。The steering transmission assembly 230 includes a reduction motor 230a installed on the second support seat 210c, a first steering transmission shaft 230b installed on the second support seat 210c, and a second steering transmission shaft 230, the output end of the reduction motor 230a has a reduction transmission gear 230a-1, the first steering transmission shaft 230b has a first steering transmission gear 230b-1 and a second steering transmission gear 230b-2 meshed with the reduction transmission gear 230a-1, the second steering transmission shaft 230 has a third steering transmission gear 230c-1 and a fourth steering transmission gear 230c-2 meshed with the second steering transmission gear 230b-2, the fourth steering transmission gear 230c-2 is connected to the tooth groove of the rotating disk 220a through the steering transmission gear belt 230d 220a-1 is engaged. When in use, the input end of the reduction motor 230a is subjected to the steering driving force of the driven transmission shaft 330, and the first steering transmission shaft 230b is driven to rotate through the reduction transmission gear 230a-1 and the first steering transmission gear 230b-1. When the first steering transmission shaft 230b rotates, the second steering transmission shaft 230 is driven to rotate through the second steering transmission gear 230b-2 and the third steering transmission gear 230c-1. The second steering transmission shaft 230 drives the rotating disk 220a to rotate through the fourth steering transmission gear 230c-2 and the steering transmission gear belt 230d, thereby realizing the steering of the walking component 220.
实施例3Example 3
融合3d视觉相机与雷达的无人叉车避障与绕障系统的方法,具体步骤如下:The method of the obstacle avoidance and bypassing system of an unmanned forklift integrating 3D vision camera and radar is as follows:
S1、无人叉车的控制单元根据上位机规划的行走路线驱动移动轮200向前方行走,并通过驱动驱动组件300调节移动轮200的行走方向,同时障碍物探测组件400的雷达探测部件420向前方发射雷达波探测前方一定距离范围内是否具有障碍物;S1. The control unit of the unmanned forklift drives the moving wheel 200 to move forward according to the walking route planned by the upper computer, and adjusts the walking direction of the moving wheel 200 by driving the driving component 300. At the same time, the radar detection component 420 of the obstacle detection component 400 emits radar waves forward to detect whether there are obstacles within a certain distance ahead;
S2、当障碍物探测组件400探测到前方一定距离范围内具有障碍物时,此时,控制单元控制移动轮200停止移动,控制单元向驱动组件300发出转向指令,驱动组件300驱动移动轮200和障碍物探测组件400整体转向90°,障碍物探测组件400的雷达探测部件420继续探测转向后的前方是否具有障碍物,同时转向后两个视觉相机430正对于之前探测到的障碍物,获取障碍物的深度图像,并构建前方障碍物道路场景的三维模型,并传输给控制单元;S2. When the obstacle detection component 400 detects an obstacle within a certain distance ahead, the control unit controls the moving wheel 200 to stop moving, and sends a steering command to the driving component 300. The driving component 300 drives the moving wheel 200 and the obstacle detection component 400 to turn 90° as a whole. The radar detection component 420 of the obstacle detection component 400 continues to detect whether there is an obstacle ahead after the turn. At the same time, after the turn, the two visual cameras 430 are facing the previously detected obstacles to obtain the depth image of the obstacles, and construct a three-dimensional model of the road scene of the obstacles ahead, and transmit it to the control unit;
S3、然后控制单元向移动轮200发出行走指令,移动轮200继续向旋转后的前方移动,同时,则控制单元根据两个视觉相机430根据构建前方障碍物道路场景的三维模型实时的判断无人叉车是否绕过障碍物,当判断无人叉车绕过障碍物时,控制单元根据规划的路线继续行走前进,其中,制单元根据两个视觉相机430根据构建前方障碍物道路场景的三维模型实时的判断无人叉车是否绕过障碍物的具体步骤如下:视觉相机430获取障碍物的深度图 像,并构建前方障碍物道路场景的三维模型,并传输给控制单元;控制单元根据获取的获取障碍物的深度图像判断障碍物的长度大小,并控制无人叉车向旋转后的前方移动至障碍物的长度大小的距离,同时控制单元判断视觉相机430构建的正前方的障碍物道路场景是否还具有障碍物,当控制无人叉车向旋转后的前方移动的距离大于障碍物的长度大小的距离时,且视觉相机430构建的正前方的障碍物道路场景不具具有障碍物时,则判定绕过障碍物。S3, then the control unit sends a walking command to the moving wheel 200, and the moving wheel 200 continues to move forward after the rotation. At the same time, the control unit determines in real time whether the unmanned forklift bypasses the obstacle according to the three-dimensional model of the obstacle road scene in front constructed by the two visual cameras 430. When it is determined that the unmanned forklift bypasses the obstacle, the control unit continues to walk forward according to the planned route. The specific steps of the control unit determining in real time whether the unmanned forklift bypasses the obstacle according to the three-dimensional model of the obstacle road scene in front constructed by the two visual cameras 430 are as follows: the visual camera 430 obtains the depth image of the obstacle, and constructs the three-dimensional model of the obstacle road scene in front, and transmits it to the control unit; the control unit determines the length of the obstacle according to the acquired depth image of the obstacle, and controls the unmanned forklift to move forward to the distance of the length of the obstacle after the rotation. At the same time, the control unit determines whether there is still an obstacle in the obstacle road scene in front constructed by the visual camera 430. When the distance controlled to move the unmanned forklift to the front after the rotation is greater than the distance of the length of the obstacle, and the obstacle road scene in front constructed by the visual camera 430 does not have an obstacle, it is determined to bypass the obstacle.
虽然在上文中已经参考实施方式对本发明进行了描述,然而在不脱离本发明的范围的情况下,可以对其进行各种改进并且可以用等效物替换其中的部件。尤其是,只要不存在结构冲突,本发明所披露的实施方式中的各项特征均可通过任意方式相互结合起来使用,在本说明书中未对这些组合的情况进行穷举性的描述仅仅是出于省略篇幅和节约资源的考虑。因此,本发明并不局限于文中公开的特定实施方式,而是包括落入权利要求的范围内的所有技术方案。Although the present invention has been described above with reference to the embodiments, various modifications may be made thereto and parts thereof may be replaced by equivalents without departing from the scope of the present invention. In particular, as long as there is no structural conflict, the various features in the embodiments disclosed in the present invention may be used in combination with each other in any manner, and the fact that these combinations are not exhaustively described in this specification is only for the sake of omitting space and saving resources. Therefore, the present invention is not limited to the specific embodiments disclosed herein, but includes all technical solutions falling within the scope of the claims.

Claims (9)

  1. 一种融合3d视觉相机与雷达的无人叉车避障与绕障系统,其特征在于,包括:An unmanned forklift obstacle avoidance and bypassing system integrating 3D vision camera and radar, characterized by comprising:
    车壳体(100),包括底板(110)和与所述底板(110)连接的防护壳(120);A vehicle housing (100) comprises a bottom plate (110) and a protective shell (120) connected to the bottom plate (110);
    移动轮(200),设置在所述底板(110)的四角,并从底部穿出;Moving wheels (200) are arranged at the four corners of the bottom plate (110) and extend out from the bottom;
    驱动组件(300),安装在所车壳体(100)内部,其中,该驱动组件(300)的一部分延伸至防护壳(120)的顶部,另一部分与所述移动轮(200)的转向输入端连接;A drive assembly (300) is installed inside the vehicle housing (100), wherein a portion of the drive assembly (300) extends to the top of the protective shell (120), and another portion is connected to the steering input end of the moving wheel (200);
    障碍物探测组件(400),位于所述防护壳(120)的正上方并与驱动组件(300)的延伸部分连接;An obstacle detection assembly (400) is located directly above the protective shell (120) and is connected to an extended portion of the driving assembly (300);
    货叉(500),安装在所述车壳体(100)的前方位置,对货物进行叉取;A cargo fork (500) is installed in front of the vehicle body (100) to fork and pick up cargo;
    其中,在正常状态下,移动轮(200)根据控制单元指令自行驱动车壳体(100)向前方移动,同时障碍物探测组件(400)探测移动前方是否具有障碍物;Wherein, in a normal state, the moving wheel (200) automatically drives the vehicle body (100) to move forward according to the instruction of the control unit, and at the same time, the obstacle detection component (400) detects whether there is an obstacle in front of the movement;
    当障碍物探测组件(400)发现正前方一定距离具有障碍物时,驱动组件(300)驱动移动轮(200)和障碍物探测组件(400)整体转向90°,然后继续向旋转后的前方移动,同时障碍物探测组件(400)检测是否越过上述障碍物,若越过,则控制单元根据上位机的指令重新规划路线,控制移动轮(200)或者驱动组件(300)动作。When the obstacle detection component (400) finds that there is an obstacle at a certain distance directly in front, the driving component (300) drives the moving wheel (200) and the obstacle detection component (400) to turn 90 degrees as a whole, and then continue to move forward after the rotation. At the same time, the obstacle detection component (400) detects whether the obstacle has been crossed. If the obstacle has been crossed, the control unit replans the route according to the instructions of the host computer and controls the moving wheel (200) or the driving component (300) to move.
  2. 根据权利要求1所述的融合3d视觉相机与雷达的无人叉车避障与绕障系统,其特征在于,所述驱动组件(300)包括主齿轮盘(310)、环绕包围所述主齿轮盘(310)的四个从动齿轮(320)、与所述从动齿轮(320)同轴设置的从动传动轴杆(330)、与所述从动齿轮(320)啮合的传动带(340)、与所述主齿轮盘(310)同轴设置的主动传动轴杆(350)以及安装在所述底板(110)上且输出端与所述主动传动轴杆(350)连接的转向驱动电机(360);The unmanned forklift obstacle avoidance and circumvention system integrating 3D vision camera and radar according to claim 1 is characterized in that the driving assembly (300) includes a main gear plate (310), four driven gears (320) surrounding the main gear plate (310), a driven transmission shaft (330) coaxially arranged with the driven gear (320), a transmission belt (340) meshing with the driven gear (320), an active transmission shaft (350) coaxially arranged with the main gear plate (310), and a steering drive motor (360) installed on the base plate (110) and having an output end connected to the active transmission shaft (350);
    其中,其中两个相互对称的从动齿轮(320)与所述主齿轮盘(310)啮 合,所述从动传动轴杆(330)的一端与所述移动轮(200)的转向输入端连接,另一端与所述防护壳(120)的内壁顶部转动连接。Among them, two mutually symmetrical driven gears (320) are meshed with the main gear plate (310), one end of the driven transmission shaft (330) is connected to the steering input end of the moving wheel (200), and the other end is rotatably connected to the top of the inner wall of the protective shell (120).
  3. 根据权利要求2所述的融合3d视觉相机与雷达的无人叉车避障与绕障系统,其特征在于,所述障碍物探测组件(400)包括与所述主动传动轴杆(350)连接且呈矩形状的旋转头(410)、安装在所述旋转头(410)一侧面的雷达探测部件(420)和安装在所述旋转头(410)另一侧面的两个视觉相机(430);The unmanned forklift obstacle avoidance and circumvention system integrating 3D visual camera and radar according to claim 2 is characterized in that the obstacle detection component (400) comprises a rotating head (410) connected to the active transmission shaft (350) and in a rectangular shape, a radar detection component (420) installed on one side of the rotating head (410), and two visual cameras (430) installed on the other side of the rotating head (410);
    其中,两个视觉相机(430)的安装面与所述雷达探测部件(420)的安装面垂直。The mounting surfaces of the two visual cameras (430) are perpendicular to the mounting surface of the radar detection component (420).
  4. 根据权利要求3所述的融合3d视觉相机与雷达的无人叉车避障与绕障系统,其特征在于,所述雷达探测部件(420)包括雷达波发射端(420a)和雷达波接收端(420b)。According to the unmanned forklift obstacle avoidance and circumvention system integrating a 3D vision camera and a radar as described in claim 3, it is characterized in that the radar detection component (420) includes a radar wave transmitting end (420a) and a radar wave receiving end (420b).
  5. 根据权利要求2所述的融合3d视觉相机与雷达的无人叉车避障与绕障系统,其特征在于,所述移动轮(200)包括座体(210)、安装在所述座体(210)上的行走组件(220)和安装在所述座体(210)驱动所述行走组件(220)转向的转向传动组件(230),所述转向传动组件(230)的输入端与所述从动传动轴杆(330)连接。According to the unmanned forklift obstacle avoidance and circumvention system integrating 3D vision camera and radar as described in claim 2, it is characterized in that the moving wheel (200) includes a seat body (210), a walking component (220) installed on the seat body (210), and a steering transmission component (230) installed on the seat body (210) to drive the walking component (220) to turn, and the input end of the steering transmission component (230) is connected to the driven transmission shaft (330).
  6. 根据权利要求5所述的融合3d视觉相机与雷达的无人叉车避障与绕障系统,其特征在于,所述座体(210)包括底座(210a)通过轴销与所述底座(210a)连接且位于所述底座(210a)上方的第一支撑座(210b)以及第二支撑座(210c);The unmanned forklift obstacle avoidance and circumvention system integrating 3D vision camera and radar according to claim 5 is characterized in that the seat body (210) includes a base (210a) connected to the base (210a) by an axle pin and a first support seat (210b) and a second support seat (210c) located above the base (210a);
    所述行走组件(220)包括通过轴承与所述底座(210a)的轴孔旋转连接且底部对称设置有支撑耳(220a-2)的旋转盘(220a)、设置在两个所述支撑耳(220a-2)之间的支撑轴杆(220b)、与所述支撑轴杆(220b)同轴连接且侧壁具有第一锥齿轮(220c-1)的行走轮(220c)、与所述行走轮(220c) 啮合的第二锥齿轮(220d)、位于所述旋转盘(220a)的上方且通过轴杆与所述第二锥齿轮(220d)同轴连接的行走传动直齿轮(220e)以及安装在所述第一支撑座(210b)上且输出端的行走驱动齿轮(220f-1)与所述行走传动直齿轮(220e)啮合的行走驱动电机(220f);The walking assembly (220) comprises a rotating disk (220a) rotatably connected to the shaft hole of the base (210a) through a bearing and having support ears (220a-2) symmetrically arranged at the bottom, a support shaft (220b) arranged between the two support ears (220a-2), a walking wheel (220c) coaxially connected to the support shaft (220b) and having a first bevel gear (220c-1) on the side wall, a second bevel gear (220d) meshing with the walking wheel (220c), a walking transmission spur gear (220e) located above the rotating disk (220a) and coaxially connected to the second bevel gear (220d) through the shaft, and a walking drive motor (220f) installed on the first support seat (210b) and having a walking drive gear (220f-1) at the output end meshing with the walking transmission spur gear (220e);
    所述转向传动组件(230)包括安装在所述第二支撑座(210c)上的减速电机(230a)、安装在所述第二支撑座(210c)上的第一转向传动轴杆(230b)以及第二转向传动轴杆(230);The steering transmission assembly (230) comprises a reduction motor (230a) mounted on the second support seat (210c), a first steering transmission shaft (230b) mounted on the second support seat (210c), and a second steering transmission shaft (230);
    所述减速电机(230a)的输出端具有减速传动齿轮(230a-1),所述第一转向传动轴杆(230b)上具有与所述减速传动齿轮(230a-1)啮合的第一转向传动齿轮(230b-1)以及第二转向传动齿轮(230b-2);The output end of the reduction motor (230a) is provided with a reduction transmission gear (230a-1), and the first steering transmission shaft (230b) is provided with a first steering transmission gear (230b-1) and a second steering transmission gear (230b-2) meshed with the reduction transmission gear (230a-1);
    所述第二转向传动轴杆(230)上具有与所述第二转向传动齿轮(230b-2)啮合的第三转向传动齿轮(230c-1)以及第四转向传动齿轮(230c-2),所述第四转向传动齿轮(230c-2)通过转向传动齿轮带(230d)与所述旋转盘(220a)的齿槽(220a-1)啮合。The second steering transmission shaft (230) has a third steering transmission gear (230c-1) and a fourth steering transmission gear (230c-2) meshed with the second steering transmission gear (230b-2), and the fourth steering transmission gear (230c-2) meshes with the tooth groove (220a-1) of the rotating disk (220a) through a steering transmission gear belt (230d).
  7. 根据权利要求1所述的融合3d视觉相机与雷达的无人叉车避障与绕障系统,其特征在于,所述货叉(500)包括矩形框架(510)、安装在所述矩形框架(510)的底架(510a)上的升降驱动电机(520)、一端部与所述升降驱动电机(520)的输出端连接,另一端与所述矩形框架(510)的顶架(510c)连接的丝杆(530)、与所述矩形框架(510)的竖直架(510b)滑动连接且后侧壁具有与所述丝杆(530)啮合的移动块(540a)的滑动板(540)以及与所述滑动板(540)垂直设置的叉架(550)。The unmanned forklift obstacle avoidance and obstacle bypassing system integrating 3D vision camera and radar according to claim 1 is characterized in that the fork (500) includes a rectangular frame (510), a lifting drive motor (520) installed on the bottom frame (510a) of the rectangular frame (510), a screw rod (530) having one end connected to the output end of the lifting drive motor (520) and the other end connected to the top frame (510c) of the rectangular frame (510), a sliding plate (540) which is slidably connected to the vertical frame (510b) of the rectangular frame (510) and has a moving block (540a) on the rear side wall that engages with the screw rod (530), and a fork frame (550) arranged vertically to the sliding plate (540).
  8. 一种如权利要求1-7任一项所述的融合3d视觉相机与雷达的无人叉车避障与绕障系统的方法,其特征在于,具体步骤如下:A method for an unmanned forklift obstacle avoidance and bypassing system integrating a 3D vision camera and a radar as claimed in any one of claims 1 to 7, characterized in that the specific steps are as follows:
    S1、无人叉车的控制单元根据上位机规划的行走路线驱动移动轮(200)向前方行走,并通过驱动驱动组件(300)调节移动轮(200)的行走方向, 同时障碍物探测组件(400)的雷达探测部件(420)向前方发射雷达波探测前方一定距离范围内是否具有障碍物;S1. The control unit of the unmanned forklift drives the moving wheel (200) to move forward according to the moving route planned by the upper computer, and adjusts the moving direction of the moving wheel (200) by driving the driving component (300). At the same time, the radar detection component (420) of the obstacle detection component (400) emits radar waves forward to detect whether there is an obstacle within a certain distance ahead;
    S2、当障碍物探测组件(400)探测到前方一定距离范围内具有障碍物时,此时,控制单元控制移动轮(200)停止移动,控制单元向驱动组件(300)发出转向指令,驱动组件(300)驱动移动轮(200)和障碍物探测组件(400)整体转向90°,障碍物探测组件(400)的雷达探测部件(420)继续探测转向后的前方是否具有障碍物,同时转向后两个视觉相机(430)正对于之前探测到的障碍物,获取障碍物的深度图像,并构建前方障碍物道路场景的三维模型,并传输给控制单元;S2. When the obstacle detection component (400) detects an obstacle within a certain distance ahead, the control unit controls the moving wheel (200) to stop moving, and the control unit sends a steering command to the driving component (300). The driving component (300) drives the moving wheel (200) and the obstacle detection component (400) to turn 90 degrees as a whole. The radar detection component (420) of the obstacle detection component (400) continues to detect whether there is an obstacle ahead after the turn. At the same time, after the turn, the two visual cameras (430) face the previously detected obstacle to obtain a depth image of the obstacle, and construct a three-dimensional model of the road scene of the obstacle ahead, and transmit it to the control unit;
    S3、然后控制单元向移动轮(200)发出行走指令,移动轮(200)继续向旋转后的前方移动,同时,则控制单元根据两个视觉相机(430)根据构建前方障碍物道路场景的三维模型实时的判断无人叉车是否绕过障碍物,当判断无人叉车绕过障碍物时,控制单元根据规划的路线继续行走前进。S3, the control unit then sends a walking instruction to the moving wheel (200), and the moving wheel (200) continues to move forward after the rotation. At the same time, the control unit determines in real time whether the unmanned forklift has bypassed the obstacle based on the three-dimensional model of the road scene of the obstacle ahead constructed by the two visual cameras (430). When it is determined that the unmanned forklift has bypassed the obstacle, the control unit continues to move forward according to the planned route.
  9. 根据权利要求8所述的融合3d视觉相机与雷达的无人叉车避障与绕障方法,其特征在于,控制单元根据两个视觉相机(430)根据构建前方障碍物道路场景的三维模型实时的判断无人叉车是否绕过障碍物的具体步骤如下:The obstacle avoidance and circumvention method for unmanned forklifts integrating 3D vision cameras and radars according to claim 8 is characterized in that the control unit determines in real time whether the unmanned forklift has circumvented the obstacle based on the three-dimensional model of the road scene of the obstacle ahead constructed by the two vision cameras (430). The specific steps are as follows:
    视觉相机(430)获取障碍物的深度图像,并构建前方障碍物道路场景的三维模型,并传输给控制单元;The visual camera (430) acquires a depth image of the obstacle, constructs a three-dimensional model of the road scene of the obstacle ahead, and transmits it to the control unit;
    控制单元根据获取的获取障碍物的深度图像判断障碍物的长度大小,并控制无人叉车向旋转后的前方移动至障碍物的长度大小的距离,同时控制单元判断视觉相机(430)构建的正前方的障碍物道路场景是否还具有障碍物,当控制无人叉车向旋转后的前方移动的距离大于障碍物的长度大小的距离时,且视觉相机(430)构建的正前方的障碍物道路场景不具具有障碍物时,则判定绕过障碍物。The control unit determines the length of the obstacle based on the acquired depth image of the obstacle, and controls the unmanned forklift to move forward after the rotation to a distance equal to the length of the obstacle. At the same time, the control unit determines whether the obstacle road scene directly in front of the visual camera (430) still has an obstacle. When the distance controlled by the unmanned forklift to move forward after the rotation is greater than the distance equal to the length of the obstacle, and the obstacle road scene directly in front of the visual camera (430) does not have an obstacle, it is determined to bypass the obstacle.
PCT/CN2022/133814 2022-11-23 2022-11-23 Driverless forklift obstacle avoidance and obstacle bypassing method and system integrating 3d visual camera and radar WO2024108439A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2022/133814 WO2024108439A1 (en) 2022-11-23 2022-11-23 Driverless forklift obstacle avoidance and obstacle bypassing method and system integrating 3d visual camera and radar

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2022/133814 WO2024108439A1 (en) 2022-11-23 2022-11-23 Driverless forklift obstacle avoidance and obstacle bypassing method and system integrating 3d visual camera and radar

Publications (1)

Publication Number Publication Date
WO2024108439A1 true WO2024108439A1 (en) 2024-05-30

Family

ID=91194976

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/133814 WO2024108439A1 (en) 2022-11-23 2022-11-23 Driverless forklift obstacle avoidance and obstacle bypassing method and system integrating 3d visual camera and radar

Country Status (1)

Country Link
WO (1) WO2024108439A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118419828A (en) * 2024-07-03 2024-08-02 中国建筑一局(集团)有限公司 A high altitude suspension platform that walks that is used for steel construction roofing inner panel to install

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104777835A (en) * 2015-03-11 2015-07-15 武汉汉迪机器人科技有限公司 Omni-directional automatic forklift and 3D stereoscopic vision navigating and positioning method
CN109160452A (en) * 2018-10-23 2019-01-08 西安中科光电精密工程有限公司 Unmanned transhipment fork truck and air navigation aid based on laser positioning and stereoscopic vision
JP2019099141A (en) * 2017-12-05 2019-06-24 株式会社豊田自動織機 Unmanned forklift travel control device, unmanned forklift travel control method, unmanned traction vehicle travel control device, and unmanned traction vehicle travel control method
CN209024157U (en) * 2018-10-23 2019-06-25 西安中科光电精密工程有限公司 A kind of unmanned transhipment fork truck mixing guidance with vision based on laser
CN209024143U (en) * 2018-10-23 2019-06-25 西安中科光电精密工程有限公司 A kind of unmanned transhipment fork truck based on laser positioning and stereoscopic vision
CN113233377A (en) * 2021-03-29 2021-08-10 上海快仓自动化科技有限公司 Motion control method of omnidirectional automatic forklift and omnidirectional automatic forklift
CN217756753U (en) * 2022-06-12 2022-11-08 苏州深酷机器人有限公司 Keep away barrier structure and unmanned fork truck

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104777835A (en) * 2015-03-11 2015-07-15 武汉汉迪机器人科技有限公司 Omni-directional automatic forklift and 3D stereoscopic vision navigating and positioning method
JP2019099141A (en) * 2017-12-05 2019-06-24 株式会社豊田自動織機 Unmanned forklift travel control device, unmanned forklift travel control method, unmanned traction vehicle travel control device, and unmanned traction vehicle travel control method
CN109160452A (en) * 2018-10-23 2019-01-08 西安中科光电精密工程有限公司 Unmanned transhipment fork truck and air navigation aid based on laser positioning and stereoscopic vision
CN209024157U (en) * 2018-10-23 2019-06-25 西安中科光电精密工程有限公司 A kind of unmanned transhipment fork truck mixing guidance with vision based on laser
CN209024143U (en) * 2018-10-23 2019-06-25 西安中科光电精密工程有限公司 A kind of unmanned transhipment fork truck based on laser positioning and stereoscopic vision
CN113233377A (en) * 2021-03-29 2021-08-10 上海快仓自动化科技有限公司 Motion control method of omnidirectional automatic forklift and omnidirectional automatic forklift
CN217756753U (en) * 2022-06-12 2022-11-08 苏州深酷机器人有限公司 Keep away barrier structure and unmanned fork truck

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118419828A (en) * 2024-07-03 2024-08-02 中国建筑一局(集团)有限公司 A high altitude suspension platform that walks that is used for steel construction roofing inner panel to install

Similar Documents

Publication Publication Date Title
US20190337564A1 (en) Moving vehicle
WO2024108439A1 (en) Driverless forklift obstacle avoidance and obstacle bypassing method and system integrating 3d visual camera and radar
US4993912A (en) Stair climbing robot
CN110667722B (en) Wheel-foot switching robot based on electro-hydraulic hybrid drive and control system
CN111924752B (en) Fork truck formula automated guided transporting vehicle
US20170094144A1 (en) Mobile vehicle
JP2008536779A (en) Equipment for lifting, handling and transporting containers
US7905311B2 (en) Fork lift truck with a single front wheel
US20170090033A1 (en) Mobile vehicle
FR2958579A1 (en) AXLE SYSTEM, AXLE MODULE COMPRISING AT LEAST ONE SUCH AXLE SYSTEM AND VEHICLE COMPRISING AT LEAST ONE SUCH MODULE
WO2023103674A1 (en) Agv forklift
US20220144355A1 (en) Self-powered single axle dolly vehicle unit with auto-coupling ability
EP4271585A1 (en) A vehicle and a method of controlling the propulsion of a vehicle
JP6909051B2 (en) Mobile vehicle
JP2018198485A (en) Traveling apparatus, traveling control method, traveling control program, and traveling system
CN211198487U (en) Omnidirectional movement forklift
CN113365873B (en) Tractor unit for transporting elongated loads
CN107444902A (en) A kind of automatic guided vehicle with automatic crawl function
CN102883989B (en) Forklift
US3528524A (en) Hydraulic filming or television camera crane
JP2017061291A (en) Mobile vehicle
CN206985135U (en) A kind of automatic guided vehicle with automatic crawl function
US8978810B2 (en) Tractor
CN115390563A (en) Unmanned forklift obstacle avoidance and obstacle avoidance method and system integrating 3d vision camera and radar
CN212893752U (en) Large-tonnage forklift steering device with steering early warning structure

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22966134

Country of ref document: EP

Kind code of ref document: A1