阅读说明：本技术 道路负障碍检测方法及系统 (Road negative obstacle detection method and system ) 是由 杨明 杨辰兮 王春香 王冰 于 2020-11-24 设计创作，主要内容包括：本发明提供了一种道路负障碍检测方法,包括：采集载车两侧面道路的单帧环境点云数据和载车运动信息；将单帧环境点云数据根据载车运动信息进行空间叠加,得到多帧融合后的点云数据；将多帧融合后的点云数据进行负边缘提取,获得负边缘曲线,进而判断负障碍及其具体位置,完成对道路负障碍的检测。同时提供了一种道路负障碍检测系统。本发明通过在载车侧面设置专用负障碍物检测补盲激光雷达,大幅提高堤坝、码头等无人驾驶车辆具有坠落风险,提高载车及断崖下方行人、船只等的安全性。(The invention provides a road negative obstacle detection method, which comprises the following steps: acquiring single-frame environmental point cloud data and vehicle motion information of roads on two side surfaces of a vehicle; carrying out spatial superposition on single-frame environmental point cloud data according to vehicle-carrying motion information to obtain multi-frame fused point cloud data; and extracting the negative edge of the multi-frame fused point cloud data to obtain a negative edge curve, and further judging the negative obstacle and the specific position of the negative obstacle to finish the detection of the road negative obstacle. A road negative obstacle detection system is also provided. According to the invention, the special negative obstacle detection blind-repairing laser radar is arranged on the side surface of the vehicle carrier, so that the falling risk of unmanned vehicles such as dams and wharfs is greatly increased, and the safety of pedestrians, ships and the like under the vehicle carrier and the cliff is improved.)

1. A road negative obstacle detection method is characterized by comprising the following steps:

acquiring single-frame environmental point cloud data and vehicle motion information of roads on two side surfaces of a vehicle;

carrying out spatial superposition on single-frame environmental point cloud data according to vehicle-carrying motion information to obtain multi-frame fused point cloud data;

and extracting the negative edge of the multi-frame fused point cloud data to obtain a negative edge curve, and further judging the negative obstacle and the specific position of the negative obstacle to finish the detection of the road negative obstacle.

2. The road negative obstacle detection method according to claim 1, wherein single-frame environmental point cloud data of roads on two side faces of the vehicle are acquired by blind-supplementary laser radars arranged on two side faces of the vehicle; and/or

The vehicle carrying motion information is acquired through a corner speed collector arranged on the vehicle.

3. The road negative obstacle detection method according to claim 2, characterized by further comprising any one or more of:

the blind-repairing laser radars are respectively arranged on the upper edges of the side faces of the vehicle carrier;

-the blind-fill lidar has respective downward-looking capabilities of 180 ° covering a field of view of an area within 10 meters of the vehicle side;

the angular speed collector is arranged inside the vehicle;

the angular velocity harvester employs two rotary encoders or an inertial navigation system.

4. The method for detecting road negative obstacle according to claim 1, wherein spatially superimposing single-frame environmental point cloud data according to vehicle motion information to obtain multi-frame fused point cloud data comprises:

acquiring real-time multiple continuous single-frame environmental point cloud data of the vehicle carrier, calculating vehicle carrier pose transformation data according to inter-frame point cloud matching, and acquiring a vehicle carrier real-time pose calculation result;

obtain and carry real-time year car motion information of car, include: steering engine rotation angle and speed information;

fusing the obtained real-time posture calculation result of the carrier vehicle with real-time steering engine turning angle and speed information of the carrier vehicle to obtain fused carrier vehicle navigation position information;

and superposing the corresponding multiple continuous single-frame environmental point cloud data in the space according to the fused multiple continuous single-frame vehicle-carrying navigation position information to obtain the multi-frame fused point cloud data.

5. The method for detecting road negative obstacle according to claim 1, wherein the step of performing negative edge extraction on the multi-frame fused point cloud data to obtain a negative edge curve comprises the following steps:

acquiring multi-frame fused point cloud data;

carrying out negative edge extraction on the acquired multi-frame fused point cloud data to obtain a negative edge detection result point set;

carrying out outer point filtering on the obtained negative edge detection result point set to obtain a negative edge point set after the outer points are filtered;

and performing curve fitting on the negative edge point set to obtain a negative edge curve.

6. A road negative obstacle detection system, comprising:

the vehicle-mounted sensor module is used for acquiring single-frame environmental point cloud data and vehicle motion information of roads on two side faces of a vehicle;

the data fusion module is used for carrying out spatial superposition on single-frame environmental point cloud data according to vehicle-carrying motion information to obtain multi-frame fused point cloud data;

and the negative obstacle detection module is used for carrying out negative edge extraction on the multi-frame fused point cloud data to obtain a negative edge curve, further judging the negative obstacle and the specific position of the negative obstacle, and completing the detection of the negative obstacle of the road.

7. The road negative obstacle detection system of claim 6, wherein the vehicle-mounted sensor module comprises blind-supplementary laser radars arranged on two side faces of the vehicle and a corner speed collector arranged on the vehicle; wherein:

the blind-complementing laser radars arranged on the two side faces of the vehicle are used for acquiring single-frame environmental point cloud data of roads on the two side faces of the vehicle;

the corner speed collector arranged on the vehicle is used for collecting motion information of the vehicle.

8. The system of claim 7, further comprising any one or more of:

the blind-repairing laser radars are respectively arranged on the upper edges of the side faces of the vehicle carrier;

-the blind-fill lidar has respective downward-looking capabilities of 180 ° covering a field of view of an area within 10 meters of the vehicle side;

the angular speed collector is arranged inside the vehicle;

the angular velocity harvester employs two rotary encoders or an inertial navigation system.

9. The system of claim 6, wherein the data fusion module comprises a lidar odometry module, a dead reckoning fusion module, and a point cloud overlay module; wherein:

the laser radar odometer module is used for acquiring a plurality of continuous single-frame environmental point cloud data, calculating vehicle-carrying pose transformation data according to inter-frame point cloud matching and obtaining a vehicle-carrying real-time pose calculation result;

the dead reckoning module is used for acquiring the real-time vehicle carrying motion information of the vehicle carrying, and comprises: steering engine rotation angle and speed information;

the navigation position fusion module is used for fusing the obtained real-time posture calculation result of the vehicle loading and the real-time steering engine turning angle and speed information of the vehicle loading to obtain fused vehicle loading navigation position information;

and the point cloud overlapping module is used for overlapping the corresponding multiple continuous single-frame environmental point cloud data in space according to the fused multiple continuous single-frame vehicle-carrying navigation position information to obtain the multi-frame fused point cloud data.

10. The road negative obstacle detection system of claim 6, wherein the negative obstacle detection module comprises a negative edge extraction module, an outlier filtering module, a curve fitting module and a negative obstacle judgment module; wherein:

the negative edge extraction module is used for acquiring multi-frame fused point cloud data and carrying out negative edge detection on the multi-frame fused point cloud data to obtain a negative edge detection result point set;

the outer point filtering module is used for filtering outer points of the negative edge detection result point set to obtain a negative edge point set after the outer points are filtered;

the curve fitting module is used for performing curve fitting on the negative edge point set to obtain a negative edge curve;

and the negative obstacle judging module is used for judging the negative obstacle and the specific position of the negative obstacle according to the obtained negative edge curve.

Technical Field

The invention relates to the technical field of surveying and mapping, in particular to a road negative obstacle detection method and system.

Background

With the continuous development of the performance of the laser radar, the laser radar has been widely applied to the field of unmanned vehicle perception. Currently, positive direction above ground obstacle detection, represented by pedestrians and ambient vehicles, in the direction of vehicle travel is relatively mature. However, the sensor layout of the conventional vehicle roof-mounted laser radar has large blind areas at the near ends of the two sides of the vehicle, so that pedestrians, non-motor vehicles and the like close to the two sides of the vehicle cannot be effectively identified. The above-mentioned problems are particularly dangerous in the case of negative direction obstacles such as dams, wharf edges and the like, which would risk the vehicle falling if they could not be detected effectively.

Through search, the following results are found:

the Chinese patent application with the publication number of CN109633688A and the invention name of 'a laser radar obstacle identification method and device' comprises the steps of obtaining information of obstacles to be identified of continuous N +1 frames around a laser radar scanning unmanned vehicle; judging whether the barrier to be identified in the (N + 1) th frame enters a laser radar blind area or not; intercepting the laser point cloud of the barrier to be identified in the Nth frame according to the length of the barrier to be identified entering the laser radar blind area; matching the intercepted laser point cloud of the obstacle to be identified with the laser point cloud of the obstacle to be identified in the (N + 1) th frame; completing the laser point cloud of the barrier to be identified in the (N + 1) th frame; and identifying the obstacle according to the supplemented obstacle laser point cloud to be identified. The obstacle entering the laser radar blind area can be identified, the risk of collision caused by misidentification of the length and distance of the obstacle is avoided, and the driving safety of the unmanned vehicle is effectively improved. The method aims at the laser radar blind area, and is a method for completing obstacles in the blind area. In this method, since there is a blind area, there is still a possibility of the above-mentioned danger, and effective safety control cannot be achieved.

In summary, no explanation or report of similar technologies to the present invention is found at present, and no similar data is collected at home and abroad, aiming at the problem that the conventional roof-mounted lidar cannot effectively cover the near-end visual fields at both sides of the vehicle, especially has no negative obstacle represented by cliff.

Disclosure of Invention

Aiming at the defects in the prior art, the invention provides a road negative obstacle detection method and a road negative obstacle detection system.

The invention is realized by the following technical scheme.

According to an aspect of the present invention, there is provided a road negative obstacle detection method including:

acquiring single-frame environmental point cloud data and vehicle motion information of roads on two side surfaces of a vehicle;

carrying out spatial superposition on single-frame environmental point cloud data according to vehicle-carrying motion information to obtain multi-frame fused point cloud data;

and extracting the negative edge of the multi-frame fused point cloud data to obtain a negative edge curve, and further judging the negative obstacle and the specific position of the negative obstacle to finish the detection of the road negative obstacle.

Preferably, the single-frame environmental point cloud data of the roads on the two side faces of the vehicle carrier are acquired through blind-complementing laser radars arranged on the two side faces of the vehicle carrier.

Preferably, the blind-fill lidar has downward-looking capability of covering 180 degrees of the field of view of the area within 10 meters of the side of the vehicle.

Preferably, the blind-repairing laser radars are respectively arranged on the edges of the upper part of the side face of the vehicle carrier.

Preferably, the vehicle carrying motion information is acquired by a turning speed collector arranged on the vehicle.

Preferably, the rotational speed collector adopts two rotary encoders or an inertial navigation system.

Preferably, the turning speed collector is arranged inside the vehicle.

Preferably, the spatially superimposing the single-frame environmental point cloud data according to the vehicle motion information to obtain multi-frame fused point cloud data includes:

acquiring real-time multiple continuous single-frame environmental point cloud data of the vehicle carrier, calculating vehicle carrier pose transformation data according to inter-frame point cloud matching, and acquiring a vehicle carrier real-time pose calculation result;

obtain and carry real-time year car motion information of car, include: steering engine rotation angle and speed information;

fusing the obtained real-time posture calculation result of the carrier vehicle with real-time steering engine turning angle and speed information of the carrier vehicle to obtain fused carrier vehicle navigation position information;

and superposing the corresponding multiple continuous single-frame environmental point cloud data in the space according to the fused multiple continuous single-frame vehicle-carrying navigation position information to obtain the multi-frame fused point cloud data.

Preferably, the negative edge extracting the multi-frame fused point cloud data to obtain a negative edge curve includes:

acquiring multi-frame fused point cloud data;

carrying out negative edge extraction on the acquired multi-frame fused point cloud data to obtain a negative edge detection result point set;

carrying out outer point filtering on the obtained negative edge detection result point set to obtain a negative edge point set after the outer points are filtered;

and performing curve fitting on the negative edge point set to obtain a negative edge curve.

According to another aspect of the present invention, there is provided a road negative obstacle detection system including:

the vehicle-mounted sensor module is used for acquiring single-frame environmental point cloud data and vehicle motion information of roads on two side faces of a vehicle;

the data fusion module is used for carrying out spatial superposition on single-frame environmental point cloud data according to vehicle-carrying motion information to obtain multi-frame fused point cloud data;

and the negative obstacle detection module is used for carrying out negative edge extraction on the multi-frame fused point cloud data to obtain a negative edge curve, further judging the negative obstacle and the specific position of the negative obstacle, and completing the detection of the negative obstacle of the road.

Preferably, the vehicle-mounted sensor module comprises blind-supplementary laser radars arranged on two side faces of the vehicle and a corner speed collector arranged on the vehicle; wherein:

the blind-complementing laser radars arranged on the two side faces of the vehicle are used for acquiring single-frame environmental point cloud data of roads on the two side faces of the vehicle;

the corner speed collector arranged on the vehicle is used for collecting motion information of the vehicle.

Preferably, the blind-repairing laser radars are respectively arranged on the edges of the upper part of the side face of the vehicle carrier.

Preferably, the blind-fill lidar has downward-looking capability of covering 180 degrees of the field of view of the area within 10 meters of the side of the vehicle.

Preferably, the turning speed collector is arranged inside the vehicle.

Preferably, the rotational speed collector adopts two rotary encoders or an inertial navigation system.

Preferably, the data fusion module comprises a laser radar odometer module, a dead reckoning module and a point cloud superposition module; wherein:

the laser radar odometer module is used for acquiring a plurality of continuous single-frame environmental point cloud data, calculating vehicle-carrying pose transformation data according to inter-frame point cloud matching and obtaining a vehicle-carrying real-time pose calculation result;

the dead reckoning module is used for acquiring the real-time vehicle carrying motion information of the vehicle carrying, and comprises: steering engine rotation angle and speed information;

the navigation position fusion module is used for fusing the obtained real-time posture calculation result of the vehicle loading and the real-time steering engine turning angle and speed information of the vehicle loading to obtain fused vehicle loading navigation position information;

and the point cloud overlapping module is used for overlapping the corresponding multiple continuous single-frame environmental point cloud data in space according to the fused multiple continuous single-frame vehicle-carrying navigation position information to obtain the multi-frame fused point cloud data.

Preferably, the negative obstacle detection module comprises a negative edge extraction module, an outlier filtering module, a curve fitting module and a negative obstacle judgment module; wherein:

the negative edge extraction module is used for acquiring multi-frame fused point cloud data and carrying out negative edge detection on the multi-frame fused point cloud data to obtain a negative edge detection result point set;

the outer point filtering module is used for filtering outer points of the negative edge detection result point set to obtain a negative edge point set after the outer points are filtered;

the curve fitting module is used for performing curve fitting on the negative edge point set to obtain a negative edge curve;

and the negative obstacle judging module is used for judging the negative obstacle and the specific position of the negative obstacle according to the obtained negative edge curve.

Due to the adoption of the technical scheme, compared with the prior art, the invention has the following beneficial effects:

according to the road negative obstacle detection method and system provided by the invention, the special negative obstacle detection blind-repairing laser radar is arranged on the side surface of the vehicle carrier, so that the falling risk of unmanned vehicles such as dams and wharfs is greatly increased, and the safety of pedestrians, ships and the like below the vehicle carrier and the broken cliffs is improved.

Drawings

Other features, objects and advantages of the invention will become more apparent upon reading of the detailed description of non-limiting embodiments with reference to the following drawings:

fig. 1 is a flowchart of a road negative obstacle detection method according to an embodiment of the present invention.

Fig. 2 is a schematic diagram illustrating the block components of a road negative obstacle detection system according to an embodiment of the present invention.

Fig. 3 is a schematic block diagram of a road negative obstacle detection system according to a preferred embodiment of the present invention.

FIG. 4 is a top view and a side view of an in-vehicle sensor module mounting location in accordance with a preferred embodiment of the present invention; wherein, (a) is a top view, and (b) is a side view.

In the figure, 1 is a vehicle, 2 is a blind-repairing laser radar, and 3 is a corner speed collector.

Detailed Description

The following examples illustrate the invention in detail: the embodiment is implemented on the premise of the technical scheme of the invention, and a detailed implementation mode and a specific operation process are given. It should be noted that, for a person skilled in the art, several variations and modifications can be made without departing from the inventive concept, which falls within the scope of the present invention.

An embodiment of the invention provides a road negative obstacle detection method, which is free of a visual field blind area, can directly sense negative obstacles at any time, solves the problem of negative obstacle detection and guarantees the safety of a vehicle by additionally arranging a downward-looking blind-supplementary laser radar on the side surface of the vehicle and designing a corresponding negative obstacle detection method.

Fig. 1 is a flowchart of a road negative obstacle detection method provided in this embodiment.

As shown in fig. 1, the method for detecting a negative road obstacle provided in this embodiment may include the following steps:

s100, collecting single-frame environmental point cloud data and vehicle motion information of roads on two side surfaces of a vehicle;

s200, carrying out spatial superposition on single-frame environmental point cloud data according to vehicle-carrying motion information to obtain multi-frame fused point cloud data;

s300, carrying out negative edge extraction on the multi-frame fused point cloud data to obtain a negative edge curve, and further judging a negative obstacle and a specific position of the negative obstacle to finish the detection of the road negative obstacle.

In S100, single-frame environmental point cloud data of roads on two sides of the vehicle are acquired by blind-supplementary laser radars on two sides of the vehicle.

In a preferred embodiment, the blind-fill lidar has a downward-looking capability of 180 ° covering a field of view of an area within 10 m of the side of the vehicle.

As a preferred embodiment, the blind-repairing laser radars are respectively arranged on the upper edges of the side surfaces of the vehicle carriers.

As a preferred embodiment, in S100, the vehicle motion information is acquired by a rotational speed acquisition unit disposed on the vehicle.

As a preferred embodiment, the rotational angle speed collector employs two rotary encoders or an inertial navigation system.

As a preferred embodiment, the turning angle speed collector is arranged inside the vehicle loader.

As a preferred embodiment, in S200, spatially superimposing single-frame environmental point cloud data according to vehicle motion information to obtain multi-frame fused point cloud data, including:

s201, acquiring a plurality of pieces of continuous single-frame environmental point cloud data of the vehicle carrier in real time, calculating vehicle carrier pose transformation data according to inter-frame point cloud matching, and acquiring a vehicle carrier real-time pose calculation result;

s202, acquiring the real-time vehicle carrying motion information of the vehicle, including: steering engine rotation angle and speed information;

s203, fusing the obtained real-time posture calculation result of the carrier vehicle with real-time steering engine turning angle and speed information of the carrier vehicle to obtain fused carrier vehicle navigation position information;

and S204, overlapping the corresponding multiple continuous single-frame environmental point cloud data in the space according to the fused multiple continuous single-frame vehicle-carrying navigation position information to obtain multiple frames of fused point cloud data.

As a preferred embodiment, in S201, the method for calculating vehicle pose transformation data according to inter-frame point cloud matching specifically includes:

and according to a space geometric structure formed by each point in each frame of point cloud data and all the points adjacent to each point, calculating geometric characteristics such as edges and planes in an environment area covered by each frame of point cloud, and then minimizing a matching error by matching the geometric characteristics of the edges and the planes calculated by each frame of point cloud data, thereby calculating vehicle-carrying pose transformation data.

As a preferred embodiment, in S203, the method for fusing the obtained real-time posture estimation result of the vehicle loader with the real-time steering engine rotation angle and speed information of the vehicle loader specifically includes:

kalman filtering is carried out on a spatial pose transformation sequence obtained by calculation in continuous multiframes of the vehicle, so that a pose transformation calculation result with higher precision at the latest moment is improved; and comparing the pose transformation calculation result with a vehicle-carrying real-time pose calculation result calculated by the real-time steering engine rotation angle and speed information, if the error between the two results is smaller than a preset threshold value, taking the space pose calculated by the point cloud data as a criterion, and otherwise, taking the space pose calculated by the real-time steering engine rotation angle and speed information of the vehicle-carrying as a criterion, and finally obtaining the vehicle-carrying position information.

As a preferred embodiment, in S204, a plurality of continuous single-frame environmental point cloud data corresponding to a plurality of fused continuous single-frame vehicle-carrying navigation position information are superimposed, and each frame of vehicle-carrying navigation position information is only responsible for providing a coordinate position of each frame of point cloud in the same spatial coordinate system.

As a preferred embodiment, in S300, performing negative edge extraction on the multi-frame fused point cloud data to obtain a negative edge curve, including:

s301, acquiring multi-frame fused point cloud data;

s302, carrying out negative edge extraction on the acquired multi-frame fused point cloud data to obtain a negative edge detection result point set;

s303, carrying out outer point filtering on the obtained negative edge detection result point set to obtain a negative edge point set after the outer points are filtered;

and S304, performing curve fitting on the negative edge point set to obtain a negative edge curve.

As a preferred embodiment, in S302, a method for performing negative edge extraction on acquired multi-frame fused point cloud data to obtain a negative edge detection result point set includes:

and detecting the height jump of the ground points in the fused point cloud data from near to far by taking the position of the vehicle in the fused point cloud as the center and the normal direction of the vehicle advancing direction as the direction according to the mounting height of the vehicle-mounted side blind-complementing laser radar, taking the first detected negative jump (ground height dip) as a negative edge detection result point, and finally obtaining a detection result point set.

As a preferred embodiment, S303, a method for filtering out an outer point from the obtained negative edge detection result point set includes:

according to the detection result point set obtained in the step S302, curve fitting is performed on the point sets on both sides by using a random sample consensus (RANSAC) algorithm, a curve with the best random sample consensus is used as a basis for filtering out the external points, and points with Euclidean distances and distances between the above curves being greater than a preset threshold are used as the external points for filtering out.

Another embodiment of the present invention provides a road negative obstacle detection system, and fig. 2 is a schematic diagram showing a module composition of the road negative obstacle detection system in this embodiment.

As shown in fig. 2, the road negative obstacle detection system provided in this embodiment may include the following modules:

the vehicle-mounted sensor module is used for acquiring single-frame environmental point cloud data and vehicle-mounted motion information of roads on two side faces of a vehicle;

the data fusion module is used for carrying out spatial superposition on the single-frame environmental point cloud data according to the vehicle-carrying motion information to obtain multi-frame fused point cloud data;

and the negative obstacle detection module is used for extracting the negative edge of the multi-frame fused point cloud data to obtain a negative edge curve, and further judging the negative obstacle and the specific position of the negative obstacle to finish the detection of the road negative obstacle.

Fig. 3 is a schematic block diagram of a road negative obstacle detection system according to a preferred embodiment of the present invention.

As shown in fig. 3, the road negative obstacle detection system in the preferred embodiment may further include the following modules.

As a preferred embodiment, the vehicle-mounted sensor module comprises blind-supplementary laser radars arranged on two side faces of the vehicle and a corner speed collector arranged on the vehicle; wherein:

blind-complementing laser radars arranged on two side faces of the vehicle carrier are used for acquiring single-frame environmental point cloud data of roads on the two side faces of the vehicle carrier;

the turning speed collector arranged on the vehicle is used for collecting the motion information of the vehicle.

As a preferred embodiment, the blind-repairing laser radars are respectively arranged on the upper edges of the side surfaces of the vehicle carriers.

In a preferred embodiment, the blind-fill lidar has a downward-looking capability of 180 ° covering a field of view of an area within 10 m of the side of the vehicle.

As a preferred embodiment, the turning angle speed collector is arranged inside the vehicle loader.

As a preferred embodiment, the rotational angle speed collector employs two rotary encoders or an inertial navigation system.

As a preferred embodiment, the data fusion module comprises a laser radar odometer module, a dead reckoning module and a point cloud superposition module; wherein:

the laser radar odometer module is used for acquiring a plurality of continuous single-frame environmental point cloud data, calculating vehicle-carrying pose transformation data according to inter-frame point cloud matching and obtaining a vehicle-carrying real-time pose calculation result;

the dead reckoning module is used for obtaining the real-time vehicle carrying motion information of the vehicle carrying, and comprises: steering engine rotation angle and speed information;

the navigation position fusion module is used for fusing the obtained real-time posture calculation result of the vehicle loading and the real-time steering engine turning angle and speed information of the vehicle loading to obtain fused vehicle loading navigation position information;

and the point cloud overlapping module is used for overlapping the corresponding multiple continuous single-frame environmental point cloud data in the space according to the fused multiple continuous single-frame vehicle-carrying navigation position information to obtain the multi-frame fused point cloud data.

As a preferred embodiment, the negative obstacle detection module comprises a negative edge extraction module, an outlier filtering module, a curve fitting module and a negative obstacle judgment module; wherein:

the negative edge extraction module is used for acquiring multi-frame fused point cloud data and carrying out negative edge detection on the multi-frame fused point cloud data to obtain a negative edge detection result point set;

the outer point filtering module is used for carrying out outer point filtering on the negative edge detection result point set to obtain a negative edge point set after the outer points are filtered;

the curve fitting module is used for performing curve fitting on the negative edge point set to obtain a negative edge curve;

and the negative obstacle judging module is used for judging the negative obstacle and the specific position of the negative obstacle according to the obtained negative edge curve.

As shown in fig. 3, in the preferred embodiment: the vehicle-mounted sensor module is connected with the data fusion module to transmit single-frame environment point cloud data and vehicle-mounted motion information, the data fusion module is connected with the negative obstacle detection module to transmit multi-frame fused point cloud data, and the negative obstacle detection module outputs a continuous negative edge curve to obtain a negative obstacle position.

As shown in fig. 4 (a) and (b), in the present preferred embodiment: the vehicle-mounted sensor module collects single-frame environmental point cloud data and vehicle-mounted motion information, and comprises the following steps: blind laser radar 2, corner speed collector 3 are mended to side, wherein: the side blind-complementing laser radar is arranged on the edge of the upper portion of the side face of the vehicle, the corner speed collector is arranged inside the vehicle, the side blind-complementing laser radar is connected with the data fusion module to transmit single-frame environmental point cloud data, and the corner speed collector and the data fusion module are connected to transmit vehicle motion information. The side blind-filling laser radar comprises two sides of the vehicle, the side blind-filling laser radars on the two sides respectively have downward-looking capability of covering the visual field of the area within 10 meters of the side of the vehicle by 180 degrees, and the data fusion module is connected with and transmits single-frame point cloud data.

In the preferred embodiment: the vehicle carrying vehicle can be any type of common medium-sized passenger car purchased in the market, and the vehicle speed can be required to be controlled within 100 kilometers per hour.

In some embodiments of the invention:

the vehicle-mounted sensor module is connected with the data fusion module to transmit single-frame environment point cloud data and vehicle-mounted motion information, the data fusion module is connected with the negative obstacle detection module to transmit multi-frame fused point cloud data, and the negative obstacle detection module outputs a continuous negative edge curve to obtain a negative obstacle position.

The side blind-complementing laser radar is arranged on the edge of the upper portion of the side face of the vehicle, the corner speed collector is arranged inside the vehicle, the side blind-complementing laser radar is connected with the data fusion module to transmit single-frame environmental point cloud data, and the corner speed collector and the data fusion module are connected to transmit vehicle motion information.

The laser radar odometer module is connected with the vehicle-mounted sensor module to transmit a plurality of continuous single-frame environmental point clouds carrying vehicles in real time and calculates the pose change of the carrying vehicles according to the inter-frame point cloud matching, the dead reckoning module is connected with the vehicle-mounted sensor module to transmit steering engine corner and speed information of the carrying vehicles in real time, the dead reckoning module is connected with the laser radar odometer module to transmit laser radar mileage, the dead reckoning module is connected with the dead reckoning module to transmit a vehicle body real-time pose calculation result, and the point cloud overlaying module is connected with the dead reckoning module to transmit the fused carrying vehicle position information.

The negative edge extraction module is connected with the data fusion module to transmit multi-frame fused point cloud data, the outer point filtering module is connected with the negative edge extraction module to transmit a negative edge detection result point set, the curve fitting module is connected with the outer point filtering module to transmit the negative edge point set after the outer point is filtered, and the curve fitting module is matched with the negative edge curve to output.

According to the road negative obstacle detection method and system provided by the embodiment of the invention, the special negative obstacle detection blind-repairing laser radar is arranged on the side surface of the vehicle carrier, so that the falling risk of unmanned vehicles such as dams and wharfs is greatly increased, and the safety of pedestrians, ships and the like below the vehicle carrier and the broken cliffs is improved; the blind area of the visual field does not exist, the negative obstacle can be directly sensed at any moment, the problem of negative obstacle detection is solved and the safety of the vehicle is guaranteed by additionally arranging the downward-looking blind-supplementary laser radar on the side surface of the vehicle and designing a corresponding negative obstacle detection method.

It should be noted that, the steps in the method provided by the present invention can be implemented by using corresponding modules, devices, units, and the like in the system, and those skilled in the art can implement the step flow of the method by referring to the technical scheme of the system, that is, the embodiment in the system can be understood as a preferred example of the implementation method, and details are not described herein.

Those skilled in the art will appreciate that, in addition to implementing the system and its various devices provided by the present invention in purely computer readable program code means, the method steps can be fully programmed to implement the same functions by implementing the system and its various devices in the form of logic gates, switches, application specific integrated circuits, programmable logic controllers, embedded microcontrollers and the like. Therefore, the system and various devices thereof provided by the present invention can be regarded as a hardware component, and the devices included in the system and various devices thereof for realizing various functions can also be regarded as structures in the hardware component; means for performing the functions may also be regarded as structures within both software modules and hardware components for performing the methods.

The foregoing description of specific embodiments of the present invention has been presented. It is to be understood that the present invention is not limited to the specific embodiments described above, and that various changes and modifications may be made by one skilled in the art within the scope of the appended claims without departing from the spirit of the invention.