A distance calibration method, device and system based on triangulated laser radar
By calculating the incident angle of the laser and fitting the triangular ranging model, the accuracy and efficiency problems of triangular lidar range calibration were solved, and high-precision range calibration was achieved.
Patent Information
- Application Number
- CN202411148578.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-21
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-08-21
AI Technical Summary
Existing triangular lidar distance calibration methods suffer from low accuracy and low efficiency. The multi-distance calibration board method is space-consuming and costly, the optical coupler identification method has large errors, and the laser module and moving calibration board method has long calibration time and low accuracy.
By collecting the height and horizontal distance differences of the light spot on the calibration plate, the incident angle of the laser is calculated, and the model parameters are obtained by fitting the trigonometric ranging model to eliminate Abbe error and improve calibration accuracy and efficiency.
It achieves high-precision distance calibration, improves production efficiency, eliminates Abbe error, and enhances the measurement accuracy of triangular lidar.
Smart Images

Figure CN118655549B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of laser radar, and in particular relates to a distance calibration method, device and system based on triangulated laser radar. Background Art
[0002] In the production process of triangulated laser radar, the distance calibration process plays a vital role and directly determines the accuracy of the final product. The complexity of this process not only affects production efficiency, but is also directly related to cost control.
[0003] At present, the commonly used distance calibration methods include the multi-distance calibration plate method, the optical coupling angle recognition method, and the laser module and mobile calibration plate method. The multi-distance calibration plate method requires the setting of multiple calibration plates to cover different measurement distances, which takes up a large space and is costly. At the same time, the laser head rotation angle of the laser radar has an accuracy deviation, and it is impossible to ensure that the optical path is consistent each time, which in turn causes the light spot position to shift, affecting the accuracy of the calibration result; in the optical coupling recognition method, when the optical coupling is used for angle recognition, the error existing in it will increase with the increase of the measurement distance, resulting in the accuracy of the initial calibration distance. At the same time, the limitations of the optical coupling angle recognition will cause the error to accumulate during the calibration process, thereby reducing the measurement accuracy; in the laser module and mobile calibration plate method, although the calibration can ensure the consistency of the optical path by moving the calibration plate on the slide rail, the movement accuracy error of the calibration plate is large, and only one data point is collected each time, making it difficult to establish an accurate mathematical model, resulting in long calibration time, low production efficiency, and low measurement accuracy. Summary of the invention
[0004] The present invention provides a distance calibration method, device and system based on triangulated laser radar. The method collects and obtains the height distance difference and the horizontal distance difference of the light spot position on the calibration plate at different positions, calculates the vertical upward incident angle of the laser, and then obtains the virtual light spot corresponding to the light spot based on the fixed position of the calibration plate, and the position of the imaging point corresponding to the virtual light spot on the photosensitive sensor. The virtual light path distance can be calculated, and the model parameter value is obtained by fitting the triangulated ranging model, so that multiple equivalent distance light spots can be obtained based on the same exit light path, Abbe error is eliminated, production efficiency is improved, and calibration accuracy is high.
[0005] A distance calibration method based on triangulated laser radar comprises the following steps:
[0006] Based on the first position and the second position of the calibration plate, respectively collect and obtain the height position of the light spot formed by any parallel sub-beam on the calibration plate, and calculate and obtain the height distance difference of the light spot formed by the parallel sub-beam on the calibration plate at different positions;
[0007] Calculate the incident angle of the laser in the vertical direction based on the horizontal distance difference between the first position and the second position of the calibration plate;
[0008] Based on the first position of the calibration plate, the position of the light spot formed by each parallel sub-beam on the calibration plate is acquired, and based on the position of the virtual light spot formed by each parallel sub-beam on the calibration plate on the laser emission direction line, the corresponding imaging point on the photosensitive sensor is acquired, and the virtual light path distance between the virtual light spot and the photosensitive sensor in the horizontal direction is calculated in combination with the horizontal distance between the lens and the photosensitive sensor;
[0009] Based on the given triangulated ranging model, the model parameter values are fitted to complete the distance calibration of the triangulated lidar model.
[0010] By collecting the height distance difference and horizontal distance difference of the light spot position on the calibration plate at different positions, the vertical upward incident angle of the laser is calculated, and then based on the fixed position of the calibration plate, the virtual light spot corresponding to the light spot and the position of the imaging point corresponding to the virtual light spot on the photosensitive sensor are obtained. The virtual light path distance can be calculated, and the model parameter value can be obtained by combining the triangulation ranging model fitting, so that multiple light spots of equivalent distance can be obtained based on the same output light path, eliminating Abbe error, improving production efficiency, and achieving high calibration accuracy.
[0011] Further, based on the first position and the second position of the calibration plate, respectively collecting and acquiring the height position of the light spot formed by any parallel sub-beam on the calibration plate, and calculating and acquiring the height distance difference of the light spot formed by the parallel sub-beam on the calibration plate at different positions includes the following steps:
[0012] The calibration plate is moved to a first position, the laser is started, and the height position of a first light spot formed on the calibration plate by any parallel sub-beam is collected;
[0013] The calibration plate is moved to a second position, the laser is started, and the height position of the second light spot formed by the same parallel split light beam on the calibration plate is collected;
[0014] Calculating a height distance difference between a first light spot formed by the parallel split light beam at a first position of the calibration plate and a second light spot formed at a second position of the calibration plate;
[0015] ;
[0016] In the formula, Indicates the height distance difference between a first light spot formed by the selected same parallel sub-beam at a first position of the calibration plate and a second light spot formed at a second position of the calibration plate; Indicates the first light spot formed on the first position calibration plate by the selected parallel sub-beam Height; Indicates the second light spot formed on the second position calibration plate by the selected parallel sub-beam Height; Indicates the number of light spots, .
[0017] Furthermore, in combination with the horizontal distance difference between the first position and the second position of the calibration plate, the process of calculating the incident angle of the laser in the vertical direction specifically includes the following steps:
[0018] Acquire the horizontal distance difference between the first position and the second position of the calibration plate;
[0019] Calculate the incident angle of the laser in the vertical direction based on the height difference of the light spots formed by the parallel split light beam on the first position and the second position calibration plate;
[0020] ;
[0021] In the formula, Indicates the incident angle of the laser in the vertical direction; Represents the horizontal distance difference between the calibration plate at the first position and the second position, which is a fixed value.
[0022] Further, based on the first position of the calibration plate, the position of the light spot formed by each parallel sub-beam on the calibration plate is collected and acquired, and based on the position of the virtual light spot formed by each parallel sub-beam on the calibration plate on the laser emission direction line, the position of the corresponding imaging point on the photosensitive sensor, combined with the horizontal distance between the lens and the photosensitive sensor, the process of calculating the virtual light path distance between the virtual light spot and the photosensitive sensor in the horizontal direction specifically includes the following steps:
[0023] Move the calibration plate to the first position, start the laser, and obtain the first light spot formed by each parallel sub-beam on the calibration plate. and calculate the height distance difference between each first light spot and the first light spot;
[0024] Get the virtual light spot formed by each parallel beam based on the laser emission direction line The position of each virtual light spot is determined, and the corresponding imaging point of each virtual light spot on the photosensitive sensor is determined. location;
[0025] Get the position of the lens center corresponding to the photosensitive sensor , and calculate the height distance difference between the imaging point corresponding to each virtual light spot on the photosensitive sensor and the position of the lens center corresponding to the photosensitive sensor;
[0026] Combined with the horizontal distance difference between the lens and the photosensitive sensor, and the incident angle of the laser in the vertical direction, the virtual light spot formed on the laser emission direction line of each parallel sub-beam is calculated to form a virtual light path distance in the horizontal direction between the photosensitive sensor and the virtual light spot formed on the laser emission direction line;
[0027] ;
[0028] In the formula, Indicates the formation of a virtual light spot on the laser emission direction line The virtual optical path distance from the photosensor in the horizontal direction; Indicates that a light spot is formed on the calibration plate at the first position The horizontal distance from the photosensor; Indicates that a light spot is formed on the calibration plate at the first position With light spot The height difference, Indicates that a light spot is formed on the calibration plate at the first position Height; Indicates the corresponding imaging point of each virtual light spot on the photosensor The position on the photosensor corresponding to the center of the lens The height difference, Indicates the height of each virtual light spot corresponding to the imaging point on the photosensor, Indicates the height of the lens center on the photosensitive sensor; Indicates the horizontal distance difference between the lens and the photosensor.
[0029] Furthermore, based on a given triangulation ranging model, the model parameter values are fitted and the process of completing the distance calibration of the triangulation lidar model specifically includes the following steps:
[0030] Substitute the calculated virtual optical path distance, the height of each virtual light spot corresponding to the imaging point on the photosensor, and the incident angle of the laser in the vertical direction into the given triangulation ranging model in sequence, fit and solve the model parameters, update the triangulation ranging model, and complete the distance calibration of the triangulation lidar model;
[0031] The expression of the triangulation model is:
[0032] ;
[0033] In the formula, , , Represents model parameters.
[0034] A device for distance calibration method based on triangulated laser radar, comprising:
[0035] Pedestal;
[0036] A laser radar module, which is mounted on the base and is used to emit laser and receive reflected light spots;
[0037] A beam splitter group, which is arranged on the light output path of the laser emitted by the laser radar module and is used to split the laser emitted by the laser radar module into multiple parallel sub-beams;
[0038] The calibration plate is arranged on the light output path of the beam splitter group and is used for receiving the light spots formed by each parallel sub-beam and reflecting the light spots.
[0039] Furthermore, the laser radar module includes:
[0040] LiDAR module housing;
[0041] A laser, which is installed in the upper part of the laser radar module housing and is used to emit laser;
[0042] A lens, which is installed at the lower part of the laser radar module housing and is used to receive the light spot reflected by the calibration plate;
[0043] A photosensitive sensor is installed at the lower part of the laser radar module housing; the photosensitive sensor is coaxially arranged with the lens in the horizontal direction and is located on the light output path of the lens, and is used to receive the light spot transmitted by the lens.
[0044] Furthermore, the beam splitter group includes a plurality of beam splitters and a reflector; the plurality of beam splitters and the reflector are arranged vertically in sequence to split the light beam emitted by the laser into a plurality of parallel sub-beams.
[0045] Furthermore, it also includes a camera, which is arranged at the front end of the calibration plate and is used to obtain the position of the light spot on the calibration plate; the camera is connected to the laser radar module through an image processor.
[0046] A system for distance calibration method based on triangulated laser radar, comprising:
[0047] A data acquisition module, used for acquiring position data of the light spot on the calibration plate, position data of the calibration plate at the first position and the second position, and position data of imaging points corresponding to each virtual light spot on the photosensitive sensor;
[0048] A data calculation module, used to calculate the incident angle of the laser in the vertical direction, and the virtual light path distance between the virtual light spot and the photosensor in the horizontal direction;
[0049] The data fitting module is used for linear fitting to obtain the model parameter values of the triangulation distance measurement model.
[0050] The beneficial effects of the present invention are:
[0051] The present invention collects and obtains the height distance difference and the horizontal distance difference of the light spot position on the calibration plate at different positions, calculates the vertical upward incident angle of the laser, and then obtains the virtual light spot corresponding to the light spot based on the fixed position of the calibration plate, and the position of the imaging point corresponding to the virtual light spot on the photosensitive sensor, so as to calculate the virtual light path distance, and obtain the model parameter value in combination with the triangulation distance measurement model fitting, so that a plurality of light spots of equivalent distance can be obtained based on the same exit light path, thereby eliminating Abbe error, improving production efficiency, and achieving high calibration accuracy. BRIEF DESCRIPTION OF THE DRAWINGS
[0052] Figure 1 is a flow chart of the present invention;
[0053] Figure 2 It is a structural schematic diagram of the present invention;
[0054] Figure 3 It is a schematic diagram of incident angle calculation of the present invention;
[0055] Figure 4 is a schematic diagram of the virtual optical path distance in the present invention;
[0056] Figure 5 It is a structural schematic diagram of the system in the present invention;
[0057] Figure 6 It is a schematic diagram of the structure of the computer device in the present invention.
[0058] Reference numerals:
[0059] 1. Base;
[0060] 21. LiDAR module housing; 22. Laser; 23. Lens; 24. Photosensitive sensor;
[0061] 3. Beam splitter group; 31. Beam splitter; 32. Reflector;
[0062] 4. Calibration plate;
[0063] 5. Camera; 51. Image processor;
[0064] 6. Memory;
[0065] 7. Processor. DETAILED DESCRIPTION
[0066] 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.
[0067] It should be noted that various aspects of the embodiments within the scope of the appended claims are described below. It should be apparent that the aspects described herein can be embodied in a wide variety of forms, and any specific structure and / or function described herein is merely illustrative. Based on the present disclosure, it should be understood by those skilled in the art that an aspect described herein can be implemented independently of any other aspect, and two or more of these aspects can be combined in various ways. For example, any number of aspects described herein can be used to implement the device and / or practice the method. In addition, other structures and / or functionalities other than one or more of the aspects described herein can be used to implement this device and / or practice this method.
[0068] In addition, in the following description, specific details are provided to facilitate a thorough understanding of the examples, and a person of ordinary skill in the art can understand the specific meanings of the above terms in this application under specific circumstances.
[0069] Example 1
[0070] Figure 1 The method is a distance calibration method based on triangulated laser radar. By collecting and acquiring the height distance difference and horizontal distance difference of the light spot position on the calibration plate 4 at different positions, the vertical incident angle of the laser 22 is calculated, and then based on the fixed position of the calibration plate 4, the virtual light spot corresponding to the light spot and the position of the imaging point corresponding to the virtual light spot on the photosensitive sensor 24 are obtained. The virtual light path distance can be calculated, and the model parameter value can be obtained by fitting the triangulated distance measurement model, so that multiple equivalent distance light spots can be obtained based on the same outgoing light path, Abbe error can be eliminated, production efficiency can be improved, and calibration accuracy is high. Specifically, the following steps are included:
[0071] S1: Based on the first position and the second position of the calibration plate 4, respectively collect and obtain the height position of the light spot formed by any parallel sub-beam on the calibration plate 4, and calculate and obtain the height distance difference of the light spot formed by the parallel sub-beam on the calibration plate 4 at different positions;
[0072] S11: moving the calibration plate 4 to a first position, starting the laser 22, and collecting the height position of a first light spot formed by any parallel sub-beam on the calibration plate 4;
[0073] S12: moving the calibration plate 4 to a second position, starting the laser 22, and collecting the height position of the second light spot formed by the same parallel split light beam on the calibration plate 4;
[0074] S13: Calculating a height distance difference between a first light spot formed by the parallel split light beam at a first position of the calibration plate 4 and a second light spot formed at a second position of the calibration plate 4;
[0075] The calculation expression for the height distance difference between the first light spot formed by the parallel split light beam at the first position of the calibration plate 4 and the second light spot formed at the second position of the calibration plate 4 is:
[0076] ;
[0077] In the formula, represents the height distance difference between a first light spot formed by the selected same parallel sub-beam at a first position of the calibration plate 4 and a second light spot formed at a second position of the calibration plate 4; Indicates the first light spot formed by the selected parallel sub-beam on the first position calibration plate 4 Height; Indicates the second light spot formed by the selected parallel sub-beam on the second position calibration plate 4 Height; Indicates the number of light spots, .
[0078] S2: Calculate the incident angle of the laser 22 in the vertical direction based on the horizontal distance difference between the calibration plate 4 at the first position and the second position;
[0079] S21: Acquire the horizontal distance difference between the calibration plate 4 at the first position and the second position;
[0080] S22: Calculate the incident angle of the laser 22 in the vertical direction based on the height distance difference of the light spots formed by the parallel split light beam on the first position and the second position calibration plate 4;
[0081] The calculation expression of the incident angle of the laser 22 in the vertical direction is:
[0082] ;
[0083] In the formula, represents the incident angle of the laser 22 in the vertical direction; It represents the horizontal distance difference between the calibration plate 4 at the first position and the second position, which is a fixed value.
[0084] Figure 3 The diagram shows the incident angle calculation diagram of the present invention, wherein A represents the first position of the calibration plate 4, and B represents the second position of the calibration plate 4.
[0085] In this embodiment, the beam splitter group 3 includes , , Three beam splitters 31 and A reflector 32 is formed on the calibration plate 4 at A in sequence , , , Four first light spots are formed on the calibration plate 4 at position B in sequence. , , , Four second light spots.
[0086] S3: Based on the first position of the calibration plate 4, the positions of the light spots formed by each parallel sub-beam on the calibration plate 4 are acquired, and the positions of the corresponding imaging points of the virtual light spots formed by each parallel sub-beam on the calibration plate 4 on the laser emission direction line on the photosensitive sensor 24 are acquired, and the virtual light path distance between the virtual light spot and the photosensitive sensor 24 in the horizontal direction is calculated in combination with the horizontal distance between the lens 23 and the photosensitive sensor 24;
[0087] S31: Move the calibration plate 4 to the first position, start the laser 22, and obtain the first light spot formed by each parallel sub-beam on the calibration plate 4 and calculate the height distance difference between each first light spot and the first light spot;
[0088] S32: Obtaining virtual light spots formed on the laser emission direction lines of each parallel sub-beam and determine the position of each virtual light spot corresponding to the imaging point on the photosensitive sensor 24 location;
[0089] S33: Obtaining the position of the center of the lens 23 corresponding to the photosensitive sensor 24 , and calculate the height distance difference between the imaging point corresponding to each virtual light spot on the photosensitive sensor 24 and the position corresponding to the center of the lens 23 on the photosensitive sensor 24;
[0090] S34: combining the horizontal distance difference between the lens 23 and the photosensitive sensor 24 and the incident angle of the laser 22 in the vertical direction, calculating the virtual light path distance between the virtual light spot formed on the laser emission direction line of each parallel sub-beam and the photosensitive sensor 24 in the horizontal direction;
[0091] ;
[0092] In the formula, Indicates the formation of a virtual light spot on the laser emission direction line A virtual light path distance from the light sensor 24 in the horizontal direction; Indicates that a light spot is formed on the calibration plate 4 at the first position The distance from the light sensor 24 in the horizontal direction; Indicates that a light spot is formed on the first position calibration plate 4 With light spot The height difference, Indicates that a light spot is formed on the first position calibration plate 4 Height; Indicates the corresponding imaging point of each virtual light spot on the photosensitive sensor 24 The position on the photosensitive sensor 24 corresponding to the center of the lens 23 The height difference, represents the height of the corresponding imaging point of each virtual light spot on the photosensitive sensor 24, Indicates the height of the center of the lens 23 corresponding to the light sensor 24; Indicates the horizontal distance difference between the lens 23 and the light sensor 24.
[0093] Figure 4 Shown is a schematic diagram of virtual optical path distance calculation.
[0094] S4: Based on the given triangulation ranging model, the model parameter values are fitted to complete the distance calibration of the triangulation lidar model.
[0095] The calculated virtual optical path distance, the height of the corresponding imaging point of each virtual light spot on the photosensor 24, and the incident angle of the laser 22 in the vertical direction are sequentially substituted into the given triangulation ranging model, the model parameters are fitted and solved, the triangulation ranging model is updated, and the distance calibration of the triangulation lidar model is completed.
[0096] Among them, the expression of the triangulation ranging model is:
[0097] ;
[0098] In the formula, , , Represents model parameters.
[0099] Example 2
[0100] Figure 2 What is shown is a distance calibration device based on triangulated laser radar, which includes a base 1, a laser radar module, a spectroscope group 3, a calibration plate 4 and a camera 5.
[0101] Specifically, the laser radar module is mounted on the base 1 and is used to emit laser and receive reflected light spots; it includes:
[0102] Laser radar module housing 21;
[0103] A laser 22, which is installed in the upper part of the laser radar module housing 21 and is used to emit laser;
[0104] The lens 23 is installed at the lower part of the laser radar module housing 21 and is used to receive the light spot reflected by the calibration plate 4;
[0105] The photosensitive sensor 24 is installed at the lower part of the laser radar module housing 21; the photosensitive sensor 24 is coaxially arranged with the lens 23 in the horizontal direction and is located on the light output path of the lens 23, and is used to receive the light spot transmitted by the lens 23.
[0106] Specifically, the beam splitter group 3 is arranged on the light output path of the laser emission of the laser radar module, and is used to split the laser emitted by the laser radar module into multiple parallel sub-beams; the beam splitter group 3 includes multiple beam splitters 31 and a reflector 32; the multiple beam splitters 31 and the reflector 32 are arranged in sequence vertically, and are used to split the light beam emitted by the laser 22 into multiple parallel sub-beams.
[0107] In this embodiment, the spectroscope group 3 includes three spectroscopes 31 and a reflector 32, that is, the first spectroscope 31 transmits a part of the light beam emitted by the laser 22 to the calibration plate 4, and the other part is split to the second spectroscope 31, the second spectroscope 31 reflects a part of the light beam split by the first spectroscope 31 to the calibration plate 4, and the other part is transmitted to the third spectroscope 31, the third spectroscope 31 reflects a part of the light beam transmitted by the second spectroscope 31 to the calibration plate 4, and the other part is transmitted to the reflector 32, and the reflector 32 reflects the received light beam to the calibration plate 4.
[0108] Specifically, the calibration plate 4 is arranged on the light-emitting path of the beam splitter group 3 , and is used to receive the light spots formed by each parallel split light beam and reflect the light spots.
[0109] Specifically, the camera 5 is arranged at the front end of the calibration plate 4 and is used to obtain the position of the light spot on the calibration plate 4 ; the camera 5 is connected to the laser radar module through the image processor 51 .
[0110] Example 3
[0111] like Figure 5 As shown, this embodiment also provides a distance calibration system based on triangulated laser radar, including a data acquisition module, a data calculation module and a data fitting module.
[0112] Specifically, the data acquisition module is used to collect the position data of the light spot on the calibration plate 4, the position data of the calibration plate 4 at the first position and the second position, and the position data of the imaging point corresponding to each virtual light spot on the photosensitive sensor 24;
[0113] Specifically, the data calculation module is used to calculate the incident angle of the laser 22 in the vertical direction and the virtual light path distance between the virtual light spot and the photosensor 24 in the horizontal direction;
[0114] Specifically, the data fitting module is used for linear fitting to obtain the model parameter values of the triangulation ranging model.
[0115] Example 4
[0116] Based on the same technical concept, the embodiment of the present application also provides a computer device, including a memory 6 and a processor 7, such as Figure 6 As shown, the memory 6 stores a computer program, and the processor 7 implements any of the above-mentioned methods when executing the computer program.
[0117] Among them, the memory 6 includes at least one type of readable storage medium, and the readable storage medium includes flash memory, hard disk, multimedia card, card-type memory (for example, SD or DX memory, etc.), magnetic memory, disk, optical disk, etc. In some embodiments, the memory 6 can be an internal storage unit of the distance calibration system based on triangulation laser radar, such as a hard disk. In other embodiments, the memory 6 can also be an external storage device of the distance calibration system based on triangulation laser radar, such as a plug-in hard disk, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card, a flash card (Flash Card), etc. Further, the memory 6 can also include both an internal storage unit and an external storage device of the distance calibration system based on triangulation laser radar. The memory 6 can not only be used to store application software and various types of data installed in the distance calibration system based on triangulation laser radar, such as the code of the distance calibration system program based on triangulation laser radar, but also can be used to temporarily store data that has been output or is to be output.
[0118] In some embodiments, the processor 7 can be a central processing unit (CPU), a controller, a microcontroller, a microprocessor or other data processing chip, used to run the program code stored in the memory 6 or process data, such as executing a distance calibration system program based on a triangulated laser radar.
[0119] The disclosed embodiment of the present invention further provides a computer-readable storage medium, on which a computer program is stored, and the computer program is executed by a processor to perform the steps of the method described in the above method embodiment. The storage medium can be a volatile or non-volatile computer-readable storage medium.
[0120] The computer program product of the application page content refresh method provided in the disclosed embodiment of the present invention includes a computer-readable storage medium storing program code, and the instructions included in the program code can be used to execute the steps of the method described in the above method embodiment. For details, please refer to the above method embodiment, which will not be repeated here.
[0121] The disclosed embodiment of the present invention further provides a computer program, which implements any one of the methods of the aforementioned embodiments when executed by a processor. The computer program product can be implemented in hardware, software, or a combination thereof. In an optional embodiment, the computer program product is specifically embodied as a computer storage medium, and in another optional embodiment, the computer program product is specifically embodied as a software product, such as a software development kit (SDK), etc.
[0122] It can be understood that the same or similar parts of the above embodiments can be referenced to each other, and the contents not described in detail in some embodiments can refer to the same or similar contents in other embodiments.
[0123] It should be noted that, in the description of the present invention, the terms "first", "second", etc. are only used for descriptive purposes and cannot be understood as indicating or implying relative importance. In addition, in the description of the present invention, unless otherwise specified, the meaning of "plurality" refers to at least two.
[0124] Any process or method description in a flowchart or otherwise described herein may be understood to represent a module, segment or portion of code that includes one or more executable instructions for implementing the steps of a specific logical function or process, and the scope of the preferred embodiments of the present invention includes alternative implementations in which functions may not be performed in the order shown or discussed, including performing functions in a substantially simultaneous manner or in the reverse order depending on the functions involved, which should be understood by those skilled in the art to which the embodiments of the present invention belong.
[0125] It should be understood that the various parts of the present invention can be implemented by hardware, software, firmware or a combination thereof. In the above-mentioned embodiments, multiple steps or methods can be implemented by software or firmware stored in a memory and executed by a suitable instruction execution system. For example, if implemented by hardware, as in another embodiment, it can be implemented by any one of the following technologies known in the art or their combination: a discrete logic circuit having a logic gate circuit for implementing a logic function for a data signal, a dedicated integrated circuit having a suitable combination of logic gate circuits, a programmable gate array (PGA), a field programmable gate array (FPGA), etc.
[0126] A person skilled in the art may understand that all or part of the steps in the method for implementing the above-mentioned embodiment may be completed by instructing related hardware through a program, and the program may be stored in a computer-readable storage medium, which, when executed, includes one or a combination of the steps of the method embodiment.
[0127] In addition, each functional unit in each embodiment of the present invention may be integrated into a processing module, or each unit may exist physically separately, or two or more units may be integrated into one module. The above-mentioned integrated module may be implemented in the form of hardware or in the form of a software functional module. If the integrated module is implemented in the form of a software functional module and sold or used as an independent product, it may also be stored in a computer-readable storage medium.
[0128] The storage medium mentioned above can be a read-only memory, a magnetic disk or an optical disk, etc.
[0129] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "examples", "specific examples", or "some examples" means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner.
[0130] Although the embodiments of the present invention have been shown and described above, it is to be understood that the above embodiments are exemplary and are not to be construed as limitations of the present invention. A person skilled in the art may change, modify, replace and vary the above embodiments within the scope of the present invention.
Claims
1. A distance calibration method based on triangulated laser radar, characterized in that: The steps include: Based on the first position and the second position of the calibration plate, respectively collect and obtain the height position of the light spot formed by any parallel sub-beam on the calibration plate, and calculate and obtain the height distance difference of the light spot formed by the parallel sub-beam on the calibration plate at different positions; Calculate the incident angle of the laser in the vertical direction based on the horizontal distance difference between the first position and the second position of the calibration plate; Based on the first position of the calibration plate, the position of the light spot formed by each parallel sub-beam on the calibration plate is acquired, and based on the position of the virtual light spot formed by each parallel sub-beam on the calibration plate on the laser emission direction line, the corresponding imaging point on the photosensitive sensor is acquired, and the virtual light path distance between the virtual light spot and the photosensitive sensor in the horizontal direction is calculated in combination with the horizontal distance between the lens and the photosensitive sensor; Based on the given triangulation ranging model, the model parameter values are fitted to complete the distance calibration of the triangulation lidar model; Based on the first position and the second position of the calibration plate, respectively collecting and acquiring the height position of the light spot formed by any parallel sub-beam on the calibration plate, and calculating and acquiring the height distance difference of the light spot formed by the parallel sub-beam on the calibration plate at different positions includes the following steps: The calibration plate is moved to a first position, the laser is started, and the height position of a first light spot formed on the calibration plate by any parallel sub-beam is collected; The calibration plate is moved to a second position, the laser is started, and the height position of the second light spot formed by the same parallel split light beam on the calibration plate is collected; Calculating a height distance difference between a first light spot formed by the parallel split light beam at a first position of the calibration plate and a second light spot formed at a second position of the calibration plate; ; In the formula, Indicates the height distance difference between a first light spot formed by the selected same parallel sub-beam at a first position of the calibration plate and a second light spot formed at a second position of the calibration plate; Indicates the first light spot formed on the first position calibration plate by the selected parallel sub-beam Height; Indicates the second light spot formed on the second position calibration plate by the selected parallel sub-beam Height; Indicates the number of light spots, ; The process of calculating the incident angle of the laser in the vertical direction based on the horizontal distance difference between the first position and the second position of the calibration plate specifically includes the following steps: Acquire the horizontal distance difference between the first position and the second position of the calibration plate; Calculate the incident angle of the laser in the vertical direction based on the height difference of the light spots formed by the parallel split light beam on the first position and the second position calibration plate; ; In the formula, Indicates the incident angle of the laser in the vertical direction; Indicates the horizontal distance difference between the calibration plate at the first position and the second position, which is a fixed value; Based on the first position of the calibration plate, the position of the light spot formed by each parallel sub-beam on the calibration plate is collected and acquired, and based on the position of the virtual light spot formed by each parallel sub-beam on the calibration plate on the laser emission direction line, the position of the corresponding imaging point on the photosensitive sensor, and the process of calculating the virtual light path distance between the virtual light spot and the photosensitive sensor in the horizontal direction in combination with the horizontal distance between the lens and the photosensitive sensor specifically includes the following steps: Move the calibration plate to the first position, start the laser, and obtain the first light spot formed by each parallel sub-beam on the calibration plate. and calculate the height distance difference between each first light spot and the first light spot; Get the virtual light spot formed by each parallel beam based on the laser emission direction line The position of each virtual light spot is determined, and the corresponding imaging point of each virtual light spot on the photosensitive sensor is determined. location; Get the position of the lens center corresponding to the photosensitive sensor , and calculate the height distance difference between the imaging point corresponding to each virtual light spot on the photosensitive sensor and the position of the lens center corresponding to the photosensitive sensor; Combined with the horizontal distance difference between the lens and the photosensitive sensor, and the incident angle of the laser in the vertical direction, the virtual light spot formed on the laser emission direction line of each parallel sub-beam is calculated to form a virtual light path distance in the horizontal direction between the photosensitive sensor and the virtual light spot formed on the laser emission direction line; ; In the formula, Indicates the formation of a virtual light spot on the laser emission direction line The virtual optical path distance from the photosensor in the horizontal direction; Indicates that a light spot is formed on the calibration plate at the first position The horizontal distance from the photosensor; Indicates that a light spot is formed on the calibration plate at the first position With light spot The height difference, Indicates that a light spot is formed on the calibration plate at the first position Height; Indicates the corresponding imaging point of each virtual light spot on the photosensor The position on the photosensor corresponding to the center of the lens The height difference, Indicates the height of each virtual light spot corresponding to the imaging point on the photosensor, Indicates the height of the lens center on the photosensitive sensor; Indicates the horizontal distance difference between the lens and the photosensor; Based on a given triangulation model, the model parameter values are fitted and the process of completing the distance calibration of the triangulation lidar model includes the following steps: Substitute the calculated virtual optical path distance, the height of each virtual light spot corresponding to the imaging point on the photosensor, and the incident angle of the laser in the vertical direction into the given triangulation ranging model in sequence, fit and solve the model parameters, update the triangulation ranging model, and complete the distance calibration of the triangulation lidar model; The expression of the triangulation model is: ; In the formula, , , Represents model parameters.
2. A system for the distance calibration method based on triangulated laser radar according to claim 1, characterized in that: include: A data acquisition module, used for acquiring position data of the light spot on the calibration plate, position data of the calibration plate at the first position and the second position, and position data of imaging points corresponding to each virtual light spot on the photosensitive sensor; A data calculation module, used to calculate the incident angle of the laser in the vertical direction, and the virtual light path distance between the virtual light spot and the photosensor in the horizontal direction; The data fitting module is used for linear fitting to obtain the model parameter values of the triangulation ranging model.
