Navigation method by narrow angle laser for automated guided vehicles

The narrow angle laser navigation method for AGVs addresses the challenges of high costs and low accuracy by using precalculated angles and distances to guide AGVs along straight paths, enhancing navigation efficiency and accuracy in agricultural settings.

WO2024231902A1PCT designated stage expired Publication Date: 2024-11-14DO MINH TAM
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
PCT/IB2024/054626
Authority / Receiving Office
WO · WO
Patent Type
Applications
Current Assignee / Owner
Priority Date
2023-05-11
Filing Date
2024-05-13
Publication Date
2024-11-14

AI Technical Summary

Technical Problem

Existing navigation methods for automated guided vehicles (AGVs) in agriculture face high costs, complex installations, and low accuracy, particularly in environments with intricate layouts, requiring technical expertise and prone to noise interference.

Method used

A navigation method utilizing a narrow angle laser to determine the position and direction of AGVs by calculating the scanning angle and transversal distance between operation points, allowing for efficient movement along straight lines without additional equipment like reflecting mirrors or GPS, using equations to adjust the AGV's path based on real-time laser scans.

Benefits of technology

This method reduces installation complexity and costs while improving navigation accuracy by using precalculated angles and distances to guide AGVs along straight paths, effectively navigating in agricultural and similar environments with minimal equipment and technical expertise.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure IB2024054626_14112024_PF_FP_ABST
    Figure IB2024054626_14112024_PF_FP_ABST
Patent Text Reader

Abstract

The invention relates to a method of navigation for automated guided vehicle (AGV) in agriculture. This method employs one (or more) lasers to scan in a narrow angle to determine position of the next operation point and moving direction of the automated guided vehicle, or it is possible to combine with some prior art at special operation points to navigate the AGV in the whole operation area.
Need to check novelty before this filing date? Find Prior Art

Description

NAVIGATION METHOD BY NARROW ANGLE LASER FOR AUTOMATED GUIDED VEHICLES

[0001] The invention relates to a method of navigation for automated guided vehicle (AGV) in agriculture.

[0002] Automated guided vehicle (AGV)are robots that can perform automatic movement. It is possible to mention some conventional navigation methods for automated guided vehicle such as:

[0003] Navigation by magnetic tape, wherein the magnetic tape is glued on the ground, being identified by the AGV to move along.

[0004] Navigation by magnetic point, wherein the magnetic points are provided 250-500 mm away from each other as a dotted line, the AGV moves from one point to another by magnetic sensors.

[0005] Navigation by line follower sensor, wherein the AGV employs light sensors to identify color differences of the navigation path.

[0006] Navigation by QR code, wherein the AGV employs cameras or sensors to scan the QR code on the landmarks. The AGV navigates based on the information from this QR code.

[0007] Navigation by laser, wherein a laser head is provided on the body of the automated guided vehicle, receives and transmits laser signals reflected by the reflecting mirror provided in the AGV’s operational space, thereby the AGV processes these signals and navigates.

[0008] Navigation by natural navigation, wherein the AGV employs a built-in operational space map, employs cameras or laser scans to identify fixed, positioned landmarks to navigate.

[0009] Navigation by global positioning system (GPS), wherein the AGV specifies positions based on position of the satellites and built-in map to navigate.

[0010] Navigation by cameras, wherein the AGV employs cameras to collect ambient images, compares the input with the coded information on the map to position and navigate.

[0011] Navigation by lidar, wherein the AGV employs sensors that receive and transmit laser signals to measure distance between the robot and the ambient objects to create a 360omap of the ambient space to navigate.

[0012] The aforementioned navigation methods have such shortcomings as high cost of investment, long installation time, complicated installation process, high cost of operation and maintenance, required technical expertise, low accuracy, prone to noise in intricate environment, etc.

[0013] The present invention has been made in view of the circumstances described above of the available navigation methods for automated guided vehicle, and the primary objective of the invention is to provide a navigation methods for automated guided vehicle in agriculture and other areas.

[0014] Agriculture is a management system with use of ground and water surface to harvest crops, livestock, marine products, etc., wherein crops, pond and lake, warehouse, barn and breeding facilities, battery cage, equipment… (operation points of the AGV) are allocated on a large area. The difference between the environment of agriculture and other industries (factories, warehouse, supermarkets, service facilities, etc.) is that operation points of the AGV are mostly robot arranged on rows and columns, the AGV moves in succession to these points on a straight line, performing actions in the process and moves to the next point. The arrangement by rows and columns of the operation points is characterized by the moving direction (in most cases) on a straight line, target being fixed in the direction and the distance between points being fairly constant; because of which it is possible to use one (or more) lasers to scan in a narrow angle compared to the straight moving direction of the AGV to determine position of the next operation point and moving direction of the automated guided vehicle, or it is possible to combine with some prior art at special operation points to navigate the AGV in the whole operation area.Fig.1

[0015] is a schematic view illustrating a navigation method for the automated guided vehicle at normal operation points;Fig.2

[0016] is a schematic view illustrating a navigation method for the automated guided vehicle at special operation points;Fig.3

[0017] is a schematic view illustrating a navigation method for the automated guided vehicle at special operation points;

[0018] Hereinafter, the present invention will be described in detail with reference to the accompanying drawings. The contents described herein are for illustrative purposes only and are not intended to limit the scope of the present disclosure.

[0019] In the scope of this disclosure, the term "narrow angle" refers to the angle of less than 360o, according to some embodiments, from -90oto 90o,or from 0oto 180o, or from -180oto 0o, or from -180oto 180o,based upon position of the target point.

[0020] According to an embodiment as illustrated in, the AGV is at normal operation point 1 and needs to move to normal operation point 2 (normal operation points are points provided on almost a straight line and the AGV does not need to change direction too much when navigating from one point to the next). Position of the laser head provided on the AGV is O. The line segment OT starts from O to T to be in tangent with the normal operation point 2. OX concurs with the straight movement direction of the AGV. The right triangle OXT (right-angled at X) composed by three points O, X, and T is used to calculate navigation path of the AGV, wherein:

[0021] α = angle XOT, is the narrow scanning angle compared to the straight moving direction of the AGV, with a value of less than 360o(from -90oto 90o, or from 0oto 180o, or from -180oto 0o, or from -180oto 180obased upon position of the target point), keeps changing when the AGV moves;

[0022] XT = Constant = length of the line segment XT, is the required transversal distance between the AGV and an operation point when it completes its movement;

[0023] β = Constant = Angle XOT at operation point 2, is the angle for specifying position when the AGV completes its movement;

[0024] When the AGV starts moving, due to normal operation points being provided on almost a straight line , the laser head only needs to scan an angle of small value α to approach the normal operation point 2 at T, without use of other auxiliary equipment such as reflecting mirror, magnetic point, QR code, GPS device, 360omap, etc. as described in prior art. Due to distance between operation points not changing much and most of the next operation points being the closest as well, the AGV can determine the target point by limiting the scanning distance. While moving, the angle α is variable but XT is constant. By scanning continuously with laser on the basis of the line segment OT, the AGV navigates with the following equation:

[0025] αo= arcsin (XT / OT), wherein αois standard angle which is precalculated at each position of the AGV on the correct path, XT is a preset constant and OT is the real distance from O to T (which changes real-time);

[0026] at each position on the path, the AGV compares α with αo:

[0027] if α ≠ αo: navigate to move straight forward;

[0028] if α = αo: move straight forward;

[0029] if α = β (angle XOT at target point, specifying position when the AGV completes its movement): stop.

[0030] According to an embodiment, if the transversal distance is calculated in case the target point is on the right of the moving path, then:

[0031] if α < αo: Navigate to the left;

[0032] if α = αo: Move straight forward;

[0033] if α > αo: Navigate to the right;

[0034] if α = β : Reach the target point, stop.

[0035] Another navigation equation according to the embodiment is illustrated in, wherein:

[0036] α = angle XOT, is the narrow scanning angle compared to the straight moving direction of the AGV, with a value of less than 360o(from -90oto 90o, or from 0oto 180o, or from -180oto 0o, or from -180oto 180obased upon position of the target point), keeps changing when the AGV moves;

[0037] XT = Constant = length of the line segment XT, is the required transversal distance between the AGV and an operation point when it completes its movement;

[0038] β = Constant = Angle XOT at operation point 2, is the angle for specifying position when the AGV completes its movement;

[0039] While moving, the angle α and the real transversal distance between the moving direction of the AGV and the target point are variable while the XT is constant. By scanning continuously with laser on the basis of the line segment OT, the AGV navigates with the following equation:

[0040] XTo= OT*(sinα), wherein XTois the real transversal distance between the moving direction of the AGV and the target point, α is the angle between the moving direction of the AGV and the line segment from O to T (which changes real-time) and OT is the real distance from O to T (which changes real-time);

[0041] at each position on the path, the AGV compares XTowith XT:

[0042] if XTo≠ XT: navigate to move straight forward;

[0043] if XTo= XTo: move straight forward;

[0044] if α = β: reach the target point, stop.

[0045] According to an embodiment, if the transversal distance is calculated in case the target point is on the right of the moving path, then:

[0046] if XTo< XT: Navigate to the left;

[0047] if XTo= XT: Move straight forward;

[0048] if XTo> XT: Navigate to the right;

[0049] if α = β : Reach the target point, stop.

[0050] The AGV can additionally navigate by other calculation methods but they are always based on the parameters comprising laser scanning angle, longitudinal distance from the AGV to operation point, transversal distance between the AGV and operation point when reaching the target point.

[0051] According to an embodiment as illustrated in, the AGV is at the special operation point where the AGV cannot move straight forward but it has to navigate to reach the next point, for example, when reaching the end of the queue, or changing to another queue, etc. In this case, the AGV is navigated with a guide bar provided above it, follows the guide bar to navigate to the left towards the next operation point. After navigating, the guide bar ends at E, herein the AGV repeats the navigation by the method illustrated in.

[0052] According to an embodiment as illustrated in, wherein the AGV is navigated with a guide bar above it. The laser is directed upward, scans the guide bar, and navigates:

[0053] if the laser’s deflection angle µ (the angle between upward direction and the laser when touching the guide bar) ≠ 0o: navigate to move straight forward;

[0054] if the laser has the deflection angle µ= 0o: Move straight forward;

[0055] According to an embodiment, if the transversal distance is calculated in case the target point is on the right of the moving path, then:

[0056] if the laser’s deflection angle µ < 0o: Navigate to the left;

[0057] if the laser has the deflection angle µ= 0o: Move straight forward;

[0058] if the laser’s deflection angle µ> 0o: Navigate to the right;

[0059] At special operation points the AGV can employ prior art to navigate to the next point such as by use of magnetic guide bars, magnetic points, line follower sensors, QR code, laser reflecting mirror, operational map, GPS, camera-map combo, etc.

[0060] To eliminate impact of unidentified objects, landmarks higher than these objects can be used at the operation points. The AGV navigates by following these landmarks.

[0061] This navigation method can be used at non-agricultural facilities such as factories, warehouse, supermarkets, service facilities, etc., if the operation points are provided suitably as required.

[0062] In fact, the inventor has used the methods described in this disclosure to navigate rubber tapping robot in the area of 1500 trees; each tree is 3m away from each other in the same queue, each queue is 3m away from each other.

Claims

A navigation method for automated guided vehicle, wherein when moving from the start to the finish, laser head of the AGV scans a narrow angle, from -90oto 90o,or from 0oto 180o, or from -180oto 0o, or from -180oto 180obased upon position of the target point, compared to moving straight forward to reach the target point and navigates based on parameters comprising laser scanning angle from the AGV to target point, longitudinal distance from the AGV to target point, transversal distance between the AGV and target point when reaching it.The navigation method of claim 1, wherein the AGV navigates with the following equation:αo= arcsin (XT / OT); is standard angle which is precalculated at each position of the AGV on the correct path, wherein:XT is the required transversal distance between the AGV and an operation point when it completes its movement;OT is the line segment from O (where laser head is provided on the AGV) to T (where the laser is in tangent with target point);OX concurs with the straight movement direction of the AGV (perpendicular to XT);α = angle XOT in real time, keeps changing when the AGV moves;at each position on the path, the AGV compares α with αo:if α ≠ αo: navigate to move straight forward;if α = αo: move straight forward;if α = β (angle XOT at target point, specifying position when the AGV completes its movement): stop.The navigation method of claim 1, wherein the AGV navigates with the following equation:XTo= OT*(sinα), is real transversal distance between the moving direction of the AGV and the target point, wherein:OT is the line segment from O (where laser head is provided on the AGV) to T (where the laser is in tangent with target point);α is the scanning angle between the moving direction of the AGV and OT;XT is the required transversal distance between the AGV and an operation point when it completes its movement;at each position on the path, the AGV compares XTowith XT :if XTo≠ XT: navigate to move straight forward;if XTo= XTo: move straight forward;if α = β: reach the target point, stop.The navigation method of claims 1, wherein the AGV can determine the target point for movement by limiting the scanning distance in a preset distance corresponding to the target point.The navigation method of claim 1, wherein to navigate to a direction which is different from the usual moving direction, the AGV is navigated by a guide bar above it, then the laser is directed upward, scans the guide bar, and navigates:if the laser’s deflection angle µ (the angle between upward direction and the laser when touching the guide bar) ≠ 0o: navigate to move straight forward;if the laser has the deflection angle µ= 0o: Move straight forward;after navigating (at the end of the guide bar) the AGV starts to repeat the navigation by the method illustrated in claim 1 and 2.The navigation method of claim 1, wherein to navigate to a direction which is different from the usual moving direction, the AGV can employ prior art to navigate such as by use of magnetic guide bars, magnetic points, line follower sensors, QR code, laser reflecting mirror, operational map, GPS, camera-map combo, etc., after navigating the AGV starts to repeat the navigation by the method illustrated in claim 1 and 2.The navigation method of claim 1, wherein it is possible to use other types of sensors to replace laser sensor, such as infra-red sensors, ultrasonic sensors, image sensors, magnetic sensors, etc.

Citation Information

Patent Citations

  • Electrical control method and control device for a three-way forward-moving navigation switching AGV forklift

    CN109144068B

  • A navigation system and method for a laser-guided forklift

    CN112125224B

  • On-vehicle navigation system

    JP2005114565A

  • Navigator, and its control program and control method

    JP2009128347A