Unmanned obstacle avoidance driving method and terminal based on laser radar and UWB array

A technology of laser radar and driving method, applied in the direction of electromagnetic wave re-radiation, radio wave measurement system, utilization of re-radiation, etc., can solve the problems of mission failure, automatic obstacle avoidance, economic loss, etc. Reduce the effect of avoidance

Pending Publication Date: 2021-08-24
福建盛海智能科技有限公司
0 Cites 4 Cited by

AI-Extracted Technical Summary

Problems solved by technology

When there are obstacles in the unmanned driving path, and the vehicle cannot actively avoid the obstacles, accidents such as crashes and rollovers will occur, which will not only cause economic losses, but also cause failure to ...
the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Method used

As can be seen from the above description, the present invention judges whether it is necessary to avoid by whether the obstacle is located in the dangerous distance of the path track and whether the height of the obstacle is higher than the preset dangerous height, that is, comprehensively position information and height information to carry out Consideration, more comprehensive, can effectively reduce unnecessary avoidance, thereby improving avoidance efficiency.
As can be seen from the above description, the present invention judges whether it is necessary to avoid by whether the obstacle is located in the dangerous distance of the path track and whether the height of the obstacle is higher than the preset dangerous height, that is, the comprehensive position information and height information are carried out. Consideration, more comprehensive, can effectively reduce unnecessary avoi...
the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Abstract

The invention discloses an unmanned obstacle avoidance driving method and terminal based on a laser radar and a UWB array. According to the method, the laser radar is started, and real-time positioning information is acquired according to the regional positioning coordinate system established based on the preset UWB array, so that the vehicle is controlled to run along the pre-acquired path track; according to point cloud data of a laser radar, obstacle identification is carried out, three-dimensional data of an obstacle and coordinates of the laser radar of the obstacle are acquired, UWB coordinates of the obstacle are calculated, whether obstacle avoidance is needed or not is judged, and if yes, an obstacle avoidance route is generated according to a preset obstacle avoidance algorithm when a vehicle is away from the obstacle by a preset distance, and the vehicle runs along the obstacle avoidance route until bypassing the obstacle and returning to the pre-acquired path track; according to the invention, automatic obstacle avoidance of unmanned tracking driving of the vehicle can be realized, judgment is carried out according to the position and height of the obstacle, unnecessary avoidance can be reduced, the obstacle avoidance efficiency is improved, and the system can run without a GPS and is more stable.

Application Domain

Technology Topic

Image

  • Unmanned obstacle avoidance driving method and terminal based on laser radar and UWB array
  • Unmanned obstacle avoidance driving method and terminal based on laser radar and UWB array
  • Unmanned obstacle avoidance driving method and terminal based on laser radar and UWB array

Examples

  • Experimental program(2)

Example Embodiment

[0082] Please refer to Figure 1 , Figure 3 Sum Figure 4 Embodiments of the present invention one as:
[0083] An unmanned avoidance driving method based on laser radar and UWB array, including:
[0084] S1, start the laser radar, acquire real-time positioning information based on the area positioning coordinate system established based on the preset UWB array, and control the vehicle along the pre-acquired path trajectory according to the real-time positioning information;
[0085] In this embodiment, the real-time positioning information includes real-time positioning coordinates and real-time navigation angles, and the regional positioning coordinate system created based on the preset UWB array is specifically: obtaining the vehicle and various described in accordance with preset intervals. The distance between the UWB base station acquires the base station coordinates of the nearest four of the UWB base stations, select two of the base station coordinates in which the longitudinal sites are small as the first base station coordinate and the second base station coordinate, wherein the first base station coordinate The abscissa is smaller than the abscissa of the second base station coordinate, the first distance A of the vehicle and the first base station coordinate, the second distance C of the vehicle and the second base station coordinate C, the first base station The third distance B of the coordinates and the second base station coordinate bums into the following formula:
[0086] P = (A + B + C) / 2;
[0087] S = √ [p * (p-a) * (p-b) * (p-c)]
[0088] S = h * b / 2
[0089] a 2 = H 2 + T 2
[0090] The first coordinates of the first base station coordinates (X, Y) of the vehicle are calculated, and the longitudinal difference h of the first base station coordinate (X, Y) is calculated to obtain real-time positioning coordinates (X + T, Y + H);
[0091] The vehicle traveling vector Vc = (X1-X0, Y1-Y0) is calculated based on the positioning coordinates (X0, Y0) of the position (X0, Y0) (X0, Y0) (X0, Y0) before the preset time interposed coordinates (X1, Y1) and the preset time interval; and by y The positive vector VY = (0, 1) of the axis is according to the following formula:
[0092] θ = Arccos (VC * VY / (| VC | * | VY |)
[0093] When calculating the angle θ, if X1-X0> 0, the real-time gantry angle is θ, if X1-X0 <0, the real-time gantry angle is π-θ, ​​if X1-x0 = 0 and Y1-Y0> = 0, Then the head is 0, if X1-X0 = 0 and Y1-Y0 <0, the real-time navigation angle is 180 °.
[0094] According to the calculated real-time positioning coordinates and real-time navigation angles to control the vehicle along the pre-acquired path trajectory, that is, according to real-time positioning coordinates, real-time navigation angle, and path trajectory in real time, it can be obtained by real-time coordinates and target trajectory points. The target navigation angle, and controls the steering of the vehicle to adjust the current real-time navigation angle to the target navigation angle, thereby controlling the vehicle steering, traveling along the path trajectory.
[0095] S2, the obstacle recognition is performed according to the point cloud data of the laser radar, and the three-dimensional data of the obstacle and the obstacle laser radar coordinates are obtained, and the obstacle UWB coordinates are calculated according to the obstacle laser radar coordinates, and according to the obstacle UWB coordinates And the three-dimensional data is determined whether or not avoiding avoidance, and when the avoidance is required, the process proceeds to step S3, otherwise it will continue along the path trajectory;
[0096] Wherein, the point cloud data according to the laser radar is recognized according to the point cloud data of the laser radar, and the three-dimensional data of the obstacle and the obstacle laser radar coordinate are specifically:
[0097] Traverse the point cloud data of the laser radar, the point distance between the calculation point and the point, the two points smaller than the preset threshold, each of which is included in each obstacle. All points of point;
[0098] In the coordinates of all points of the point set, the length L of the obstacle is calculated based on the maximum horizontal coordinate and the minimum abscissa, calculate the width W of the obstacle according to the maximum ordinate and the minimum abscissa, according to the maximum vertical coordinates The height h of the obstacle is calculated from the minimum vertical coordinates to obtain three dimensions of the obstacle;
[0099] The obstacle laser radar coordinates are calculated according to the clustering algorithm, the obstacle laser radar coordinates including radar center point coordinates and radar edge point coordinates;
[0100] Wherein, the step S2 calculates the obstacle the UWB coordinates according to the obstacle laser radar coordinate.
[0101] Getting the current real-time positioning information of the vehicle includes real-time positioning coordinates (X, Y), and real-time navigation angle θ, laser radar coordinates for the obstacle (X ob Y ob ) After entering the following formula:
[0102] X '= x ob Cos θ-y ob sinθ
[0103] Y '= x ob SIN θ + Y ob Cos θ
[0104] The first coordinate (x ', y') can be obtained, and can be obtained according to the current real-time positioning coordinates (X, Y) of the vehicle:
[0105] x ob '= X + x'
[0106] y ob '= Y + y'
[0107] To get an obstacle UWB coordinate (X ob ', Y ob ');
[0108] In this embodiment, according to the laser radar point cloud data, the clustering algorithm and the distance between the obstacles in the laser radar (ie, the obstacle laser radar coordinate), including the center point coordinates and the edge point coordinates. (Ie radar center point coordinates and radar edge point coordinates), and calculate the three-dimensional information of the obstacle, and the real-time positioning information is obtained, and the real-time positioning coordinates, real-time navigation angles, and obstacles laser radar coordinates into formulas and further calculate, The obstacle UWB coordinates can be obtained, including the UWB center point coordinates of the calculated obstacle by the radar center point coordinates and the UWB edge point coordinates.
[0109] Wherein, the obstacle UWB coordinates and the three-dimensional data judgment need to be avoided:
[0110] According to the obstacle UWB coordinates, it is determined whether there is a point (x_t, y_t) and the distance of the path trajectory less than the preset hazardous distance and H is greater than the preset hazard height. If it is necessary to avoid, it is necessary to avoid ;
[0111] Where X min ≤ x_t≤x max Y min ≤Y_t≤y max , Where x min , X max Y min Sum max The minimum horizontal coordinates, maximum horizontal coordinates, minimum ordinate, maximum longitudinal coordinates, respectively, the UWB edge point coordinates of the obstacle UWB coordinates, respectively;
[0112] In this embodiment, according to the obstacle GPS coordinate, we can determine whether the obstacle and path trajectory information is conflicted based on the regional positioning coordinate system established based on the UWB array, ie, whether it is in the dangerous range of the path trajectory, that is, the preset dangerous distance. In this embodiment, the preset hazard is considered according to the vehicle width, for example, the dangerous distance of 4 meters in the vehicle width is 2 meters. In other equivalents, the preset hazard distance can be appropriately increased or decreased on the basis of the vehicle width and vehicle length according to the safety consideration.
[0113] Specifically, according to the maximum smallest coordinates in the UWB edge point coordinates, it is determined whether there is a little horizontal coordinate between the maximum horizontal coordinates and the minimum abscissa, the ordinate between the maximum ordinate and the minimum longitudinal coordinate, and with the path The distance of the trajectory is smaller than the preset dangerous distance, and the height of the obstacle (the three-dimensional coordinates of the obstacle is calculated, and the height information h) is higher than the preset hazard height. If it is necessary to avoid the avoidance, it is necessary to avoid the avoidance, Drive along the original trajectory. In this embodiment, the preset hazard height is half of the height of the vehicle chassis. In other equivalents, the preset hazard height can also be pre-set, or according to the height of the chassis.
[0114] S3, when the distance of the obstacle is preset, the avoidance route is generated according to the preset avoidance algorithm, and travels along the avoidance route until the obstacle and returns to the predetermined channel trajectory. ;
[0115] The path trajectory contains a plurality of ordered target trajectory points, combined Figure 4 It can be seen that the step S3 is specifically:
[0116] The maximum horizontal coordinates in the edge point in the obstacle laser radar coordinates are used as the value obtained by the preset safety spacing as the maximum value of the avoidance. m;
[0117] When the obstacle is preset during the vehicle, according to the radar center point coordinates and the radar edge point coordinates, the spacing is in the horizontal housing range (0, x m ] Take the horizontal coordinate X1 in the following formula, respectively.
[0118] (x1-r) 2 + Y1 2 = R * r
[0119] Thereby, a plurality of turn radar trajectories (X1, Y1) are determined, wherein R is a preset turning radius of the vehicle, the preset distance is greater than the vehicle turn radius R plus preset safety distance;
[0120] Turning radar trajectory point b by the horizontal coordinate m Y b ), Determine a point C (X m Y c ), Where Y c The maximum longitudinal coordinates in the radar edge point coordinates are added to the preset safety spacing, and a point d after the obstacle is greater than the preset hazardous distance, thus controlling the vehicle along the turn radar trajectory to the turn radar trajectory. Point B and the path along B-> C-> D runs to the D point after the current GPS information and the path trajectory continue to perform unmanned tracking;
[0121] like Figure 4 As shown in the present embodiment, if the result of avoiding the need is needed to avoid, the avoidance treatment is required based on the laser radar. According to the turning radius of the vehicle, the preset turn radius, the resulting point O (R, 0), and the largest horizontal coordinate of the radar edge point coordinate of the obstacle laser radar coordinate (the maximum value of the horizontal) m ), Thereby calculating a plurality of turning radar trajectory points, and determines point B, c, d, control the vehicle along the rotary radar trajectory point B, while traveling along the route B-> C-> D can bypass the obstacle At this time, it can be real-time according to the area positioning coordinate system established by the UWB array, thereby controlling the vehicle to continue to enter and drive unmanned by the path trajectory.

Example Embodiment

[0122] Please refer to figure 2 Embodiment 2 of the present invention:
[0123] An unmanned avoidance driving terminal 1 based on laser radar and UWB array, including processor 2, memory 3, and computer program stored on memory 3 and can run on processor 2, the processor 2 performs said processor 2. The steps in the above embodiment are implemented in the computer program.
[0124] In summary, an unmanned avoidance driving method based on laser radar and UWB array is positioned, and the UWB-based regions established based on the UWB array, determines the UWB of the obstacle according to the laser radar point cloud data. The coordinates and 3D data, and determine whether the obstacle is harmed according to the laser radar coordinates and three-dimensional data, thereby realizing the automatic avoidance of the vehicle's unmanned tracking, not only judging the location of the obstacle, but also Whether the height of the obstacle will judge the vehicle, it can reduce unnecessary avoidance to improve the avoidance efficiency, and can be detached from GPS, more stable.
the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

no PUM

Description & Claims & Application Information

We can also present the details of the Description, Claims and Application information to help users get a comprehensive understanding of the technical details of the patent, such as background art, summary of invention, brief description of drawings, description of embodiments, and other original content. On the other hand, users can also determine the specific scope of protection of the technology through the list of claims; as well as understand the changes in the life cycle of the technology with the presentation of the patent timeline. Login to view more.
the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Similar technology patents

Unmanned obstacle avoidance method and terminal based on laser radar and GPS

PendingCN113296118AReduce avoidanceImprove obstacle avoidance efficiencyElectromagnetic wave reradiationThree dimensional dataEngineering
Owner:福建盛海智能科技有限公司

Dynamic obstacle avoiding method based on combination of neural network and Q-learning algorithm

PendingCN110345948AImprove obstacle avoidance efficiencyNavigational calculation instrumentsNeural architecturesMobile robotGoal attainment
Owner:重庆邮智机器人研究院有限公司

Classification and recommendation of technical efficacy words

  • Reduce avoidance
  • Improve obstacle avoidance efficiency

Unmanned obstacle avoidance method and terminal based on laser radar and GPS

PendingCN113296118AReduce avoidanceImprove obstacle avoidance efficiencyElectromagnetic wave reradiationThree dimensional dataEngineering
Owner:福建盛海智能科技有限公司

Obstacle avoiding method and device of robot and robot

PendingCN111090282AImprove obstacle avoidanceImprove obstacle avoidance efficiencyTarget-seeking controlPosition/course control in two dimensionsComputer visionEngineering
Owner:ANKER INNOVATIONS TECH CO LTD

Dynamic obstacle avoiding method based on combination of neural network and Q-learning algorithm

PendingCN110345948AImprove obstacle avoidance efficiencyNavigational calculation instrumentsNeural architecturesMobile robotGoal attainment
Owner:重庆邮智机器人研究院有限公司

Unmanned obstacle avoidance method and terminal based on laser radar and GPS

PendingCN113296118AReduce avoidanceImprove obstacle avoidance efficiencyElectromagnetic wave reradiationThree dimensional dataEngineering
Owner:福建盛海智能科技有限公司
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products