Method and device for detecting rotating speed and angle of laser radar, and storage medium

By placing columns around the lidar and analyzing point cloud data using the laser ranging module, the problem of high cost and susceptibility to interference in the lidar heading angle detection is solved, and simplified structure and high-precision angle and speed measurement is achieved, suitable for multiple A navigation device.

CN119001740APending Publication Date: 2024-11-22SHENZHEN YUBU TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410923487.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-10
Publication Date
2024-11-22

AI Technical Summary

Technical Problem

The existing lidar heading angle detection method is costly and large in size, and is easily disturbed by strong external light.

Method used

By placing columns around the lidar, using laser reflected signals and point cloud data to identify column characteristics, calculate the angle and rotation speed of the lidar, eliminating the photoelectric switch and code disk structure, and using the laser ranging module and motor-driven rotation The device performs measurements.

Benefits of technology

It reduces the complexity and volume of the equipment, reduces costs, improves the stability and accuracy of the system, is not susceptible to external interference, and is suitable for a variety of navigation equipment.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119001740A_ABST
    Figure CN119001740A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of laser radars, and discloses a laser radar rotating speed and angle detection method and device, and a storage medium, and the method comprises the steps: placing a certain number of stand columns around a laser radar, receiving a reflection signal through the laser radar, analyzing point cloud data, and recognizing the characteristics of the stand columns; and calculating the angle and rotation speed of the laser radar relative to the column. According to the method, the structure of the laser radar is simplified, the complexity and the size of equipment are reduced, and meanwhile, the measurement precision and the measurement stability are improved. In addition, the method is also suitable for the fields needing accurate navigation and positioning, such as automatic driving automobiles, unmanned aerial vehicles, robots and the like, and has a wide application prospect. The positions and the number of the stand columns can be adjusted according to application requirements so as to adapt to different use environments and requirements. Compared with a traditional scheme using a photoelectric switch and a code disc, the method has the advantages of low cost, high anti-interference capability, simplicity and convenience in implementation and the like.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of laser radar, and specifically relates to a method, device and storage medium for detecting rotation speed and angle of a laser radar. Background Art

[0002] In robot navigation applications (such as sweeping robots), LiDAR has functions such as navigation, mapping, obstacle avoidance, and surveying. In addition to distance measurement information, LiDAR also needs angle and speed information to fuse 2D point cloud data.

[0003] like Figure 1-4 As shown, the current laser radar heading angle detector is composed of a housing, a circuit board, a transmitter, a light receiver, a ring motor, a photoelectric switch, a photoelectric code disk, a wireless data transmission and receiving module, a bottom shell, etc.; the current laser radar heading angle detection method is: the photoelectric switch and the code disk analyze the angle and speed information, and there is a code tooth structure on the structural member. When rotating, the photoelectric switch will generate an obstruction to form a coded signal. The control box in the distance measuring device rotates with the motor relative to the code disk, so that the point teeth and the equidistant teeth pass between the corresponding positions of the light transmitter and the light receiver. When the point teeth or the distance measuring teeth are exactly at the corresponding position, the light receiver outputs a high level, and other positions output a low level. As the control box rotates one circle relative to the code disk, the light receiver outputs a signal to the control unit. This solution is costly, and the photoelectric switch has a certain volume, so the diameter of the rotating part is not small, and the photoelectric switch is easily interfered by strong external light. Summary of the invention

[0004] The problem to be solved by the present invention is that the laser radar heading angle detection method uses a photoelectric switch and a code disk to analyze the angle and speed information, but the cost is high and the volume is large, and the photoelectric switch is easily interfered by strong external light. In order to make up for the shortcomings of the prior art, the present invention proposes a laser radar speed and angle detection method, device, and storage medium.

[0005] To achieve the above object, the present invention provides the following technical solutions:

[0006] A method for detecting rotation speed and angle of a laser radar comprises the following steps:

[0007] S1. Place a certain number of pillars around the laser radar, one of which is different from the other pillars;

[0008] S2, the laser radar emits laser, and when the laser hits the pillar, it is reflected back, and the laser radar receives these reflected signals at the same time;

[0009] S3, by analyzing the received point cloud data, identifying the features of the column, that is, the features missing at a certain angle;

[0010] S4, by comparing the position changes of the pillar features between consecutive frames, the angle of the laser radar relative to the pillar is calculated, and at the same time, the rotation speed of the laser radar is calculated by measuring the time difference of the appearance of the pillar features;

[0011] S5, converting the calculated angle and speed information into electrical signals for subsequent processing and application;

[0012] S6. Process the obtained speed and angle data to meet the requirements of specific applications.

[0013] Preferably, a ranging device and a rotating device are provided on the robot body, and laser pulses are emitted by the ranging device. When these pulses encounter columns, they are blocked by the columns, thereby causing a sudden change or omission in the ranging data received by the laser radar. This change or omission is recognized by the laser radar and used to determine the position and relative angle of the column.

[0014] Preferably, the distance measuring device comprises a base, a motor, a control box, a distance measuring module, and a radar cover;

[0015] The motor is arranged on the base, the motor driving control box is rotatably connected to the base, the ranging module is integrally arranged on the control box, and under the drive of the motor, relative rotation occurs between the ranging module and the radome, the columns are located around the radome and are used to support the radome, and the ranging module is a laser ranging module, such as a photoelectric detection device ranging sensor, a time-of-flight ranging sensor, a triangulation ranging sensor, etc.

[0016] Preferably, the number of pillars is N, N is greater than 1, and obtaining the period of the target signal includes: obtaining the number of periodic signals within the target time, and a periodic signal refers to a signal generated by the laser ranging module when two adjacent pillars are blocked.

[0017] Preferably, the size of one of the pillars is larger or smaller than the size of the remaining pillars.

[0018] Preferably, when the laser pulse emitted by the laser radar encounters a pillar, occlusion will occur, resulting in missing features at a specific angle in the point cloud data. By comparing the position changes of the pillar features between consecutive frames, the angle of the laser radar relative to the pillar is calculated;

[0019] A special case is: when three pillars are placed around the laser radar, the period of pillar feature change between consecutive scanning frames of the laser radar is T, then the feature change within one period can be divided into three equal stages, the corresponding angle is 120 degrees, and the time difference of each pillar feature is T / 3;

[0020] The rotation speed is n = 1 / T Hz, which is converted into rpm as n = 60 / T rpm. T is decomposed into T = T1 + T2 + T3, so the instantaneous rotation speed between the three columns is 20 / T1 rpm, 20 / T2 rpm, and 20 / T3 rpm.

[0021] Preferably, the special column is set to 0 degrees, and the other two periodic signal time points are set to 120 and 240 degrees respectively. The middle position needs to be added with W△t, where W is the angular velocity, △t is the time difference from the nearest column, W=360*n, in degrees / second.

[0022] A laser radar rotation speed and angle detection device includes a robot and a laser ranging sensor, a motor, a column, a memory, a processor and a computer program stored in the memory and executable on the processor. When the processor executes the computer program, the above-mentioned laser radar rotation speed and angle measurement calculation method is implemented.

[0023] A computer-readable storage medium stores a computer program, wherein the computer program implements the above-mentioned laser radar rotation speed and angle measurement calculation method when executed by a processor.

[0024] Compared with the prior art, the technical effects and advantages of the present invention are:

[0025] The laser radar rotation speed and angle detection method, device, and storage medium, the laser radar emits laser pulses, when these pulses encounter pillars, they will be blocked by the pillars, thereby causing a sudden change or loss in the distance measurement data received by the laser radar, by comparing the position changes of the pillar features between consecutive frames, the angle of the laser radar relative to the pillar can be calculated, and by measuring the time difference of the appearance of the pillar features, the rotation speed of the laser radar can be calculated. The laser radar system measures the distance by emitting laser beams. When these laser beams are blocked by pillars set at specific positions, the system will record the blocking event, so that the rotation speed and direction of the radar system can be determined.

[0026] Eliminating the expensive photoelectric switches and complex code disk structure, simplifying the structure of the laser radar, reducing mechanical components, and thus reducing the complexity and volume of the equipment, this method can reduce costs, especially in large-scale production, because no additional photoelectric switches and code disks are required. This method does not rely on external light sources, so it is not easily affected by strong external light or electromagnetic interference, and improves the stability and reliability of the system. The position and number of columns can be adjusted according to the needs of specific applications, so as to adapt to different usage environments and requirements, with good flexibility.

[0027] By analyzing the pillar features in the point cloud data, the angle and rotation speed of the lidar can be accurately calculated, thereby improving the measurement accuracy. This method utilizes the lidar's own capabilities to measure angles and rotation speeds, and does not require additional hardware, making it easier to implement. This method is not only suitable for cleaning equipment such as sweepers, but can also be widely used in self-driving cars, drones, robots, and other fields that require precise navigation and positioning. BRIEF DESCRIPTION OF THE DRAWINGS

[0028] Figure 1 It is a structural schematic diagram of a laser radar heading angle detector in the prior art;

[0029] Figure 2 It is an exploded view of a laser radar heading angle detector in the prior art;

[0030] Figure 3 for Figure 1 Schematic diagram of the structure after the middle shell and the bottom shell are removed;

[0031] Figure 4 It is a schematic diagram of the structure of the photoelectric encoder on the laser radar heading angle detector in the prior art;

[0032] Figure 5 It is a structural schematic diagram of the first viewing angle of the distance measuring device of the present invention;

[0033] Figure 6 It is a structural schematic diagram of the second viewing angle of the distance measuring device of the present invention;

[0034] Figure 7 It is a flow chart of the present invention.

[0035] In the figure: 1. housing; 2. circuit board; 3. transmitter; 4. optical receiver; 5. ring motor; 6. photoelectric switch; 7. photoelectric encoder; 8. wireless data transmitting and receiving module; 9. bottom shell;

[0036] 100. Sweeping machine body; 200. Base; 300. Motor; 400. Control box; 500. Radar cover; 600. Column; 700. Distance measurement module. DETAILED DESCRIPTION

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

[0038] The following is combined with Figure 5-7 To further explain this application in detail,

[0039] The present application discloses a method for detecting rotation speed and angle of a laser radar, comprising the following steps:

[0040] S1. Place a certain number of pillars around the laser radar, one of which is different from the other pillars;

[0041] S2, the laser radar emits laser, and when the laser hits the pillar, it is reflected back, and the laser radar receives these reflected signals at the same time;

[0042] S3, by analyzing the received point cloud data, identifying the features of the column, that is, the features missing at a certain angle;

[0043] S4, by comparing the position changes of the pillar features between consecutive frames, the angle of the laser radar relative to the pillar is calculated, and at the same time, the rotation speed of the laser radar is calculated by measuring the time difference of the appearance of the pillar features;

[0044] S5, converting the calculated angle and speed information into electrical signals for subsequent processing and application;

[0045] S6. Process the obtained speed and angle data to meet the requirements of specific applications.

[0046] Compared with the traditional solution of using photoelectric switches and code disks, this method simplifies the structure of the lidar and reduces mechanical components, thereby reducing the complexity and volume of the equipment. Since no additional photoelectric switches and code disks are required, this method can reduce costs, especially in mass production.

[0047] This method does not rely on external light sources, so it is not easily affected by strong external light or electromagnetic interference, which improves the stability and reliability of the system. By analyzing the column features in the point cloud data, the angle and rotation speed of the lidar can be accurately calculated, improving the accuracy of the measurement. This method uses the lidar's own ability to measure angles and rotation speeds, and does not require additional hardware, making it easier to implement. This method is not only suitable for cleaning equipment such as sweepers, but can also be widely used in fields such as self-driving cars, drones, robots, etc. that require precise navigation and positioning.

[0048] The position and number of columns can be adjusted according to the needs of specific applications to adapt to different usage environments and requirements.

[0049] Specifically, a ranging device and a rotating device are set on the robot body. Laser pulses are emitted by the ranging device. When these pulses encounter pillars, they will be blocked by the pillars, thereby causing a sudden change or loss in the ranging data received by the laser radar. This change or loss is recognized by the laser radar and used to determine the position and relative angle of the pillar.

[0050] The distance measuring device comprises a base, a motor, a control box, a distance measuring module and a radar cover;

[0051] The motor is arranged on the base, the motor drive control box is rotatably connected to the base, the ranging module is integrally arranged on the control box, and under the drive of the motor, relative rotation occurs between the ranging module and the radome, and the columns are located around the radome and are used to support the radome.

[0052] The distance measurement module is a laser distance measurement module, such as a photoelectric detection device (Position Sensitive Detector, PSD) distance measurement sensor, a time of flight (Time Of Flight, TOF) distance measurement sensor, a triangulation distance measurement sensor, etc. It can be expanded to be one or more of optical, acoustic, millimeter wave, and microwave sensors.

[0053] Specifically, the number of the pillars is N, and N is greater than 1, then obtaining the period of the target signal includes: obtaining the number of periodic signals within the target time, and a periodic signal refers to a signal generated by the laser ranging module when two adjacent pillars are blocked.

[0054] Specifically, three pillars are placed around the laser radar, each pillar is arranged at an interval of 120 degrees, and the size of one of the pillars is larger or smaller than the sizes of the other pillars.

[0055] When the laser pulse emitted by the LiDAR encounters a pillar, it will be blocked, resulting in the loss of features at a specific angle in the point cloud data. By comparing the position changes of the pillar features between consecutive frames, the angle of the LiDAR relative to the pillar is calculated.

[0056] A special case is: when three pillars are placed around the laser radar, the period of pillar feature change between consecutive scanning frames of the laser radar is T, then the feature change within one period can be divided into three equal stages, the corresponding angle is 120 degrees, and the time difference of each pillar feature is T / 3;

[0057] The rotation speed is n = 1 / T Hz, which is converted into rpm as n = 60 / T rpm. T is decomposed into T = T1 + T2 + T3, so the instantaneous rotation speed between the three columns is 20 / T1 rpm, 20 / T2 rpm, and 20 / T3 rpm.

[0058] The special column is set to 0 degrees, and the other two periodic signal time points are set to 120 and 240 degrees respectively. The middle position needs to be added with W△t, where W is the angular velocity, △t is the time difference from the nearest column, W=360*n, in degrees / second.

[0059] A laser radar rotation speed and angle detection device includes a robot and a laser ranging sensor, a motor, a column, a memory, a processor and a computer program stored in the memory and executable on the processor. When the processor executes the computer program, the above-mentioned laser radar rotation speed and angle measurement calculation method is implemented.

[0060] A computer-readable storage medium stores a computer program, wherein the computer program implements the above-mentioned laser radar rotation speed and angle measurement calculation method when executed by a processor.

[0061] The LiDAR system measures distance by emitting laser beams. When these laser beams are blocked by pillars set at specific positions, the system will record the blockage event. Since the position of the pillar is fixed, the position of the blocked laser can be used to determine the angular position of the pillar. When the LiDAR system is rotating, the time point when each pillar is blocked will be recorded, and these time points can be used to calculate the rotation period of the radar system. Since the rotation speed is the reciprocal of the cycle time, the rotation speed of the radar system can be obtained by taking the reciprocal of the cycle. In simple terms, the rotation speed and direction of the radar system are determined by measuring the time interval when the laser beam is blocked by the pillar.

[0062] The method, device, and storage medium for detecting the rotation speed and angle of the laser radar use a column to block the laser to detect the rotation speed and angle. This method is not affected by external strong light because the signal generated by the column blocking is generated by the laser of the laser radar system itself, rather than relying on an external light source. This is different from the traditional photoelectric switch solution, which is easily disturbed by strong external light (such as sunlight). Since the position of the column is fixed, the position of the blocked laser can be accurately used to determine the angular position of the column. This method can provide high-precision angle information, while traditional photoelectric switches and code disk solutions may introduce errors due to factors such as the manufacturing tolerance of the code disk and the response time of the photoelectric switch. The present invention eliminates expensive photoelectric switches and complex code disk structures, so the overall cost is lower. The traditional solution requires additional hardware to generate and parse the coded signal, while the new solution uses the existing laser radar system itself to generate the signal, reducing additional hardware costs and complexity.

[0063] Finally, it should be noted that the above is only a preferred embodiment of the present invention and is not intended to limit the present invention. Although the present invention has been described in detail with reference to the aforementioned embodiments, it is still possible for those skilled in the art to modify the technical solutions described in the aforementioned embodiments or to make equivalent substitutions for some of the technical features therein. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the protection scope of the present invention.

Claims

1. A method for detecting rotation speed and angle of a laser radar, characterized in that: The steps include: S1. Place a certain number of pillars around the laser radar, one of which is different from the other pillars; S2, the laser radar emits laser, and when the laser hits the pillar, it is reflected back, and the laser radar receives these reflected signals at the same time; S3, identifying the features of the column, i.e., the missing features at a certain angle, by analyzing the received point cloud data; S4, by comparing the position changes of the pillar features between consecutive frames, the angle of the laser radar relative to the pillar is calculated, and at the same time, the rotation speed of the laser radar is calculated by measuring the time difference of the appearance of the pillar features; S5, converting the calculated angle and speed information into electrical signals for subsequent processing and application; S6. Process the obtained speed and angle data to meet the requirements of specific applications.

2. The method for detecting rotation speed and angle of a laser radar according to claim 1, characterized in that: A ranging device and a rotating device are set on the robot body. Laser pulses are emitted through the ranging device. When these pulses encounter columns, they will be blocked by the columns, resulting in a sudden change or loss in the ranging data received by the laser radar. This change or loss is recognized by the laser radar and used to determine the position and relative angle of the column.

3. The method for detecting rotation speed and angle of a laser radar according to claim 2, characterized in that: The distance measuring device comprises a base, a motor, a control box, a distance measuring module and a radar cover; The motor is arranged on the base, the motor drive control box is rotatably connected to the base, the ranging module is integrally arranged on the control box, and under the drive of the motor, relative rotation occurs between the ranging module and the radome, and the columns are located around the radome and are used to support the radome.

4. The method for detecting rotation speed and angle of a laser radar according to claim 3, characterized in that: The distance measurement module is a laser distance measurement module.

5. The method for detecting rotation speed and angle of a laser radar according to claim 1, characterized in that: The number of the pillars is N, and N is greater than 1. Then, obtaining the period of the target signal includes: obtaining the number of periodic signals within the target time, and a periodic signal refers to a signal generated by the laser ranging module when two adjacent pillars are blocked.

6. The method for detecting rotation speed and angle of a laser radar according to claim 5, characterized in that: The size of one of the pillars is larger or smaller than the size of the remaining pillars.

7. The method for detecting rotation speed and angle of a laser radar according to claim 6, characterized in that: When the laser pulse emitted by the LiDAR encounters a pillar, it will be blocked, resulting in the loss of features at a specific angle in the point cloud data. By comparing the position changes of the pillar features between consecutive frames, the angle of the LiDAR relative to the pillar is calculated. A special case is: when three pillars are placed around the laser radar, the period of pillar feature change between consecutive scanning frames of the laser radar is T, then the feature change within one period can be divided into three equal stages, the corresponding angle is 120 degrees, and the time difference of each pillar feature is T / 3; The rotation speed is n = 1 / T Hz, which is converted into rpm as n = 60 / T rpm. T is decomposed into T = T1 + T2 + T3, so the instantaneous rotation speed between the three columns is 20 / T1 rpm, 20 / T2 rpm, and 20 / T3 rpm.

8. The method for detecting rotation speed and angle of a laser radar according to claim 7, characterized in that: The special column is set to 0 degrees, and the other two periodic signal time points are set to 120 and 240 degrees respectively. The middle position needs to be added with W△t, where W is the angular velocity, △t is the time difference from the nearest column, W=360*n, in degrees / second.

9. A laser radar speed and angle detection device, comprising a robot and a laser ranging sensor, a motor, a column, a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the laser radar rotation speed and angle measurement calculation method as described in any one of claims 1 to 8 is implemented.

10. A computer-readable storage medium storing a computer program, characterized in that: When the computer program is executed by a processor, the laser radar rotation speed and angle measurement calculation method as described in any one of claims 1 to 8 is implemented.