AGV pose determination method and device and storage medium

By calculating the weight of particles in combination with the matching rates of the first and second types of obstacles, the AGV positioning drift problem is solved, the stability and accuracy of positioning are improved, and the positioning error is reduced.

CN118913240APending Publication Date: 2024-11-08ZTE CORP

Patent Information

Application Number
CN202310515390.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-05-08
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

Traditional AGV positioning methods are prone to positioning drift in scenarios with fewer obstacles, resulting in an increase in cumulative positioning error and a decrease in positioning accuracy.

Method used

A method of AGV position determination is adopted, combining the matching rates of the first and second types of obstacles. The second type of obstacle is an object with a highly reflective material, which is used to calculate the weight of the particles, thereby updating the estimated position of the AGV. posture.

Benefits of technology

In scenarios with fewer obstacles, the stability and accuracy of positioning are greatly enhanced, the positioning error is reduced, and more stable and robust positioning results are obtained.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118913240A_ABST
    Figure CN118913240A_ABST
Patent Text Reader

Abstract

The invention discloses an AGV pose determination method and device and a storage medium, relates to the technical field of positioning, and can reduce positioning errors and obtain a more stable and robust positioning result. The method comprises the following steps: acquiring an estimated pose of an AGV and a pose of at least one particle; acquiring measurement data such as distance and angle from the sensor to the obstacle; the obstacles comprise a first type of obstacles and a second type of obstacles with reflective materials; calculating coordinates, mapped to a map, of the first type of obstacles and the second type of obstacles scanned by the measurement data under the pose of the at least one particle; the coordinates of the first type of obstacles and the second type of obstacles are matched with coordinates of obstacles preset on a map, and a first matching rate and a second matching rate are obtained; calculating weights of the particles based on the first matching rate and the second matching rate; and updating the estimated pose of the AGV based on the weight and pose of the at least one particle.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of positioning technology, and in particular to an AGV posture determination method, device and storage medium. Background Art

[0002] Automated guided vehicles (AGVs) are commonly used in warehousing and logistics environments. They are equipped with electromagnetic or optical automatic guidance sensors, can travel along a specified guidance path, and have safety protection and transfer functions. The most commonly used positioning technology for AGV autonomous navigation is simultaneous localization and mapping (SLAM) technology. The use scenario of this technology requires a large number of fixed obstacles with obvious texture features to accurately estimate the position and posture of the AGV. However, in real scenarios (such as factories), most objects are dynamic objects, and the environment is empty and cluttered, making it difficult to provide a stable positioning environment for AGVs.

[0003] The method commonly used in traditional technology is a positioning method based on particle filtering. The principle of this method is to use the postures of multiple particles as candidate postures of AGV, and use the laser radar data of AGV to map the contours of multiple obstacles in the map under the postures of multiple particles. The contour coordinates of multiple obstacles are matched with the preset obstacle contour coordinates in the map, and the contour coordinates with higher matching values ​​are selected. After comprehensive calculation of the postures of the particles corresponding to the contour coordinates with higher matching values, the posture of the AGV is obtained. This method only considers the matching rate between the mapped contour of each particle in the map and the obstacle. When there are fewer obstacles in the scene, positioning drift is prone to occur, resulting in increasing cumulative positioning errors and reduced positioning accuracy. Summary of the invention

[0004] The embodiments of the present application provide an AGV posture determination method, device and storage medium, which can reduce positioning errors and obtain more stable and robust positioning results.

[0005] On the one hand, a method for determining an AGV posture is provided, comprising: obtaining an estimated posture of an AGV and a posture of at least one particle; the particle is a random sample used to characterize the AGV; obtaining measurement data of a sensor; the measurement data comprises: a distance and an angle from a sensor to an obstacle scanned by the sensor; the obstacle comprises a first type of obstacle and a second type of obstacle; the second type of obstacle is an object with a reflective material; calculating coordinates of the obstacle scanned by the sensor mapped to a map under the posture of the particle under the measurement data; wherein the coordinates of the obstacle scanned by the sensor mapped to the map comprise a first coordinate of the first type of obstacle mapped to the map, and a second coordinate of the second type of obstacle mapped to the map; matching the first coordinate and the second coordinate with the coordinates of an obstacle preset on the map, respectively, to obtain a first matching rate and a second matching rate corresponding to the particle; wherein the first matching rate is a matching rate obtained by matching the first coordinate with the coordinates of the first type of obstacle preset on the map; and the second matching rate is a matching rate obtained by matching the second coordinate with the coordinates of the second type of obstacle preset on the map; calculating the weight of the particle based on the first matching rate and the second matching rate corresponding to the particle; and updating the estimated posture of the AGV based on the weight and posture of at least one particle.

[0006] On the other hand, an AGV posture determination device is provided, comprising: an acquisition unit, used to acquire the estimated posture of the AGV and the posture of at least one particle; the posture of the particle is a random sample used to characterize the posture of the AGV; obtain measurement data of the sensor; the measurement data includes: the distance and angle from the sensor to the obstacle scanned by the sensor; the obstacle includes a first type of obstacle and a second type of obstacle; the second type of obstacle is an object with a reflective material; a calculation unit, used to calculate the coordinates of the obstacle scanned by the sensor mapped to the map under the posture of the particle; wherein the coordinates of the obstacle scanned by the sensor mapped to the map include the first type of obstacle mapped to the map a first coordinate, and a second coordinate of the second type of obstacle mapped to the map; a matching unit, matching the first coordinate and the second coordinate with the coordinates of the obstacle preset on the map respectively, to obtain a first matching rate and a second matching rate corresponding to the particle; wherein the first matching rate is a matching rate obtained by matching the first coordinate with the coordinates of the first type of obstacle preset on the map; the second matching rate is a matching rate obtained by matching the second coordinate with the coordinates of the second type of obstacle preset on the map; the calculation unit is also used to calculate the weight of the particle based on the first matching rate and the second matching rate corresponding to the particle; the updating unit is used to update the estimated posture based on the weight and posture of at least one particle.

[0007] On the other hand, an AGV posture determination device is provided, comprising: a memory and a processor; the memory and the processor are coupled; the memory is used to store a computer program; and the processor implements the AGV posture determination method of any of the above embodiments when executing the computer program.

[0008] On the other hand, a computer-readable storage medium is provided, on which computer program instructions are stored. When the computer program instructions are executed by a processor, the AGV posture determination method described in any of the above embodiments is implemented.

[0009] On the other hand, a computer program product is provided, which includes computer program instructions, and when the computer program instructions are executed by a processor, the AGV posture determination method described in any of the above embodiments is implemented.

[0010] In the embodiment of the present application, when calculating the weight of each particle, the matching rate of the first type of obstacles and the second type of obstacles is comprehensively considered. The second type of obstacles are objects made of highly reflective materials, which can greatly enhance the stability and accuracy of positioning in scenes with few first type of obstacles. Therefore, the present application combines the two types of obstacles to reduce positioning errors and obtain more stable and robust positioning results. BRIEF DESCRIPTION OF THE DRAWINGS

[0011] In order to more clearly illustrate the technical solution in the present application, the drawings required for use in some embodiments of the present application will be briefly introduced below. Obviously, the drawings described below are only drawings of some embodiments of the present application. For ordinary technicians in this field, other drawings can also be obtained based on these drawings.

[0012] Figure 1 A schematic diagram of an AGV posture determination device involved in an AGV posture determination method provided in an embodiment of the present application;

[0013] Figure 2 A flowchart of a method for determining an AGV posture provided in some embodiments of the present application;

[0014] Figure 3 A schematic diagram of a driving scenario of an AGV provided in some embodiments of the present application;

[0015] Figure 4 A schematic diagram of another AGV driving scenario provided in some embodiments of the present application;

[0016] Figure 5 A schematic diagram of a scanned map provided for some embodiments of the present application;

[0017] Figure 6 Another schematic diagram of scanning a map provided for some embodiments of the present application;

[0018] Figure 7 A schematic diagram of a grid map provided for some embodiments of the present application;

[0019] Figure 8A flowchart for determining obstacles provided in some embodiments of the present application;

[0020] Fig. 9 A schematic diagram of the structure of an AGV posture determination device provided in some embodiments of the present application. DETAILED DESCRIPTION

[0021] The following will be combined with the drawings in this application to clearly and completely describe the technical solutions in this application. Obviously, the described embodiments are only part of the embodiments of this application, not all of them. Based on the embodiments in this application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.

[0022] It should be noted that, in this application, words such as "exemplary" or "for example" are used to indicate examples, illustrations or descriptions. Any embodiment or design described as "exemplary" or "for example" in this application should not be interpreted as being more preferred or more advantageous than other embodiments or designs. Specifically, the use of words such as "exemplary" or "for example" is intended to present related concepts in a specific way.

[0023] In the following, the terms "first" and "second" are used for descriptive purposes only and are not to be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Thus, a feature defined as "first" or "second" may explicitly or implicitly include one or more of the features.

[0024] In the description of this application, unless otherwise specified, " / " means "or", for example, A / B can mean A or B. "And / or" in this article is only a description of the association relationship of associated objects, indicating that there can be three relationships. For example, A and / or B can mean: A exists alone, A and B exist at the same time, and B exists alone. In addition, "at least one" means one or more, and "multiple" means two or more.

[0025] The AGV positioning method commonly used in traditional technology is a positioning method based on particle filtering. The principle of this method is to use the postures of multiple particles as candidate postures of AGV, and use the AGV's LiDAR data to map the contours of multiple obstacles in the map under the posture of each particle, match the contour coordinates of multiple obstacles with the preset obstacle contour coordinates in the map, select the contour coordinates with higher matching values, and calculate the postures of the particles corresponding to the contour coordinates with higher matching values ​​to obtain the posture of the AGV. This method only considers the matching rate between the mapped contour of each particle in the map and the obstacle. When there are fewer obstacles in the scene, positioning drift is prone to occur, resulting in increasing cumulative positioning errors and reduced positioning accuracy.

[0026] Based on this, the present application proposes a method for determining the posture of an AGV. In this method, in addition to the first type of obstacles (such as walls) in the scene where the AGV is traveling, the second type of obstacles (such as reflectors) are also deployed. Under the posture of each particle, the first type of obstacles and the second type of obstacles scanned by the sensor are mapped to the map, and the matching rate of the first type of obstacles and the second type of obstacles after being mapped to the map with the first type of obstacles and the second type of obstacles preset in the map is calculated, so as to calculate the weight of each particle and then determine the posture of the AGV. It can be understood that in this method, when calculating the weight of each particle, the matching rate of the first type of obstacles and the second type of obstacles is comprehensively considered. The second type of obstacles are objects with highly reflective materials, which can greatly enhance the stability and accuracy of positioning in scenes with few first type of obstacles. Therefore, the present application combines the two types of obstacles to reduce the positioning error and obtain a more stable and robust positioning result.

[0027] The implementation of the embodiments of the present application will be described in detail below with reference to the accompanying drawings.

[0028] Please refer to Figure 1 , which shows an AGV posture determination device involved in an AGV posture determination method provided in an embodiment of the present application.

[0029] The AGV posture determination device 100 includes: a processor 101 , a bus 102 , a memory 103 and a communication interface 104 .

[0030] The processor 101 may be a processor that implements or executes various exemplary logic blocks, modules, and circuits described in conjunction with the embodiments of the present application. The processor 101 may be a central processing unit, a general-purpose processor, a digital signal processor, an application-specific integrated circuit, a field programmable gate array, or other programmable logic devices, transistor logic devices, hardware components, or any combination thereof. It may implement or execute various exemplary logic blocks, modules, and circuits described in conjunction with the embodiments of the present application. The processor 101 may also be a combination that implements computing functions, such as a combination of one or more microprocessors, a combination of a DSP and a microprocessor, and the like.

[0031] The bus 102 may be an extended industry standard architecture (EISA) bus, etc. The bus 102 may be divided into an address bus, a data bus, a control bus, etc. For ease of representation, Figure 1 Only one thick line is used in the diagram, but this does not mean that there is only one bus or only one type of bus.

[0032] The memory 103 may be a read-only memory (ROM) or other types of static storage devices that can store static information and instructions, a random access memory (RAM) or other types of dynamic storage devices that can store information and instructions, or an electrically erasable programmable read-only memory (EEPROM), a disk storage medium or other magnetic storage device, or any other medium that can be used to carry or store desired program code in the form of instructions or data structures and can be accessed by a computer, but is not limited thereto.

[0033] As a possible implementation, the memory 103 can exist independently of the processor 101, and the memory 103 can be connected to the processor 101 via the bus 102 to store instructions or program codes. When the processor 101 calls and executes the instructions or program codes stored in the memory 103, the AGV posture determination method provided in the embodiment of the present application can be implemented.

[0034] In another possible implementation, the memory 103 may also be integrated with the processor 101 .

[0035] The communication interface 104 is used to connect with other devices via a communication network, such as Ethernet, wireless access network, wireless local area network (WLAN), etc.

[0036] The AGV posture determination device 100 can be the AGV itself, or other devices that communicate with the AGV, such as a terminal such as a mobile phone, a tablet computer, a desktop, a laptop, a notebook computer, a netbook, etc., or a server. The embodiment of the present application does not impose any special restrictions on the specific form of the AGV posture determination device 100.

[0037] When the AGV posture determination device 100 is the AGV itself, the AGV posture determination device 100 further includes: a sensor 105 .

[0038] The sensor 105 is an electromagnetic or optical sensor, which is used by the AGV to obtain the position of obstacles scanned in the environment and the light intensity information of the scanned obstacles, and is used to estimate the AGV posture.

[0039] Exemplarily, the sensor 105 may include one or more of a laser radar, a wheel encoder, an inertial measurement unit (IMU), a camera, a magnetic medium, and a global positioning system (GPS).

[0040] Generally, the combined use of the above sensors can improve the accuracy of AGV posture estimation.

[0041] The following is an explanation of the AGV posture determination method provided in the embodiment of the present application:

[0042] Please refer to Figure 2 , which is a flow chart of a method for determining an AGV posture provided in an embodiment of the present application. Figure 1 The AGV posture determination device in the following is described by taking the AGV posture determination device as an example. Figure 2 As shown, the method may include S101-S112.

[0043] S101: AGV performs map initialization.

[0044] AGV map initialization includes S101a-S101c:

[0045] S101a: The AGV scans the AGV driving scene and creates a scan map.

[0046] The AGV driving scene may include indoor or outdoor sites, such as a factory or a road. The driving scene includes first-class obstacles and second-class obstacles.

[0047] The first type of obstacles are generally fixed obstacles in the driving scene, including walls, support columns, and large cabinets.

[0048] The second type of obstacles are objects with reflective materials arranged in the AGV driving scene, including but not limited to: reflective plates or reflective columns.

[0049] In some embodiments of the present application, the second type of obstacles are arranged in an area where the space occupied by the first type of obstacles in the AGV driving scene is less than a preset percentage, for example, an area where the space occupied by the first type of obstacles is less than 30%.

[0050] In one example, if Figure 3 In the driving scenario of the AGV shown in FIG, in an area where the space occupied by the first type of obstacle (wall) is less than 30%, such as an empty route, the second type of obstacle is deployed on one side, or Figure 4 In the AGV driving scenario shown above, the second type of obstacles are deployed on both sides of the open route. Figure 3 and Figure 4 If the second type of obstacle is a reflective column, the diameter is generally about 10 cm, and the deployment interval is generally about 5 meters to 10 meters. Figure 3 and Figure 4 5 meters is used as an example for explanation.

[0051] In the traditional method of using only the second type of obstacles to determine the AGV's posture, the deployment requirements for the second type of obstacles are relatively high. The AGV needs to be able to identify three or more second type obstacles at each position and viewing angle in the operating area, and the distance between each second type of obstacles must be no less than 1 meter. When the second type of obstacles are deployed on both sides of a straight path, the positions of the second type of obstacles cannot be symmetrical, the number cannot be the same, and the spacing is not equal. In the embodiment of the present application, since the first type of obstacles and the second type of obstacles are used in combination, the deployment of the second type of obstacles in the embodiment of the present application has no special requirements for the deployment position, quantity, etc. compared to the traditional method that only relies on the second type of obstacles, and the deployment conditions are freer and simpler.

[0052] The scanned map is a map generated by the AGV after scanning the AGV driving scene through sensors, such as a SLAM map.

[0053] In one example, the method for establishing a scanning map for an AGV includes: the AGV moves in the driving scene of the AGV under manual control or automatically according to a preset route, and at the same time uses Google's open source algorithm cartographer to scan the first type of obstacles and the second type of obstacles (such as reflective columns) in the driving scene into the map through sensors to generate a scanning map.

[0054] like Figure 5 As shown, Figure 5 A schematic diagram of a scanned map is shown. Figure 5 Yes Figure 3 The scanned map is obtained after scanning the AGV driving scene. Figure 1 It is generally a grayscale image, where obstacles are black, feasible areas are white, and unknowns (such as noise) are gray. To distinguish the second type of obstacles, the second type of obstacles can be marked with a different logo from the first type of obstacles. For example, the second type of obstacles can be marked in orange, corresponding to Figure 6 After marking the second type of obstacles in the scan map, black indicates the first type of obstacles, orange indicates the second type of obstacles, gray indicates unknown, and white indicates feasible areas.

[0055] S101b: The AGV converts the scanned map into a raster map.

[0056] A raster map is a map obtained by dividing a scanned map into units. The resolution of the x-axis and y-axis is used as the size of a single grid. When the x-axis resolution is equal to the y-axis resolution, each grid is a square. The smaller the resolution, the higher the accuracy of the raster map. The raster map is consistent with the scanned map in terms of content, geometric accuracy and color.

[0057] like Figure 7 As shown, Figure 7 Show Figure 6 The schematic diagram of the scanned map converted to a raster map is shown. Different types of obstacles are marked with different signs in the raster map. For example, black in the raster map indicates the first type of obstacle, and orange indicates the second type of obstacle.

[0058] The grids with the first type of obstacle marks are defined as the first type of grids, and the grids with the second type of obstacle marks are defined as the second type of grids. For example, the black grids in the grid map are the first type of grids, and the orange grids are the second type of grids.

[0059] Since raster maps are easy to construct, represent and save, the position of each grid is unique, and it is convenient to plan short paths, the scanned map is converted into a raster map and then processed subsequently in the embodiment of the present application, which can improve the calculation speed of AGV posture determination.

[0060] The above-mentioned conversion of the scanned map into a raster map is only a specific implementation method, and the embodiment of the present application does not limit which specific map is used for processing.

[0061] S101c: The AGV calculates and stores the distance between each grid in the grid map and the grid of the first type closest to the grid, and the distance between each grid and the grid of the second type closest to the grid.

[0062] In a possible implementation, a method for calculating the distance between each grid and the nearest grid of the first type, and the distance between each grid and the nearest grid of the second type is proposed below.

[0063] Let the grid map be m, and the coordinates of the i-th grid on the grid map be m i (x i ,y i ) characterization, for example, m i (1, 2) indicates that the grid is located in the first column on the x-axis and the second row on the y-axis of the grid map. The distance between each grid and the nearest grid of the first type is calculated by formula (1), and the distance between each grid and the nearest grid of the second type is calculated by formula (2).

[0064]

[0065] (x jocc ,yjocc ) represents the jth first-class grid, d cell,occ_max It is the maximum distance between the preset grid and the first type of obstacle.

[0066]

[0067] (x jref ,y jref ) represents the jth second-class grid, d cell,ref_max It is the maximum distance between the preset grid and the second type of obstacle.

[0068] In this step, the distance between each grid in the grid map and the nearest first and second obstacles is calculated in advance. When matching is performed subsequently, the distance is directly used to increase the matching calculation speed and improve the efficiency of AGV posture determination.

[0069] S102: AGV positioning initialization, presetting at least one particle.

[0070] Positioning initialization, that is, the AGV obtains the initial position and posture. In this step, the initial position and posture of the AGV relative to the map can be manually given to complete the positioning initialization.

[0071] Particles are random samples that represent AGVs. Generally, when AGV selects particles, it will select the poses of multiple particles as candidate poses to improve the accuracy of AGV pose determination.

[0072] Multiple particles are preset, that is, multiple pose points are randomly selected as particles near the initialization position of the AGV, and the pose of each particle represents the candidate pose of the AGV.

[0073] S103: After the AGV travels a certain distance in the above driving scene, an estimated position and posture of the AGV is obtained.

[0074] A distance can be a distance that the AGV travels along a preset path in the above driving scenario, or a distance that the AGV travels freely.

[0075] The estimated posture is generally based on the sensor measurement data on the AGV, such as lidar, wheel encoder and / or IMU, which estimates the posture of the AGV after traveling a certain distance.

[0076] S104: The AGV determines whether a change between the estimated posture and the AGV posture at the previous moment is greater than a posture threshold.

[0077] When the estimated posture change of the AGV is greater than the posture threshold, execute S105;

[0078] When the estimated posture change of the AGV is less than or equal to the posture threshold, S112 is executed.

[0079] The AGV posture at the last moment is the posture output by the AGV last time, such as the posture of positioning initialization, or the posture output after the estimated posture was obtained last time, or the posture output after the estimated posture was updated last time.

[0080] The AGV can be set to output a position every preset time period, or output a position every preset distance. For example, the AGV outputs a position every 5 seconds, or outputs a position every 1 meter.

[0081] In one example, the AGV outputs a posture every 5 seconds, and the posture threshold is set to a travel distance of 1 meter and a travel direction angle change of plus or minus 10 degrees. When the estimated posture of the AGV is compared with the posture output by the AGV 5 seconds ago, the travel distance exceeds 1 meter, and the travel direction angle changes by more than plus or minus 10 degrees, then it is considered that the estimated posture change of the AGV is greater than the posture threshold.

[0082] In this step, after the AGV has traveled a certain distance, it will determine whether the change between the estimated posture and the posture at the previous moment is greater than the threshold. If it is greater than the threshold, it is considered that the estimated posture may have a deviation and the deviation is large. At this time, the deviation needs to be corrected and the corrected AGV posture is used as the current AGV posture. If it is less than or equal to the threshold, it is considered that the estimated posture deviation is small, and the estimated AGV posture can be directly used as the current AGV posture.

[0083] S105: The AGV obtains the position and posture of at least one particle.

[0084] Specifically, the AGV performs at least one particle motion update and obtains at least one particle motion updated posture.

[0085] Particle motion update can be understood as updating particle posture. The updated particle posture is determined based on the estimated posture of the AGV. The particle moves the same distance as the AGV moves, that is, the particle moves with the movement of the AGV.

[0086] In one example, the AGV moves from a first position to a second position, and the particles around the first position also move to the second position accordingly. The AGV obtains the positions and postures of the multiple particles around the second position.

[0087] Since at least one particle is preset in S102, the posture of the at least one particle is a candidate posture of the AGV, when the AGV travels a distance in S103, the posture of the at least one particle needs to be updated based on the change of the AGV posture. That is, the AGV performs motion update on the at least one particle and obtains the updated posture of the at least one particle.

[0088] S106: The AGV obtains sensor measurement data.

[0089] The sensor measurement data includes: the distance and angle between the sensor and the obstacle scanned by the sensor. The obstacles include the first type of obstacles and the second type of obstacles.

[0090] The distance and angle from the sensor to the obstacle scanned by the sensor include: the distance and angle from each scanning point of the sensor to the obstacle scanned by the sensor. The scanning point is the point on the obstacle when the sensor scans the obstacle.

[0091] S107: The AGV calculates the measurement data and maps the obstacles scanned by the sensor under the particle's position to the coordinates of the map.

[0092] The coordinates of the obstacles scanned by the sensor and mapped to the map include first coordinates of the first type of obstacles mapped to the map, and second coordinates of the second type of obstacles mapped to the map.

[0093] The above-mentioned particle is any one of the at least one particle.

[0094] Calculating the coordinates of the obstacle scanned by the sensor and mapped to the map includes: calculating the coordinates of the obstacle scanned by each scanning point of the sensor and mapped to the map.

[0095] In one possible implementation, let the position of a particle at time t be x t =(x yθ) T , the coordinates of the sensor relative to the AGV are (x k,sens ,y k,sens ) T , using θ k,sens Represents the angle of the sensor relative to the driving direction of the AGV. Based on the above data, the kth scanning point z of the sensor is k Under the particle posture, it is mapped to the map m, and the k-th scanning point z is calculated by formula (3): k Mapped to the coordinates of map m:

[0096]

[0097] Above Includes the distance and angle from the kth scanning point to the obstacle scanned by the sensor.

[0098] Based on the coordinates of the obstacle scanned by each scanning point of the sensor mapped to the map, the coordinates of the obstacle scanned by the sensor mapped to the map can be obtained.

[0099] S108: The AGV classifies obstacles scanned by the sensor into first-category obstacles and second-category obstacles.

[0100] The distinguishing method includes: the AGV determines whether the scanning point falls on the second type of obstacle, so as to distinguish the obstacles scanned by the sensor.

[0101] In the case where the scanning point meets the preset condition, it is determined that the sensor scanning point falls on the second type of obstacle, otherwise it falls on the first type of obstacle.

[0102] If the sensor includes a laser radar, the sensor measurement data also includes the light intensity of the scanning point. In this case, the preset condition includes at least one of the following:

[0103] The light intensity at the scanning point is greater than the light intensity threshold;

[0104] The distance from the scanning point to the sensor is less than the distance threshold;

[0105] The scanning point is mapped to the grid in the grid map, and the distance of the second-type grid closest to the grid mapped to the grid map is less than the grid distance threshold; the second-type grid is a grid containing the identification of the second-type obstacle.

[0106] Generally, when the above preset conditions are met at the same time, the result of distinguishing the first type of obstacles from the second type of obstacles is most accurate.

[0107] Based on the above preset conditions, the AGV scans the kth scanning point z of the sensor in turn. k Make judgments, such as Figure 8 As shown, the judging step includes S108a-S108d.

[0108] S108a: The AGV determines whether the grid map includes the second type of grid.

[0109] If yes, execute S108b;

[0110] If not, it is determined that the kth scanning point falls on the first type of obstacle, and the subsequent S108b-S108d are not executed.

[0111] Since the grid containing the mark of the second type of obstacle is the second type of grid, if the mark of the second type of obstacle is orange, it is verified whether the grid map contains orange grids. If it contains orange grids, it indicates that the grid map includes the second type of grids. At this time, S108b can be continued to be executed. Otherwise, it indicates that the grid map does not include the second type of grids, and no second type of obstacles are deployed in the AGV driving environment. At this time, there is no need to distinguish the obstacles, and the subsequent S108b-S108d are not executed.

[0112] S108b: The AGV determines whether the light intensity at the scanning point is greater than a light intensity threshold.

[0113] Assume the light intensity at the scanning point is The light intensity threshold is I min ,like If the k-th scanning point is located on an obstacle of the first category, it is considered that the obstacle scanned by the scanning point is a second category obstacle; otherwise, it is determined that the k-th scanning point falls on a first category obstacle, and subsequent S108c-S108d are not executed.

[0114] When the sensor is a laser radar, the reflection effect of the laser radar on reflective materials of different materials varies. The light intensity reflected by the laser beams emitted by laser radars of different brands and models when scanning the scanning points of the same reflective material is different. The sizes are also different, so the light intensity can be used to determine whether the scanning point falls on the second type of obstacle.

[0115] The embodiment of the present application can effectively distinguish whether the scanning point falls on the second type of obstacle or the first type of obstacle by judging the light intensity of the scanning point.

[0116] S108c: The AGV determines whether the distance between the scanning point and the laser radar is less than the light intensity point distance threshold.

[0117] The light intensity point distance threshold is the maximum effective distance that the laser radar scans to the reflective material.

[0118] Assume the distance between the scanning point and the laser radar is d I , the light intensity point distance threshold is d Imax , if d I <d Imax , then the obstacle scanned by the scanning point is considered to be a second-category obstacle; otherwise, it is determined that the k-th scanning point falls on the first-category obstacle, and the subsequent S108d is not executed.

[0119] The maximum effective distance that different brands and models of laser radars can scan for different reflective materials is generally 6 to 10 meters. If it exceeds this value, it indicates that the distance between the scanning point and the laser radar may be abnormal. Imax The value of is generally based on the specific settings of different lidars.

[0120] S108d: The AGV determines whether the distance between the scanning point mapped to the grid in the grid map and the second-type grid closest to the grid is less than the grid distance threshold.

[0121] The above grid distance threshold is the preset maximum distance from the second type of obstacle.

[0122] Given the coordinates of the scan point mapped to the grid map, since the distance between each grid and the second type of grid has been calculated in S101c, the distance between the grid after the scan point is mapped to the grid map and the second type of grid is d cell,ref , if d cell,ref <d cell,ref_max, then the obstacle scanned by the scanning point is considered to be the second type of obstacle; otherwise, it is determined that the kth scanning point falls on the first type of obstacle.

[0123] Since the first type of obstacles may include objects with reflective materials (for example, metal aluminum plates), in order to avoid interference from the scanning points verified by S108b to S108c above being objects with reflective materials included in the first type of obstacles, this step further eliminates interference from the presence of reflective materials in the first type of obstacles by checking whether the distance from the second type of grid is less than the preset maximum distance from the second type of obstacles after the scanning points are mapped on the grid map.

[0124] In the above S108a-S108d, each parameter can be pre-set in the AGV before S102. In one example, taking the sensor as a SICK laser radar, the light intensity threshold is set to I min is 240, and the light intensity point distance threshold is d Imax is 8 meters.

[0125] When the scanning point satisfies all conditions after completing the above S108a-S108d verification process, it is considered that the scanning point is a scanning point that falls on the second type of obstacle. The present embodiment of the application does not limit the order of the above verification process S108a-S108d. Generally, the verification process in the above order does not need to execute the remaining process after the scanning point does not meet any one of the conditions, thereby saving computing resources.

[0126] S109: The AGV matches the first coordinate and the second coordinate with the coordinates of the obstacle preset on the map respectively, and obtains a first matching rate and a second matching rate corresponding to the particle.

[0127] The first matching rate is the matching rate obtained by matching the first coordinate with the coordinates of the first type of obstacle preset on the map; the second matching rate is the matching rate obtained by matching the second coordinate with the coordinates of the second type of obstacle preset on the map.

[0128] Specifically, when the sensor scanning point is on the first type of obstacle, the AGV maps each scanning point scanned by the sensor to the first type of obstacle to the grid of the grid map and matches it with the first type of grid preset on the grid map to obtain the matching rate of each scanning point scanned by the sensor to the first type of obstacle.

[0129] The first matching rate is equal to the product of the matching rates of each scanning point scanned by the sensor to the first type of obstacle.

[0130] The following is for the kth scanning point z k The calculation method of the matching rate when falling on the first type of obstacles is explained in detail:

[0131] Based on the idea of ​​likelihood domain model, the k-th scanning point z is obtained through the Gaussian distribution model and random noise model in formula (4): k Map to raster map match rate:

[0132]

[0133] The above formula (4) is a measurement model for the scanning point falling on the first type of obstacle. Based on this model, the matching rate of the scanning point can be obtained, which can also be called the probability that the scanning point is mapped on the first type of obstacle.

[0134] When the sensor scanning point falls on the second type of obstacle, the AGV maps each scanning point scanned by the sensor to the second type of obstacle to the grid of the grid map and matches it with the second type of grid preset on the grid map to obtain the matching rate of each scanning point scanned by the sensor to the second type of obstacle.

[0135] The second matching rate is equal to the product of the matching rates of each scanning point scanned by the sensor to the second type of obstacle.

[0136] The following is for the kth scanning point z k The calculation method of the matching rate when falling on the second type of obstacles is specifically described as follows:

[0137] In the case where the second type of obstacle is a reflective column, since the sensor scans the surface of the reflective column, in order to improve the accuracy of the matching rate, it is necessary to scan the scanning point z k The distance to the sensor is compensated by measuring the scanning point z k The distance to the sensor plus the radius of the reflector.

[0138] Set scanning point z k Distance to sensor The diameter of the reflective column is d ref , then the scan point z after compensation k The distance to the sensor is

[0139] Based on the idea of ​​likelihood domain model, the k-th scanning point z is obtained through the Gaussian distribution model and random noise model in formula (5): k Map to raster map match rate:

[0140]

[0141] The above formula (5) is a measurement model for the scanning point falling on the second type of obstacle. Based on this model, the matching rate of the scanning point can be obtained, which can also be called the probability that the scanning point is mapped on the second type of obstacle.

[0142] S110: The AGV calculates the weight of the particle based on the first matching rate and the second matching rate corresponding to the particle.

[0143] In a possible implementation, the first matching rate, the weighting coefficient of the first matching rate, the second matching rate, and the weighting coefficient of the second matching rate are multiplied to obtain the weight of the particle, wherein the weighting coefficient of the first matching rate is smaller than the weighting coefficient of the second matching rate.

[0144] The weighting coefficient of the first matching rate may be set to a fixed value, such as 1.

[0145] The weighted coefficient of the second matching rate is related to the target distance; the smaller the target distance, the higher the weighted coefficient of the second matching rate; the target distance is the distance of the scan point falling on the second type of obstacle mapped to the target coordinates on the map and the second type of obstacle closest to the target coordinates.

[0146] For the kth scanning point z k , when the kth scanning point falls on the first type of obstacle, the confidence of the kth scanning point zk,

[0147] For the kth scanning point z k , when the kth scanning point falls on the second type of obstacle, the weight coefficient of the kth scanning point is calculated by formula (6)

[0148]

[0149] The above ref It is the confidence coefficient set for the second type of obstacles. The setting of this coefficient value is determined by experience and is generally greater than or equal to 1.

[0150] The k-th scanning point z k The matching rate and weighted coefficient of the k-th scanning point z are calculated by formula (7): k Confidence of:

[0151]

[0152] From the above formula, it can be seen that the closer the scanning point is to the second type of obstacle, the higher the confidence coefficient is, and the higher the confidence is. This shows that the closer the scanning point is to the second type of obstacle, the more reference value the position of the scanning point has.

[0153] From the above process, we can see that if the weight of each particle is w, the weight of each particle is obtained by formula (8):

[0154]

[0155] It can be seen from the above formula (8) that the weight of each particle is obtained by multiplying the confidence of each scanning point of the sensor under the position and posture of the particle.

[0156] In an example, assuming there are 100 scanning points, 1 to 30 are scanning points that fall on the first type of obstacles, and 31 to 100 are scanning points that fall on the second type of obstacles, then the weight of a particle is:

[0157]

[0158] It can be understood that the weight of each particle is related to each scanning point. When a weighting coefficient is set for the scanning point falling on the second obstacle to determine the confidence of the scanning point, the weight of the particle can be determined more accurately, providing more valuable particles for the subsequent determination of the AGV posture.

[0159] S111: The AGV updates an estimated posture of the AGV based on the weight and posture of at least one particle.

[0160] In one possible implementation, the AGV performs a clustering algorithm on the particles based on the poses of multiple particles, selects a portion of particles with higher weights, takes an average of the poses of these particles, and uses the average to update the estimated pose of the AGV.

[0161] S112: The AGV outputs the AGV posture.

[0162] In this step, the AGV outputs the pose as the estimated pose in S103 or the updated estimated pose in S111.

[0163] In a method for determining the posture of an AGV proposed in the present application, since the estimated posture of the AGV may drift after traveling a certain distance, in order to update the estimated posture and make its output posture more accurate, multiple postures are selected around the estimated posture of the AGV as the candidate postures of the AGV, that is, the postures of multiple particles are selected as the candidate postures of the AGV. Under the posture of each particle, the matching rate of the first and second obstacles scanned by the sensor after being mapped to the map and the first and second obstacles preset in the map is calculated, and the weight of each particle is determined based on the matching rate, thereby determining the posture of the AGV. It can be understood that the higher the weight of the particle, the closer the posture of the particle is to the actual posture of the AGV. In the present application, when calculating the particle weight, the matching rate of the first and second obstacles is comprehensively considered, which can reduce the positioning error and obtain a more stable and robust positioning result.

[0164] It is understandable that, in order to realize the above functions, the AGV posture determination device includes hardware structures and / or software modules corresponding to the execution of each function. Those skilled in the art should easily realize that, in combination with the algorithm steps of each example described in the embodiments of the present application, the present application can be implemented in the form of hardware or a combination of hardware and computer software. Whether a function is executed in the form of hardware or computer software driving hardware depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of this application.

[0165] The embodiment of the present application can divide the functional modules of the AGV posture determination device according to the above-mentioned method embodiment. For example, each functional module can be divided corresponding to each function, or two or more functions can be integrated into one functional module. The above-mentioned integrated module can be implemented in the form of hardware or software. It should be noted that the division of modules in the embodiment of the present application is schematic and is only a logical function division. There may be other division methods in actual implementation. The following is an example of dividing each functional module corresponding to each function.

[0166] Fig. 9 : is a schematic diagram of the structure of an AGV posture determination device provided in an embodiment of the present application. The AGV posture determination device can execute the AGV posture determination method provided in the above method embodiment. Fig. 9 As shown, the AGV posture determination device 200 includes:

[0167] An acquisition unit 201 is used to acquire an estimated posture of the AGV and a posture of at least one particle; the particle is a random sample used to characterize the AGV; the measurement data of the sensor is acquired; the measurement data includes: the distance and angle from the sensor to the obstacle scanned by the sensor; the obstacle includes a first type of obstacle and a second type of obstacle; the second type of obstacle is an object with a reflective material; a calculation unit 202 calculates the coordinates of the obstacle scanned by the sensor mapped to the map under the posture of the particle; wherein the coordinates of the obstacle scanned by the sensor mapped to the map include the first coordinate of the first type of obstacle mapped to the map, and the second type of obstacle mapped to the map. The second coordinate of the particle; a matching unit 203 is used to match the first coordinate and the second coordinate with the coordinates of the obstacle preset on the map, respectively, to obtain a first matching rate and a second matching rate corresponding to the particle; wherein the first matching rate is a matching rate obtained by matching the first coordinate with the coordinates of the first type of obstacle preset on the map; the second matching rate is a matching rate obtained by matching the second coordinate with the coordinates of the second type of obstacle preset on the map; the calculation unit 202 is also used to calculate the weight of the particle based on the first matching rate and the second matching rate corresponding to the particle; the updating unit 204 is used to update the estimated posture of the AGV based on the weight and posture of at least one particle.

[0168] Optionally, the acquisition unit 201 is specifically used to acquire an estimated posture of the AGV; when a change between the estimated posture of the AGV and the posture of the AGV at a previous moment is greater than a posture threshold, acquire the postures of multiple particles.

[0169] Optionally, the calculation unit 202 is specifically configured to multiply the first matching rate, the weighted coefficient of the first matching rate, the second matching rate, and the weighted coefficient of the second matching rate to obtain the weight of the particle; wherein the weighted coefficient of the first matching rate is smaller than the weighted coefficient of the second matching rate.

[0170] Optionally, the weighting coefficient of the second matching rate is related to the target distance; the smaller the target distance, the higher the weighting coefficient of the second matching rate; the target distance is the distance of the scan point falling on the second type of obstacle mapped to the target coordinates on the map and the second type of obstacle closest to the target coordinates.

[0171] Optionally, the sensor includes a laser radar, and the measurement data also includes the light intensity of the scanning point; the scanning point is the point where the sensor falls on the obstacle when scanning the obstacle; the map includes a grid map; the AGV posture determination device 200 also includes a determination unit 205, which is used to calculate the measurement data under the posture of each particle, and after the obstacle scanned by the sensor is mapped to the coordinates of the map, if the scanning point meets the preset conditions, determine that the scanning point falls on the second type of obstacle; wherein the preset conditions include at least one of the following: the light intensity of the scanning point is greater than the light intensity threshold; the distance from the scanning point to the sensor is less than the distance threshold; the scanning point is mapped to the grid in the grid map, and the distance of the second type of grid closest to the grid mapped to the grid map by the scanning point is less than the grid distance threshold; the second type of grid is a grid containing the identification of the second type of obstacle.

[0172] Optionally, the AGV posture determination device 200 also includes a scanning unit 206, which scans the AGV's driving scene and establishes a scanning map before obtaining the estimated posture of the AGV and the postures of multiple particles; converts the scanning map into a raster map; and displays different labels for different categories of obstacles in the raster map.

[0173] Optionally, the calculation unit 202 is further used to calculate and store the distance between each grid in the grid map and the nearest first-type grid to each grid, and the distance between each grid and the nearest second-type grid; wherein the first-type grid is a grid containing the identification of the first-type obstacle.

[0174] Optionally, the second type of obstacles are arranged in an area where the space occupied by the first type of obstacles in the driving scene of the AGV is less than a preset percentage.

[0175] Optionally, the second type of obstacles include reflective poles or reflective panels.

[0176] Some embodiments of the present application provide a computer-readable storage medium (e.g., a non-transitory computer-readable storage medium), which stores computer program instructions. When the computer program instructions are executed on a computer, the computer executes the AGV posture determination method as described in any of the above embodiments.

[0177] Exemplarily, the above-mentioned computer-readable storage media may include, but are not limited to: magnetic storage devices (e.g., hard disks, floppy disks or magnetic tapes, etc.), optical disks (e.g., compact disks (CD), digital versatile disks (DVD), etc.), smart cards and flash memory devices (e.g., erasable programmable read-only memory (EPROM), cards, sticks or key drives, etc.). The various computer-readable storage media described in this application may represent one or more devices and / or other machine-readable storage media for storing information. The term "machine-readable storage medium" may include, but is not limited to, wireless channels and various other media capable of storing, containing and / or carrying instructions and / or data.

[0178] An embodiment of the present application provides a computer program product comprising instructions. When the computer program product is run on a computer, the computer is enabled to execute the AGV posture determination method described in any of the above embodiments.

[0179] The above is only a specific implementation of the present application, but the protection scope of the present application is not limited thereto. Any changes or substitutions within the technical scope disclosed in the present application should be included in the protection scope of the present application. Therefore, the protection scope of the present application should be based on the protection scope of the claims.

Claims

1. A method for determining the position and posture of an unmanned guided vehicle (AGV), characterized in that: The AGV includes a sensor, and the method includes: Obtaining an estimated posture of the AGV and a posture of at least one particle; the particle is a random sample used to characterize the AGV; Acquire measurement data of the sensor; the measurement data includes: the distance and angle from the sensor to the obstacle scanned by the sensor; the obstacle includes a first type of obstacle and a second type of obstacle; the second type of obstacle is an object with a reflective material; Calculating the coordinates of the obstacles scanned by the sensor mapped to the map under the position of the particle in the measurement data; wherein the coordinates of the obstacles scanned by the sensor mapped to the map include the first coordinates of the first type of obstacles mapped to the map, and the second coordinates of the second type of obstacles mapped to the map; Matching the first coordinate and the second coordinate with the coordinates of obstacles preset on the map respectively, to obtain a first matching rate and a second matching rate corresponding to the particle; wherein the first matching rate is a matching rate obtained by matching the first coordinate with the coordinates of a first type of obstacle preset on the map; and the second matching rate is a matching rate obtained by matching the second coordinate with the coordinates of a second type of obstacle preset on the map; Calculating a weight of the particle based on the first matching rate and the second matching rate corresponding to the particle; Based on the weight and the pose of the at least one particle, the estimated pose of the AGV is updated.

2. The method according to claim 1, characterized in that The obtaining of the estimated posture of the AGV and the posture of at least one particle includes: Obtaining an estimated position and posture of the AGV; When a change between the estimated posture of the AGV and the posture of the AGV at a previous moment is greater than a posture threshold, the posture of the at least one particle is acquired.

3. The method according to claim 1, characterized in that The calculating the weight of the particle based on the first matching rate and the second matching rate corresponding to the particle includes: The first matching rate, the weighting coefficient of the first matching rate, the second matching rate and the weighting coefficient of the second matching rate are multiplied to obtain the weight of the particle; wherein the weighting coefficient of the first matching rate is smaller than the weighting coefficient of the second matching rate.

4. The method according to claim 3, characterized in that: The weighting coefficient of the second matching rate is related to the target distance; the smaller the target distance, the higher the weighting coefficient of the second matching rate; the target distance is the distance between the scan point falling on the second type of obstacle and the target coordinates on the map and the second type of obstacle closest to the target coordinates.

5. The method according to claim 4, characterized in that The sensor includes a laser radar, the measurement data also includes light intensity at a scanning point; the scanning point is a point on the obstacle where the sensor falls when scanning the obstacle; the map includes a grid map; after calculating the measurement data and mapping the obstacle scanned by the sensor to coordinates of the map under the posture of each particle, the method further includes: When the scanning point meets a preset condition, determining that the scanning point falls on the second type of obstacle; wherein the preset condition includes at least one of the following: The light intensity at the scanning point is greater than the light intensity threshold; The distance from the scanning point to the sensor is less than a distance threshold; The scanning point is mapped to a grid in the grid map, and the distance between the second type of grid closest to the grid mapped to the scanning point in the grid map is less than the grid distance threshold; the second type of grid is a grid containing the identification of the second type of obstacle.

6. The method according to claim 5, characterized in that Before obtaining the estimated posture of the AGV and the postures of the plurality of particles, the method further includes: Scanning the driving scene of the AGV and establishing a scanning map; The scanned map is converted into the grid map; different types of obstacles in the grid map are displayed with different labels.

7. The method according to claim 5, characterized in that The method further comprises: The distance between each grid in the grid map and the first-type grid closest to each grid and the distance between each grid and the second-type grid closest to each grid are calculated and stored; wherein the first-type grid is a grid containing an identification of the first-type obstacle.

8. The method according to claim 1, characterized in that The second type of obstacles are arranged in an area of ​​the driving scene of the AGV where the space occupied by the first type of obstacles is lower than a preset percentage.

9. An AGV position determination device, characterized in that: It includes a memory and a processor; the memory and the processor are coupled; the memory is used to store computer program code, and the computer program code includes computer instructions; wherein, when the processor executes the computer instructions, the AGV posture determination device executes the AGV posture determination method as described in any one of claims 1-8.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions; wherein, when the computer instructions are executed on an unmanned guided vehicle (AGV) posture determination device, the AGV posture determination device executes the AGV posture determination method as described in any one of claims 1-8.

Citation Information

Patent Citations

  • AGV relocation system and method based on 2D laser sensor

    CN110456797A

  • Robot positioning method and device, computer storage medium and electronic equipment

    CN113448326A

  • Robot positioning method and device based on reflector and robot

    CN113625296A

  • Pose determination method and device of mobile robot

    CN114911232A

Cited By

  • AGV visual texture navigation path map real-time generation method

    CN121632098A

  • An AGV visual texture navigation path map real-time generation method

    CN121632098B