CN112947475A - Laser navigation forklift type AGV vehicle-mounted system and method - Google Patents
Laser navigation forklift type AGV vehicle-mounted system and method Download PDFInfo
- Publication number
- CN112947475A CN112947475A CN202110301652.9A CN202110301652A CN112947475A CN 112947475 A CN112947475 A CN 112947475A CN 202110301652 A CN202110301652 A CN 202110301652A CN 112947475 A CN112947475 A CN 112947475A
- Authority
- CN
- China
- Prior art keywords
- module
- agv
- point
- laser
- vehicle
- 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 28
- 230000033001 locomotion Effects 0.000 claims abstract description 19
- 238000004891 communication Methods 0.000 claims abstract description 13
- 238000007726 management method Methods 0.000 claims abstract description 7
- 230000000007 visual effect Effects 0.000 claims abstract description 4
- 238000010276 construction Methods 0.000 claims abstract 2
- 230000009191 jumping Effects 0.000 claims description 18
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000000295 complement effect Effects 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- 230000011218 segmentation Effects 0.000 claims description 3
- 230000004888 barrier function Effects 0.000 description 10
- 238000001514 detection method Methods 0.000 description 6
- 238000013507 mapping Methods 0.000 description 6
- 230000003137 locomotive effect Effects 0.000 description 5
- 230000005622 photoelectricity Effects 0.000 description 5
- 230000009471 action Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 230000008034 disappearance Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000002310 reflectometry Methods 0.000 description 1
- 230000007306 turnover Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0289—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling with means for avoiding collisions between vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0291—Fleet control
- G05D1/0293—Convoy travelling
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Optics & Photonics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Acoustics & Sound (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a laser navigation forklift type AGV vehicle-mounted system and a control method, wherein the system comprises an electric forklift body, a vehicle-mounted main controller is arranged on the electric forklift body, and the vehicle-mounted controller is connected with a positioning navigation module, a path planning module, a safety obstacle avoidance module, an audible and visual alarm module, a motion execution module, an automatic charging module, a wireless communication module and a task management scheduling module; the positioning navigation module describes the surrounding environment in a laser SLAM mode, integrates information of an I MU, a wheel type odometer and a camera sensor, and completes drawing construction and positioning of the AGV forklift.
Description
Technical Field
The invention relates to the field of unmanned laser forklift control, in particular to a vehicle-mounted system and a method of an unmanned laser forklift.
Background
With the rapid development of warehouse logistics automation and the disappearance of domestic population dividends, Automated Guided Vehicles (AGVs) gradually become important components of intelligent logistics systems by virtue of the advantages of high efficiency, strong flexibility and the like. Wherein, fork truck formula AGV is as the representative, not only can realize the material handling function, can realize the function of material stack moreover, replaces the manpower basically completely, realizes automaticly. At present, mainstream fork truck AGV in market is with electric fork truck as the main part, installs sensors such as laser radar in the electric fork truck main part to install optics auxiliary device such as reflector panel additional in surrounding environment, assist laser radar and fix a position, and then realize the control to AGV. However, there are the following problems:
1. the positioning mode of current laser navigation fork truck formula AGV installation reflector panel is higher to the surrounding environment requirement, and the reflector panel is easily polluted, and the reflectivity of object has certain influence to the accuracy of laser radar location around, because the requirement of reflector panel installation, uses limitedly in the outdoor, and adopts single sensor location more, and it is relatively poor to avoid dynamic obstacle ability.
2. The existing AGV path planning method mostly has the problems of long path searching time, more redundant nodes and the like, and influences the working efficiency of the AGV. And the problem of crossing jam and the like exists for the dispatching of multiple AGVs.
3. Only various sensors are installed on a forklift main body, a vehicle-mounted system of the forklift main body is mainly used for receiving information and sending instructions, a laser SLAM module, a path planning module, a motion control module and the like are not integrated, and the transportability is poor.
Disclosure of Invention
In order to solve the technical problems in the prior art, the invention provides a laser navigation forklift type AGV vehicle-mounted system and a control method, and the system and the control method have the advantages of high integration level, simple architecture and the like.
The technical scheme adopted by the invention is as follows:
in a first aspect, the embodiment of the invention provides a laser navigation forklift type AGV (automatic guided vehicle) vehicle-mounted system, which comprises an electric forklift body, wherein a vehicle-mounted main controller, a positioning navigation module, a path planning module, a safety obstacle avoidance module, an audible and visual alarm module, a motion execution module, an automatic charging module, a wireless communication module and a task management scheduling module are arranged on the electric forklift body;
the vehicle-mounted main controller is an industrial personal computer, and the positioning navigation module, the path planning module, the safety obstacle avoidance module, the sound and light alarm module, the motion execution module, the automatic charging module and the wireless communication module are respectively connected with the main controller; the positioning navigation module abandons the traditional reflector positioning mode, adopts a laser SLAM mode to describe the surrounding environment, integrates sensor information such as IMU, wheel-type odometer and camera, and completes map building and AGV forklift self positioning.
The path planning module can perform collision detection, calculate the distance between the AGV forklift and surrounding obstacles, and is used for planning a shortest collision-free path from the starting position to the target station for the AGV.
The safety obstacle avoidance module adopts a two-stage combined protection measure combining hardware and software and matching contact protection with non-contact protection, and comprises 2 professional laser obstacle avoidance scanners arranged on the head of the vehicle, a three-region protection mode, a protection region and two warning regions, obstacle avoidance detection photoelectricity arranged at the tail fork tip part of the vehicle, a bumper and an obstacle avoidance contact switch arranged on the head of the vehicle and a contact switch arranged at the fork tip part of the vehicle;
and the sound-light alarm module is used for alarming and prompting when a fault occurs.
The motion execution module adopts an electro-hydraulic hybrid driving mode by the walking, steering and lifting descending of the AGV, and the lifting of the fork adopts hydraulic control.
The automatic charging module is used for charging the vehicle-mounted battery, and the working efficiency of the AGV is improved. The wireless communication module is used for data communication with the remote control center, and plays a role in data transmission and data transfer.
And the task scheduling module is used for managing and scheduling the tasks of a plurality of AGV. The overall system is based on the ROS operating system.
In a second aspect, based on the foregoing system, an embodiment of the present invention further provides a method, where the map building method of the positioning navigation module is as follows:
step 1: the system collects speed and acceleration information through an IMU, and completes primary estimation on the self attitude of the AGV through attitude resolving and complementary filtering;
step 2: the wheel type odometer collects speed information to complete the dead reckoning of the AGV, so that the position of the AGV is estimated, and attitude estimation is completed by integrating attitude estimation and position estimation;
and step 3: the multi-line laser radar adopts a point cloud segmentation matching technology, establishes a point cloud description model of the surrounding environment based on a point cloud segment and a classified target method, and scans and matches the point cloud description model with the estimated pose to obtain a matched pose;
and 4, step 4: the camera identifies the mark pose and the mark size;
and 5: matching the pose with the laser radar to obtain a high-precision pose by dynamic weighting;
step 6: outputting the pose to a central controller to adjust the rotating speed and the rotating angle of the wheel;
and 7: and judging whether the target task point is reached, if so, finishing guidance, and if not, starting the next scanning period.
Further, the method for planning the path by the path planning module is as follows:
step 1: firstly, dividing grids according to the map precision;
step 2: adding the starting point into an open list;
and step 3: searching nodes in 8 directions by taking the starting point as a center;
and 4, step 4: adding the jumping points meeting the conditions into an open list;
and 5: searching a grid point of the minimum value in the open list and marking as an X point;
step 6: judging whether X is a target point, if so, ending the path search, and if not, deleting the X from the open list and adding the X into the closed list;
and 7: nodes can be searched in the straight line direction and the oblique line direction, when the two directions can be expanded, the expansion in the straight line direction is preferentially carried out, and the expansion in the straight line direction is firstly completed and then the expansion in the diagonal line direction is carried out; searching a first jumping point N in a straight line direction or a diagonal line direction;
and 8: deleting the N points in the closing list;
and step 9: judging whether the N point is in the open list or not, if not, adding the N point into the open list, if so, updating the value of the N point in the open list, and then performing the next round of search;
step 10: and after the search is finished, traversing the nodes in the closed list, and sequentially connecting all the nodes together to obtain a final path. And according to the finally generated path, the navigation frame is used for outputting speed information, so that the motion control of the AGV can be realized.
The beneficial effects of the above-mentioned embodiment of the present invention are as follows:
the laser navigation forklift type AGV vehicle-mounted system and the control method provided by the invention improve the related algorithm and have the advantages of high integration level, simple architecture and the like. The traditional positioning and mapping method of the reflector is abandoned, the SLAM algorithm is adopted, sensor data such as IMUs, mileometers and cameras are fused, the laser positioning accuracy is improved, the environmental adaptability is improved, and the working range of the AGV is expanded. And a related path planning algorithm is improved, path searching nodes are reduced, path searching time is shortened, and AGV autonomous navigation efficiency is improved. A novel AGV multi-machine scheduling method is provided, the problem of intersection congestion is effectively relieved, and the phenomenon of detour is reduced while conflict is avoided.
Drawings
The accompanying drawings, which are incorporated in and constitute a part of this specification, are included to provide a further understanding of the invention, and are incorporated in and constitute a part of this specification, illustrate exemplary embodiments of the invention and together with the description serve to explain the invention and not to limit the invention.
FIG. 1 is a schematic diagram of the overall system framework of the present invention;
FIG. 2 is a flow diagram of a positioning and mapping module of the present invention;
FIG. 3 is a flow chart of a path planning module of the present invention;
FIG. 4 is a flow chart of an obstacle avoidance module of the present invention;
FIG. 5 is a flow chart of an automatic charging module of the present invention;
FIG. 6 is a flow chart of the motion control module of the present invention;
FIG. 7 is a flow chart of the management scheduling of the present invention.
Detailed Description
It is to be understood that the following detailed description is exemplary and is intended to provide further explanation of the invention as claimed. Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs.
It is noted that the terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of exemplary embodiments according to the invention. As used herein, the singular forms "a", "an", and/or "the" are intended to include the plural forms as well, unless the invention expressly state otherwise, and it should be understood that when the terms "comprises" and/or "comprising" are used in this specification, they specify the presence of stated features, steps, operations, devices, components, and/or combinations thereof;
as described in the background art, the present invention provides a laser navigation forklift type AGV vehicle-mounted system and a control method thereof to solve the above technical problems.
In a typical embodiment of the present invention, as shown in fig. 1 and fig. 2, the embodiment discloses a laser navigation forklift type AGV vehicle-mounted system, which includes an electric forklift body, and a vehicle-mounted main controller, a positioning navigation module, a path planning module, a safety obstacle avoidance module, an audible and visual alarm module, a motion execution module, an automatic charging module, a wireless communication module, and a task management scheduling module are disposed on the electric forklift body.
The vehicle-mounted main controller is an industrial personal computer, and the positioning navigation module, the path planning module, the safety obstacle avoidance module, the sound and light alarm module, the motion execution module, the automatic charging module and the wireless communication module are respectively connected with the main controller; the positioning navigation module abandons the traditional reflector positioning mode, adopts a laser SLAM mode to describe the surrounding environment, integrates sensor information such as IMU, wheel type odometer and camera, and completes map building and AGV forklift self positioning.
The path planning module can perform collision detection, calculate the distance between the AGV forklift and surrounding obstacles, and is used for planning a shortest collision-free path from the starting position to the target station for the AGV.
The safety obstacle avoidance module adopts hardware and software to combine together, and the barrier scanner is kept away to 2 specialty laser that install additional including the locomotive portion to contact protection and non-contact protection complex second grade joint safeguard procedures, three regional protection modes, two warning areas in a protected area, the fender that rear of a vehicle fork point portion was installed is detected photoelectricity, the bumper that the locomotive was installed additional with keep away the contact switch that barrier contact switch and fork point portion were installed additional.
And the sound-light alarm module is used for alarming and prompting when a fault occurs.
The motion execution module adopts an electro-hydraulic hybrid driving mode by the walking, steering and lifting descending of the AGV, and the lifting of the fork adopts hydraulic control. The automatic charging module is used for charging the vehicle-mounted battery, and the working efficiency of the AGV is improved.
The wireless communication module is used for data communication with the remote control center, and plays a role in data transmission and data transfer. And the task scheduling module is used for managing and scheduling the tasks of a plurality of AGV. The overall system is based on the ROS operating system.
The positioning navigation module abandons the traditional reflector positioning mode, adopts a laser SLAM mode to describe the surrounding environment, integrates sensor information such as IMU, wheel type odometer and camera, and completes map building and AGV forklift self positioning. The path planning module can perform collision detection, calculate the distance between the AGV forklift and surrounding obstacles, and is used for planning a shortest collision-free path from the starting position to the target station for the AGV. The safety obstacle avoidance module adopts hardware and software to combine together, and the barrier scanner is kept away to 2 specialty laser that install additional including the locomotive portion to contact protection and non-contact protection complex second grade joint safeguard procedures, three regional protection modes, two warning areas in a protected area, the fender that rear of a vehicle fork point portion was installed is detected photoelectricity, the bumper that the locomotive was installed additional with keep away the contact switch that barrier contact switch and fork point portion were installed additional. And the sound-light alarm module is used for alarming and prompting when a fault occurs. The motion execution module adopts an electro-hydraulic hybrid driving mode by the walking, steering and lifting descending of the AGV, and the lifting of the fork adopts hydraulic control. The automatic charging module is used for charging the vehicle-mounted battery, and the working efficiency of the AGV is improved. The wireless communication module is used for data communication with the remote control center, and plays a role in data transmission and data transfer. And the task scheduling module is used for managing and scheduling the tasks of a plurality of AGV. The overall system is based on the ROS operating system.
The laser radar mapping and positioning module is different from a traditional single-line laser radar mapping, abandons a reflector mapping mode, adopts a multi-line laser radar mapping method, and specifically comprises the following steps:
step 1: the system collects speed and acceleration information through the IMU, completes the preliminary estimation of the self attitude of the AGV through attitude calculation, complementary filtering and the like,
step 2: the wheel type odometer collects speed information to complete the dead reckoning of the AGV, so that the position of the AGV is estimated, and attitude estimation is completed by integrating attitude estimation and position estimation;
and step 3: the multiline laser radar adopts a point cloud segmentation matching technology, establishes a point cloud description model of the surrounding environment based on a point cloud segment and a classified target method, scans and matches the point cloud description model with the estimated pose to obtain the matched pose,
and 4, step 4: the camera identifies the position and the size of the mark,
and 5: matching the pose with the laser radar to obtain a high-precision pose by dynamic weighting,
step 6: outputs the pose to a central controller to adjust the rotating speed and the rotating angle of the wheel,
and 7: and judging whether the target task point is reached, if so, finishing guidance, and if not, starting the next scanning period.
Therefore, multi-sensor fusion positioning and map building is realized, the running pose information of the AGV is fed back in real time, the normal walking of the AGV is ensured, and certain precision is kept. The flow is shown in fig. 2.
Furthermore, in the embodiment, the path planning module is used for planning a collision-free path from a starting position to a target station for the AGV, and in order to solve the problems of long path search time, more search redundant nodes and the like existing in the existing path planning method, a new path planning method is applied, instead of a traditional point-by-point judgment method, expansion calculation is performed in four directions or eight directions around the starting point serving as a center, a key point is selected as a jumping point, a jumping point judgment method is adopted, a jumping point meeting conditions is selected according to a rule by taking the starting point as the center, and the jumping point is searched in the next search direction by taking the directions of the original jumping point and the new jumping point as the destination, so that a calculation and judgment link for non-key nodes in the traditional algorithm is omitted, and the algorithm efficiency is improved. The flow is shown in fig. 3. The algorithm maintains two node lists, namely an open list and a closed list, wherein the open list stores nodes which are not traversed, and the closed list stores nodes which are traversed, and the specific steps are as follows:
step 1: firstly, dividing grids according to the map precision;
step 2: adding the starting point into an open list;
and step 3: searching nodes in 8 directions by taking the starting point as a center;
and 4, step 4: adding the jumping points meeting the conditions into an open list;
and 5: searching a grid point of the minimum value in the open list and marking as an X point;
step 6: judging whether X is a target point, if so, ending the path search, and if not, deleting X from the open list, and adding X into the closed list;
and 7: the nodes can be searched in the straight line direction and the oblique line direction, when the two directions can be expanded, the expansion in the straight line direction is preferentially carried out, and the expansion in the straight line direction is firstly completed and then the expansion in the diagonal line direction is carried out. Searching a first jumping point N in a straight line direction or a diagonal line direction;
and 8: deleting the N points in the closing list;
and step 9: judging whether the N point is in the open list or not, if not, adding the N point into the open list, if so, updating the value of the N point in the open list, and then performing the next round of search;
step 10: and after the search is finished, traversing the nodes in the closed list, and sequentially connecting all the nodes together to obtain a final path. And according to the finally generated path, the navigation frame is used for outputting speed information, so that the motion control of the AGV can be realized.
Further, the safety obstacle avoidance module in the embodiment adopts two-level combined protection measures of hardware and software, and is divided into a contact type and a non-contact type. The first-level safety system adopts multiple non-contact sensors, and comprises two professional laser obstacle avoidance scanners which are additionally arranged on a vehicle head, wherein the scanning angles of the laser scanners are 270 degrees, the laser scanners are respectively arranged at two corners of the vehicle head, the vehicle body is just covered on the surrounding area, and no safe dead angle exists. The obstacle avoidance detection photoelectricity is additionally arranged at the tip of the tail fork, and the goods in-place detection photoelectricity is additionally arranged at the root of the fork. The second level adopts contact safety system, including installing the bumper additional at the locomotive to install pull switch additional behind the bumper, install contact switch additional at rear of a vehicle fork point portion, install limit for height contact switch etc. additional on the portal. If the warning area detects the obstacle, the vehicle decelerates and crawls, and if the stopping area detects the obstacle. Stopping immediately, if no obstacle is detected around, keeping the AGV forklift in a working state, and if the anti-collision rubber strip touches the obstacle, stopping immediately, wherein the flow chart is shown in fig. 4, and the specific steps are as follows:
step 1: starting the obstacle avoidance system to work;
step 2: whether the laser radar warning area detects the obstacle or not, if the obstacle is detected, the speed is reduced and the vehicle is driven slowly, and if the obstacle is not detected, normal operation is continued;
and step 3: whether the laser radar stopping area detects an obstacle or not, if the obstacle is not detected, normal operation is continued, and if the obstacle is detected, the vehicle is stopped immediately;
and 4, step 4: detecting whether the barrier is moved away, if so, continuing normal work, and if not, keeping the barrier in place;
and 5: if the ultrasonic sensor detects an obstacle, the operation is normal if the obstacle is not detected, and if the obstacle is detected, the operation is immediately stopped,
step 6: detecting whether the barrier is moved away, if so, continuing normal work, and if not, keeping the barrier in place;
and 7: whether the anti-collision rubber strip detects an obstacle or not, if the obstacle is not detected, the anti-collision rubber strip continues to work normally, and if the obstacle is detected, the vehicle stops immediately;
and 8: and detecting whether the barrier is removed, if so, continuing normal operation, and if not, keeping the barrier in place.
Furthermore, in this embodiment, the automatic charging module detects the battery level through detecting the battery I/O port to control the contactor of the charging brush plate, so as to control the on/off of the charging. The on-vehicle brush and the disconnection of battery that charge of operation in-process, only can close the contactor when the AGV reaches the controller on the AGV after the charging station, be on-vehicle brush and the battery switch-on that charges, the side plate electrode with fill electric pile and be in the same place. The automatic charging module flow is shown in fig. 6, and includes the following steps:
step 1: detecting the current state of the AGV;
step 2: if the AGV is in an idle state, detecting whether the electric quantity of the AGV is lower than 50%, if the electric quantity of the AGV is lower than 50%, charging the charging pile, and if the electric quantity of the AGV is higher than 50%, standing by in a stopping area;
and step 3: detecting whether the battery is charged for two hours or the battery power is higher than 95%, and if the battery power is higher than 95%, driving to a stop area for standby; if not, continuing to charge;
and 4, step 4: if the AGV is in a working state, detecting whether the electric quantity of the AGV is lower than 30%, and if the electric quantity of the AGV is lower than 30%, completing a cycle of work and then charging the charging pile; if the working speed is not lower than 30%, continuing working, and waiting to the stop area after the working is finished;
and 5: judging whether the charging is carried out for one hour or the electric quantity is higher than 95%, and if the electric quantity is higher than 95%, driving to a stop area for standby; if not higher than 95%, the charging is continued.
Furthermore, the motion execution module in the embodiment is used for automatically controlling the actions of the forklift, mainly comprises a driving unit and an execution unit, and comprises motion control of straight movement, steering, fork lifting and the like. The motion control flow is shown in fig. 6.
Step 1: the AGV enters a standby state;
step 2: whether a task calls or not is judged, if no task calls exist, standby is carried out in a stopping area, and if the task calls exist, the station direction is judged;
and step 3: if the station is at the initial station, the station is in the station-out direction, and if the station is out from the left side, the station is sequentially retreated, slowly moved, retreated, rotated to the left and then accelerated and retreated; if the vehicle leaves from the right side, the vehicle is retreated slowly, retreated to the right, rotated to the right and then accelerated.
And 4, step 4: when entering a target station, if entering from the left side, firstly slowing down and slowly moving, then turning from backward to forward, and then turning to the left; if the vehicle enters from the right side, the vehicle decelerates and slowly moves, then turns from backward to forward, and then turns to the right after going forward;
and 5: judging whether the specified station is reached, and if the specified station is not reached, instructing to adjust by a controller; if the forklift reaches the designated station, the forklift is stopped first, and then the fork action is executed;
step 6: judging whether the fork action is finished or not, and if the fork is not in place, adjusting the command of the controller; and if the pallet fork is in place, carrying out the next cycle of work.
Further, in this embodiment, AGV acts as the executor of system, accomplishes the turnover transport of goods, and AGV needs work under the supervision of task management scheduling module, and this system adopts wifi wireless communication, constitutes star network connection between task management module and the AGV, mainly accomplishes functions such as rational distribution, AGV walking planning, traffic control of AGV task, still possesses functions such as supervise equipment running state simultaneously. The system dynamic scheduling flow chart is shown in the following chart. The main idea is as follows: if for the syntropy conflict, then judge the car distance between two AGV, if the AGV car distance is less than safe distance, then slow down the back car or the car before accelerating, if conflict in opposite directions, then judge two AGV who enters into earlier and dash into the district, when having an AGV enter into the conflict district, then let another AGV park the waiting outside the conflict district, leave the conflict district until the AGV that has entered into the conflict district. The program circularly runs, and the dynamic scheduling of the AGV system can be realized, and the specific steps are as follows:
step 1: the upper computer starts monitoring the AGV state;
step 2: the upper computer issues a task instruction;
and step 3: judging the priority of the task in the task queue;
and 4, step 4: allocating proper AGV for the task;
and 5: the AGV starts working, whether the current AGV is in the range of 3 meters in front of the conflict area or not is judged, and if not, the AGV continues to run at the normal speed;
step 6: if the current AGV is within the range of 3 meters in front of the conflict area, continuing to judge the conflict type, judging whether the conflict is in the same direction, if the conflict is in the same direction, judging whether the distance between two vehicles in the conflict area is smaller than a safety distance, if the distance is not smaller than the safety distance, the current AGV runs at a normal speed, if the distance is smaller than the safety distance, continuing to judge whether the current AGV is in front of another AGV, if the distance is in front, accelerating the current AGV, and if the distance is in back, decelerating the current AGV;
and 7: if the AGV does not conflict in the same direction, judging whether the AGV is in a direction conflict or not, and if the AGV is not in the direction conflict, driving the AGV at the normal speed; if the two AGVs conflict with each other, judging the positions of the two AGVs, if the current AGV enters the conflict area firstly and the other AGV is within 2 meters of the conflict area, and if the current AGV enters the conflict area, suddenly stopping the other AGV; if another AGV enters the conflict area before the current AGV and the current AGV is within two meters before the conflict area, the current AGV is suddenly stopped; and if the other AGV enters the conflict area before the current AGV and already leaves the conflict area, canceling the sudden stop of the current AGV, otherwise, driving the current AGV at the normal speed.
The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention, and various modifications and changes may be made by those skilled in the art. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims (9)
1. A laser navigation forklift type AGV vehicle-mounted system is characterized by comprising an electric forklift body, wherein a vehicle-mounted main controller is arranged on the electric forklift body and is connected with a positioning navigation module, a path planning module, a safety obstacle avoidance module, an audible and visual alarm module, a motion execution module, an automatic charging module, a wireless communication module and a task management scheduling module;
the positioning navigation module describes the surrounding environment in a laser SLAM mode, integrates IMU, wheel type odometer and camera sensor information, and completes drawing construction and AGV forklift self positioning.
2. The laser navigation forklift type AGV vehicle-mounted system according to claim 1, wherein the path planning module selects key points as jumping points, selects the jumping points meeting the conditions according to rules by taking a starting point as a center in a jumping point judgment mode, and searches the jumping points by taking the directions of the original jumping points and the new jumping points as the next searching direction until reaching the end point.
3. The laser navigation forklift type AGV vehicle-mounted system according to claim 1, wherein said safety obstacle avoidance module includes two of a contact type protection module and a non-contact type protection module.
4. The laser navigation forklift type AGV car-mounted system according to claim 3, wherein the contact type protection module comprises a bumper mounted on the car head, an obstacle avoidance contact switch mounted at the tip of the rear fork and a height limit contact switch mounted on the upper end of the door frame.
5. The laser navigation forklift type AGV vehicle-mounted system according to claim 3, wherein said non-contact type protection module comprises a laser obstacle avoidance scanner installed on the head of the electric forklift body.
6. The laser navigation forklift type AGV vehicle-mounted system according to claim 5, wherein said two laser obstacle avoidance scanners are installed at two corners of the front of the vehicle, and the scanning angle of the laser scanners is 270 degrees.
7. The laser navigation forklift type AGV vehicle-mounted system according to claim 1, wherein the motion execution module is used for walking, steering and lifting and descending of the fork of the AGV, an electro-hydraulic hybrid driving mode is adopted, and lifting of the fork is controlled hydraulically.
8. The control method of the laser navigation forklift type AGV vehicle-mounted system based on any one of claims 1 to 7, wherein the map building method of the positioning navigation module is as follows:
step 1: the system collects speed and acceleration information through an IMU, and completes primary estimation on the self attitude of the AGV through attitude resolving and complementary filtering;
step 2: the wheel type odometer collects speed information to complete the dead reckoning of the AGV, so that the position of the AGV is estimated, and attitude estimation is completed by integrating attitude estimation and position estimation;
and step 3: the multi-line laser radar adopts a point cloud segmentation matching technology, establishes a point cloud description model of the surrounding environment based on a point cloud segment and a classified target method, and scans and matches the point cloud description model with the estimated pose to obtain a matched pose;
and 4, step 4: the camera identifies the mark pose and the mark size;
and 5: matching the pose with the laser radar to obtain a high-precision pose by dynamic weighting;
step 6: outputting the pose to a central controller to adjust the rotating speed and the rotating angle of the wheel;
and 7: and judging whether the target task point is reached, if so, finishing guidance, and if not, starting the next scanning period.
9. The method for controlling the AGV system according to claim 8, wherein the path planning module plans the path by the following steps:
step 1: firstly, dividing grids according to the map precision;
step 2: adding the starting point into an open list;
and step 3: searching nodes in 8 directions by taking the starting point as a center;
and 4, step 4: adding the jumping points meeting the conditions into an open list;
and 5: searching a grid point of the minimum value in the open list and marking as an X point;
step 6: judging whether X is a target point, if so, ending the path search, and if not, deleting the X from the open list and adding the X into the closed list;
and 7: nodes can be searched in the straight line direction and the oblique line direction, when the two directions can be expanded, the expansion in the straight line direction is preferentially carried out, and the expansion in the straight line direction is firstly completed and then the expansion in the diagonal line direction is carried out; searching a first jumping point N in a straight line direction or a diagonal line direction;
and 8: deleting the N points in the closing list;
and step 9: judging whether the N point is in the open list or not, if not, adding the N point into the open list, if so, updating the value of the N point in the open list, and then performing the next round of search;
step 10: and after the search is finished, traversing the nodes in the closed list, and sequentially connecting all the nodes together to obtain a final path. And according to the finally generated path, the navigation frame is used for outputting speed information, so that the motion control of the AGV can be realized.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110301652.9A CN112947475A (en) | 2021-03-22 | 2021-03-22 | Laser navigation forklift type AGV vehicle-mounted system and method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110301652.9A CN112947475A (en) | 2021-03-22 | 2021-03-22 | Laser navigation forklift type AGV vehicle-mounted system and method |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112947475A true CN112947475A (en) | 2021-06-11 |
Family
ID=76227491
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110301652.9A Pending CN112947475A (en) | 2021-03-22 | 2021-03-22 | Laser navigation forklift type AGV vehicle-mounted system and method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112947475A (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113447950A (en) * | 2021-06-30 | 2021-09-28 | 湖南牛顺科技有限公司 | AGV positioning navigation system and method |
CN113963562A (en) * | 2021-12-21 | 2022-01-21 | 北京慧拓无限科技有限公司 | Avoidance method and device for multiple vehicles in working area |
CN115129068A (en) * | 2022-08-26 | 2022-09-30 | 济宁龙纳智能科技有限公司 | Intelligent positioning navigation system based on AGV forklift |
CN116757350A (en) * | 2023-08-11 | 2023-09-15 | 稳石机器人(深圳)有限公司 | Unmanned forklift cluster scheduling processing system |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105607635A (en) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | Panoramic optic visual navigation control system of automatic guided vehicle and omnidirectional automatic guided vehicle |
CN109115226A (en) * | 2018-09-01 | 2019-01-01 | 哈尔滨工程大学 | The paths planning method of multirobot conflict avoidance based on jump point search |
CN209161405U (en) * | 2018-10-23 | 2019-07-26 | 安徽合派电动科技有限公司 | A kind of SLAM navigation AGV fork truck |
CN110108269A (en) * | 2019-05-20 | 2019-08-09 | 电子科技大学 | AGV localization method based on Fusion |
CN110319837A (en) * | 2019-07-09 | 2019-10-11 | 北方工业大学 | Indoor complex condition path planning method for service robot |
CN111309000A (en) * | 2019-11-05 | 2020-06-19 | 华中科技大学 | AGV system based on double control boards and path planning method |
CN112066989A (en) * | 2020-08-19 | 2020-12-11 | 合肥工业大学 | Indoor AGV automatic navigation system and method based on laser SLAM |
-
2021
- 2021-03-22 CN CN202110301652.9A patent/CN112947475A/en active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105607635A (en) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | Panoramic optic visual navigation control system of automatic guided vehicle and omnidirectional automatic guided vehicle |
CN109115226A (en) * | 2018-09-01 | 2019-01-01 | 哈尔滨工程大学 | The paths planning method of multirobot conflict avoidance based on jump point search |
CN209161405U (en) * | 2018-10-23 | 2019-07-26 | 安徽合派电动科技有限公司 | A kind of SLAM navigation AGV fork truck |
CN110108269A (en) * | 2019-05-20 | 2019-08-09 | 电子科技大学 | AGV localization method based on Fusion |
CN110319837A (en) * | 2019-07-09 | 2019-10-11 | 北方工业大学 | Indoor complex condition path planning method for service robot |
CN111309000A (en) * | 2019-11-05 | 2020-06-19 | 华中科技大学 | AGV system based on double control boards and path planning method |
CN112066989A (en) * | 2020-08-19 | 2020-12-11 | 合肥工业大学 | Indoor AGV automatic navigation system and method based on laser SLAM |
Non-Patent Citations (4)
Title |
---|
王晓博: "多AGV路径规划及调度控制策略研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
王璐欢: "《工业互联网与机器人技术应用初级教程》", 30 June 2020 * |
胡杰杰: "面向制造车间柔性物流的AGV群控系统研制", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
邱磊: "利用跳点搜索算法加速A*寻路", 《兰州大学学报》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113447950A (en) * | 2021-06-30 | 2021-09-28 | 湖南牛顺科技有限公司 | AGV positioning navigation system and method |
CN113963562A (en) * | 2021-12-21 | 2022-01-21 | 北京慧拓无限科技有限公司 | Avoidance method and device for multiple vehicles in working area |
CN115129068A (en) * | 2022-08-26 | 2022-09-30 | 济宁龙纳智能科技有限公司 | Intelligent positioning navigation system based on AGV forklift |
CN115129068B (en) * | 2022-08-26 | 2022-12-16 | 济宁龙纳智能科技有限公司 | Intelligent positioning navigation system based on AGV forklift |
CN116757350A (en) * | 2023-08-11 | 2023-09-15 | 稳石机器人(深圳)有限公司 | Unmanned forklift cluster scheduling processing system |
CN116757350B (en) * | 2023-08-11 | 2024-04-26 | 稳石机器人(深圳)有限公司 | Unmanned forklift cluster scheduling processing system |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112947475A (en) | Laser navigation forklift type AGV vehicle-mounted system and method | |
JP7236749B2 (en) | Environmental active sensing type parking automatic parking system | |
JP6898394B2 (en) | Vehicle automatic driving control assist method, vehicle automatic driving control assist device, equipment, computer readable storage medium and lane cooperation system | |
US20200307648A1 (en) | Parking lot management device, parking lot management method, and storage medium | |
CN113485319A (en) | Automatic driving system based on 5G vehicle-road cooperation | |
CN109952603B (en) | System and method for operating a commercial vehicle | |
CN109403690A (en) | Automotive vehicle carries method, system and the application with transfer | |
CN112875578B (en) | Unmanned forklift control system | |
CN112875577A (en) | Intelligent warehousing management control system based on AMR and AGV forklift | |
CN111309000B (en) | AGV system based on double control boards and path planning method | |
CN112429016B (en) | Automatic driving control method and device | |
JP2020106525A (en) | Autonomous vehicle route planning | |
EP3798577A1 (en) | Method and apparatus for determining turn-round path of vehicle, device and medium | |
CN113785252A (en) | Method of parking an autonomously driven vehicle for autonomous charging | |
CN112684791A (en) | Unmanned logistics vehicle based on 5G | |
CN112875576A (en) | Automatic drive fork truck system | |
WO2020204871A1 (en) | Shared autonomous vehicle operational management | |
CN112810628A (en) | Vehicle control system | |
CN115129050A (en) | Unmanned transportation short-falling system and method for port tractor | |
CN113196358A (en) | Signal lamp system analysis system required by automatic driving path | |
CN215793717U (en) | Four-wheel driverless pure electric ferry vehicle | |
CN116166029A (en) | Multi-AGV navigation method and system compatible with local obstacle avoidance function | |
CN113022552B (en) | Automatic parking system based on laser radar and V2I technology and control method | |
US11364953B2 (en) | Vehicle control system | |
CN111857132B (en) | Central control type automatic driving method and system and central control system |
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 |