Position measurement method and device based on checkerboard target and storage medium

By determining the center position of the checkerboard target and using a total reflection prism, the measurement deviation problem caused by the incident angle of the laser rangefinder is solved, and the accuracy of spatial coordinate measurement is improved.

CN118960569APending Publication Date: 2024-11-15FUJIAN HUICHUAN DIGITAL TECH
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202411268926.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-11
Publication Date
2024-11-15

AI Technical Summary

Technical Problem

When using the checkerboard target for spatial coordinate measurement, the incident angle between the laser rangefinder and the checkerboard target is too large, resulting in a laser distance measurement deviation, which in turn affects the accuracy of measurement positioning.

Method used

By determining the center position coordinates of the checkerboard target, the laser rangefinder is controlled to emit laser signals to the center position, and the laser echo signal is obtained using a total reflection prism, the relative distance and the angle of the equipment pantometer are calculated, and the spatial coordinates of the position to be measured are accurately positioned. .

Benefits of technology

It effectively avoids measurement deviations and improves the accuracy and accuracy of spatial coordinate measurement.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118960569A_ABST
    Figure CN118960569A_ABST
Patent Text Reader

Abstract

The invention provides a position measurement method and device based on a checkerboard target and a storage medium, and the method comprises the steps: responding to a condition that the checkerboard target is placed at a to-be-measured position, adjusting an equipment holder, and enabling the checkerboard target to be located in an image collection range of an image collection device; reading a checkerboard image acquired by an image acquisition device, and determining corner point pixel coordinates of each preset checkerboard corner point in the checkerboard image; based on the angular point pixel coordinate of each preset checkerboard angular point, determining the center position coordinate of the checkerboard target; the laser range finder is controlled to emit a laser signal to the center position coordinate, a laser echo signal fed back by the total reflection prism is obtained, and the relative distance between the range finder and the checkerboard target is determined; and based on the relative distance and the current horizontal setting angle and the current vertical setting angle of the equipment holder, determining space coordinates of the position to be measured. Therefore, the measurement result deviation is avoided, and the accuracy of the measurement result is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of distance measurement technology, and in particular to a position measurement method, device and storage medium based on a chessboard target. Background Art

[0002] As checkerboard targets are widely used in engineering measurement, the precise positioning of the spatial coordinates of the measurement position in the engineering measurement environment by means of checkerboard targets has become an important auxiliary means in the field of engineering measurement.

[0003] Normally, when using a checkerboard target for spatial coordinate identification, the spatial coordinates of the position to be measured need to be calculated based on parameters such as the distance between the measuring device and the position to be measured and the device pan / tilt angle. However, due to reasons such as the large incident angle between the laser rangefinder and the checkerboard target, there is a deviation between the laser distance obtained by the laser rangefinder and the actual laser distance, which increases the error between the measured positioning of the spatial coordinates and the actual measured positioning. Summary of the invention

[0004] In view of this, the purpose of the present application is to provide a position measurement method, device and storage medium based on a checkerboard target. When measuring the spatial coordinates of the position to be measured, by determining the center position coordinates of the checkerboard target, it is ensured that the laser rangefinder emits a laser signal to the center position coordinates, thereby avoiding measurement deviations and improving the accuracy of the measurement results.

[0005] The present application provides a position measurement method based on a chessboard target, which is applied to a distance measurement device; the distance measurement device includes a device gimbal, an image acquisition device and a laser rangefinder; the position measurement method includes:

[0006] In response to a checkerboard target being placed at a position to be measured, adjusting the device pan / tilt so that the checkerboard target is located within an image acquisition range of the image acquisition device;

[0007] Determine the pixel coordinates of each preset checkerboard corner point in the checkerboard image by reading the checkerboard image acquired by the image acquisition device;

[0008] Determine the center position coordinates of the checkerboard target based on the pixel coordinates of each preset checkerboard corner point;

[0009] Control the laser rangefinder to emit a laser signal to the center position coordinate, obtain the laser echo signal fed back by the total reflection prism, and determine the relative distance between the distance measuring device and the checkerboard target; wherein the total reflection prism is set at the center position of the checkerboard target;

[0010] Based on the relative distance, a current horizontal setting angle and a current vertical setting angle of the device gimbal, the spatial coordinates of the position to be measured are determined.

[0011] In a possible implementation, adjusting the device pan / tilt so that the checkerboard target is located within the image acquisition range of the image acquisition device includes:

[0012] By adjusting the horizontal setting angle and the vertical setting angle of the equipment pan / tilt, the checkerboard target is set within the image acquisition range of the image acquisition device.

[0013] In a possible implementation, the determining the corner pixel coordinates of each preset checkerboard corner point in the checkerboard image by reading the checkerboard image acquired by the image acquisition device includes:

[0014] Calculating the checkerboard image according to a checkerboard corner point recognition algorithm to determine a pixel coordinate array of corner points of the checkerboard image;

[0015] The corner point pixel coordinate array includes the corner point pixel coordinates of each preset chessboard corner point in the chessboard image.

[0016] In a possible implementation, the corner point pixel coordinates include X-axis coordinates and Y-axis coordinates; and determining the center position coordinates of the checkerboard target based on the corner point pixel coordinates of each preset checkerboard corner point includes:

[0017] Based on the pixel coordinates of each preset checkerboard corner point, a straight line equation of two target diagonals in the checkerboard target is obtained by fitting according to a straight line fitting algorithm;

[0018] Based on the straight line equations of the two diagonal lines of the target in the checkerboard target, the pixel coordinates of the intersection of the two diagonal lines are calculated, and the pixel coordinates of the intersection are determined as the center position coordinates of the checkerboard target.

[0019] In a possible implementation manner, the step of acquiring the laser echo signal fed back by the total reflection prism and determining the relative distance between the distance measuring device and the checkerboard target includes:

[0020] In response to receiving a laser echo signal fed back by a total reflection prism, acquiring the emission time of the laser signal and the echo time of the laser echo signal;

[0021] Based on the emission time and the echo time, combined with the emission speed of the laser signal, the relative distance between the distance measuring device and the checkerboard target is determined.

[0022] In a possible implementation manner, the number of rows and columns of the checkerboard target is a positive odd number; a prism gap is reserved in a central cell of the checkerboard target; and the prism gap is not connected to an edge of the central cell.

[0023] In a possible implementation manner, the prism notch is circular; and the total reflection prism is cylindrical.

[0024] The embodiment of the present application also provides a position measurement device based on a chessboard target, which is applied to a distance measurement device; the distance measurement device includes a device gimbal, an image acquisition device and a laser rangefinder; the position measurement device includes:

[0025] A pan-tilt adjustment module, configured to adjust the device pan-tilt in response to a checkerboard target being placed at a position to be measured, so that the checkerboard target is located within an image acquisition range of the image acquisition device;

[0026] A first coordinate determination module, configured to determine the corner pixel coordinates of each preset chessboard corner point in the chessboard image by reading the chessboard image acquired by the image acquisition device;

[0027] A second coordinate determination module, used to determine the center position coordinates of the checkerboard target based on the corner point pixel coordinates of each preset checkerboard corner point;

[0028] A distance determination module, used to control the laser rangefinder to emit a laser signal to the center position coordinates, obtain the laser echo signal fed back by the total reflection prism, and determine the relative distance between the distance measuring device and the checkerboard target; wherein the total reflection prism is set at the center position of the checkerboard target;

[0029] The spatial coordinate determination module is used to determine the spatial coordinates of the position to be measured based on the relative distance, the current horizontal setting angle and the current vertical setting angle of the device gimbal.

[0030] In a possible implementation manner, when the pan / tilt adjustment module is used to adjust the device pan / tilt so that the checkerboard target is located within the image acquisition range of the image acquisition device, the pan / tilt adjustment module is used to:

[0031] By adjusting the horizontal setting angle and the vertical setting angle of the equipment pan / tilt, the checkerboard target is set within the image acquisition range of the image acquisition device.

[0032] In a possible implementation manner, when the first coordinate determination module is used to determine the corner pixel coordinates of each preset checkerboard corner point in the checkerboard image by reading the checkerboard image acquired by the image acquisition device, the first coordinate determination module is used to:

[0033] Calculating the checkerboard image according to a checkerboard corner point recognition algorithm to determine a pixel coordinate array of corner points of the checkerboard image;

[0034] The corner point pixel coordinate array includes the corner point pixel coordinates of each preset chessboard corner point in the chessboard image.

[0035] In a possible implementation, the corner point pixel coordinates include X-axis coordinates and Y-axis coordinates; when the second coordinate determination module is used to determine the center position coordinates of the checkerboard target based on the corner point pixel coordinates of each preset checkerboard corner point, the second coordinate determination module is used to:

[0036] Based on the pixel coordinates of each preset checkerboard corner point, a straight line equation of two target diagonals in the checkerboard target is obtained by fitting according to a straight line fitting algorithm;

[0037] Based on the straight line equations of the two target diagonals in the checkerboard target, the pixel coordinates of the intersection of the two diagonals are calculated, and the pixel coordinates of the intersection are determined as the center position coordinates of the checkerboard target.

[0038] In a possible implementation manner, when the distance determination module is used to obtain the laser echo signal fed back by the total reflection prism to determine the relative distance between the distance measuring device and the checkerboard target, the distance determination module is used to:

[0039] In response to receiving a laser echo signal fed back by a total reflection prism, acquiring the emission time of the laser signal and the echo time of the laser echo signal;

[0040] Based on the emission time and the echo time, combined with the emission speed of the laser signal, the relative distance between the distance measuring device and the checkerboard target is determined.

[0041] In a possible implementation manner, the number of rows and columns of the checkerboard target is a positive odd number; a prism gap is reserved in a central cell of the checkerboard target; and the prism gap is not connected to an edge of the central cell.

[0042] In a possible implementation manner, the prism notch is circular; and the total reflection prism is cylindrical.

[0043] An embodiment of the present application also provides an electronic device, comprising: a processor, a memory and a bus, wherein the memory stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor and the memory communicate through the bus, and when the machine-readable instructions are executed by the processor, the steps of the position measurement method based on the checkerboard target are performed as described above.

[0044] An embodiment of the present application further provides a computer-readable storage medium having a computer program stored thereon. When the computer program is executed by a processor, the steps of the position measurement method based on the checkerboard target as described above are executed.

[0045] The position measurement method, device and storage medium based on the checkerboard target provided by the embodiment of the present application are in response to the checkerboard target being placed at the position to be measured, by adjusting the equipment pan-tilt, the checkerboard target is located within the image acquisition range of the image acquisition device; by reading the checkerboard image acquired by the image acquisition device, the pixel coordinates of the corner points of each preset checkerboard corner point in the checkerboard image are determined; based on the pixel coordinates of the corner points of each preset checkerboard corner point, the center position coordinates of the checkerboard target are determined; the laser rangefinder is controlled to emit a laser signal to the center position coordinates, and the laser echo signal fed back by the total reflection prism is obtained to determine the relative distance between the distance measuring device and the checkerboard target; wherein the total reflection prism is set at the center position of the checkerboard target; based on the relative distance, the current horizontal setting angle and the current vertical setting angle of the equipment pan-tilt, the spatial coordinates of the position to be measured are determined. In this way, when the spatial coordinates of the position to be measured are measured, by determining the center position coordinates of the checkerboard target, it is ensured that the laser rangefinder emits a laser signal to the center position coordinates, thereby avoiding measurement deviation and improving the accuracy of the measurement result.

[0046] In order to make the above-mentioned objects, features and advantages of the present application more obvious and easy to understand, preferred embodiments are specifically cited below and described in detail with reference to the attached drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0047] In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings required for use in the embodiments will be briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present application and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without paying creative work.

[0048] Figure 1 A flowchart of a position measurement method based on a checkerboard target provided in an embodiment of the present application;

[0049] Figure 2 A schematic diagram of a checkerboard target provided in an embodiment of the present application;

[0050] Figure 3 A schematic diagram of the structure of a position measurement device based on a chessboard target provided in an embodiment of the present application;

[0051] Figure 4 A schematic diagram of the structure of an electronic device provided in an embodiment of the present application. DETAILED DESCRIPTION

[0052] To make the purpose, technical scheme and advantages of the embodiments of the present application clearer, the technical scheme in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only a part of the embodiments of the present application, rather than all of the embodiments. The components of the embodiments of the present application usually described and shown in the drawings here can be arranged and designed in various different configurations. Therefore, the following detailed description of the embodiments of the present application provided in the drawings is not intended to limit the scope of the application claimed for protection, but merely represents the selected embodiments of the present application. Based on the embodiments of the present application, each other embodiment obtained by those skilled in the art without making creative work belongs to the scope of protection of the present application.

[0053] Research has found that with the widespread use of checkerboard targets in engineering measurement, the precise positioning of the spatial coordinates of the measurement position in the engineering measurement environment using checkerboard targets has become an important auxiliary means in the field of engineering measurement.

[0054] Normally, when using a checkerboard target for spatial coordinate identification, the spatial coordinates of the position to be measured need to be calculated based on parameters such as the distance between the measuring device and the position to be measured and the device pan / tilt angle. However, due to reasons such as the large incident angle between the laser rangefinder and the checkerboard target, there is a deviation between the laser distance obtained by the laser rangefinder and the actual laser distance, which increases the error between the measured positioning of the spatial coordinates and the actual measured positioning.

[0055] Based on this, an embodiment of the present application provides a position measurement method based on a checkerboard target. When measuring the spatial coordinates of the position to be measured, by determining the center position coordinates of the checkerboard target, the laser rangefinder can be ensured to emit a laser signal to the center position coordinates, thereby avoiding measurement deviations and improving the accuracy of the measurement results.

[0056] See also Figure 1 , Figure 1 A flowchart of a position measurement method based on a chessboard target provided in an embodiment of the present application. Applied to a distance measuring device; the distance measuring device includes a device pan / tilt, an image acquisition device and a laser rangefinder; Figure 1 As shown in , the position measurement method based on the checkerboard target provided in the embodiment of the present application includes:

[0057] S101 , in response to a checkerboard target being placed at a position to be measured, adjusting the device pan / tilt so that the checkerboard target is located within an image acquisition range of the image acquisition device.

[0058] S102, determining the corner pixel coordinates of each preset chessboard corner point in the chessboard image by reading the chessboard image acquired by the image acquisition device.

[0059] S103, determining the center position coordinates of the checkerboard target based on the corner point pixel coordinates of each preset checkerboard corner point.

[0060] S104, controlling the laser rangefinder to emit a laser signal to the center position coordinates, acquiring a laser echo signal fed back by a total reflection prism, and determining a relative distance between the distance measuring device and the checkerboard target.

[0061] S105. Determine the spatial coordinates of the position to be measured based on the relative distance, a current horizontal setting angle and a current vertical setting angle of the device gimbal.

[0062] The embodiment of the present application provides a position measurement method based on a checkerboard target. According to the pixel coordinates of each preset checkerboard corner point in the checkerboard target in the image coordinate system, the center position coordinates of the checkerboard target are determined to control the laser rangefinder to emit a laser signal to the center position coordinates, thereby avoiding the spatial coordinate measurement deviation caused by the laser incident angle.

[0063] In addition, a total reflection prism is set at the center of the checkerboard target to avoid the problem of inaccurate spatial coordinate measurement results of the measured position due to the low reflectivity of the surface material of the checkerboard target. In this way, the accuracy of the measurement results can be further guaranteed and the measurement precision can be improved.

[0064] Here, considering that the reflectivity of the surface material of the traditional checkerboard target is too low, which may cause measurement errors, a total reflection prism is set at the center of the traditional checkerboard target to improve the reflectivity of the checkerboard target through the total reflection prism.

[0065] In one embodiment, the device gimbal is an electric gimbal that can rotate horizontally and vertically in two axes, and the laser rangefinder and the image acquisition device are arranged in parallel on the device gimbal.

[0066] In one embodiment, see Figure 2 , Figure 2 A schematic diagram of a checkerboard target provided in an embodiment of the present application. Figure 2 As shown, the number of rows and columns of the checkerboard target is N, where N is a positive odd number; a prism gap is reserved in the central cell of the checkerboard target; the prism gap is not connected to the edge of the central pixel block, thereby retaining the edge features of the central cell and the adjacent pixel blocks.

[0067] In one embodiment, the prism notch is circular; and the total reflection prism is cylindrical.

[0068] It should be noted that in the embodiment of the present application, the prism notch is circular and the total reflection prism is cylindrical; in other embodiments, on the premise of ensuring the connection and fit between the prism and the checkerboard target, the prism notch can also be a polygon (for example, a rectangle, a regular direction, a hexagon, a pentagon, etc.), or even an irregular polygon. At this time, the shape of the total reflection prism is consistent with the prism notch. For example, when the prism notch is a rectangle, the shape of the total reflection prism is a cuboid; when the prism notch is a hexagon, the shape of the total reflection prism is a hexagonal prism, etc.

[0069] Before measuring the spatial coordinates of the position to be measured, a checkerboard target needs to be placed on the position to be measured, so that the spatial coordinates of the position to be measured in the world coordinate system can be measured with the help of the checkerboard target.

[0070] In step S101, if the ranging device detects through the image acquisition device that the checkerboard target is placed at the position to be measured, the checkerboard target can be adjusted to the acquisition range of the image acquisition device by adjusting the device gimbal of the ranging device. In this way, the integrity of the checkerboard target is ensured during measurement, and measurement deviation caused by measuring the position to be measured when the checkerboard target is incomplete is avoided.

[0071] Specifically, in response to the checkerboard target being placed at the position to be measured, the device pan / tilt of the distance measuring device is adjusted so that the checkerboard target is completely presented within the image acquisition range of the image acquisition device.

[0072] Here, the horizontal setting angle and the vertical setting angle of the device gimbal can be adjusted respectively to ensure that the checkerboard target can be completely presented within the image acquisition range of the image acquisition device to avoid measurement deviation.

[0073] In one embodiment, adjusting the device pan / tilt so that the checkerboard target is located within the image acquisition range of the image acquisition device includes:

[0074] By adjusting the horizontal setting angle and the vertical setting angle of the equipment pan / tilt, the checkerboard target is set within the image acquisition range of the image acquisition device.

[0075] In this step, according to the presentation status of the checkerboard target in the image acquisition device, the horizontal setting angle and the vertical setting angle presented by the equipment gimbal are adjusted respectively, so that the checkerboard target is completely presented within the image acquisition range of the image acquisition device.

[0076] Here, in order to ensure that the laser signal emitted by the laser rangefinder of the ranging equipment can be accurately emitted to the total reflection prism, it is necessary to calculate the setting position of the total reflection prism (i.e., the center position coordinates of the checkerboard target) before measuring the spatial coordinates; at this time, the setting position of the total reflection prism (i.e., the center position coordinates of the checkerboard target) can be determined with the help of the corner point pixel coordinates of each preset checkerboard corner point in the checkerboard target, therefore, it is necessary to first determine the corner point pixel coordinates of each preset checkerboard corner point.

[0077] In step S102, by reading the checkerboard image acquired by the image acquisition device, the preset checkerboard corner points pre-set in the checkerboard target are identified; and the corner point pixel coordinates of each preset checkerboard corner point presented in the checkerboard image are determined.

[0078] Here, the corner point recognition function (opencv-findChessboardCorners) can be used to identify each preset chessboard corner point and the corner point pixel coordinates in the chessboard target.

[0079] In one implementation, step S102 includes: calculating the checkerboard image according to a checkerboard corner point recognition algorithm to determine an array of pixel coordinates of corner points of the checkerboard image.

[0080] In this step, a corner point recognition algorithm (i.e., opencv-findChessboardCorners) is used to recognize the chessboard image captured by the image acquisition device. That is, the chessboard image captured by the image acquisition device is input into a corner point recognition function to determine the corner point pixel coordinate array corresponding to the chessboard image in the image coordinate system of the image acquisition device; the corner point pixel coordinate array includes the corner point pixel coordinates of each preset chessboard corner point in the chessboard image.

[0081] Among them, the cv2.findChessboardCorners algorithm is a function in the OpenCV library, which is used to find the chessboard corners of the chessboard target in the chessboard image.

[0082] In step S103, after the corner pixel coordinates of each preset checkerboard corner point of the checkerboard target are determined, the center position coordinates of the checkerboard target (i.e., the center position coordinates of the checkerboard target) can be determined with the help of the corner pixel coordinates of each preset checkerboard corner point, for example, by the intersection of the lines connecting each preset checkerboard corner point, the average of the X-axis / Y-axis coordinate values, etc.

[0083] In one implementation, the corner point pixel coordinates include X-axis coordinates and Y-axis coordinates; step S103 includes:

[0084] S1031, based on the pixel coordinates of each preset checkerboard corner point, according to a straight line fitting algorithm, obtain the straight line equations of two target diagonals in the checkerboard target.

[0085] In this step, the pixel coordinates of each preset checkerboard corner point in the checkerboard target are used to fit the straight line equation for characterizing the two target diagonal lines in the checkerboard target through a straight line fitting algorithm.

[0086] S1032, based on the straight line equations of the two diagonal lines of the checkerboard target, calculate the pixel coordinates of the intersection of the two diagonal lines, and determine the pixel coordinates of the intersection as the center position coordinates of the checkerboard target.

[0087] In this step, the linear equations of the two diagonal lines of the checkerboard target are solved jointly to determine the intersection of the two diagonal lines of the checkerboard target, that is, the pixel coordinates of the intersection of the two diagonal lines are calculated;

[0088] For the checkerboard target, the intersection of the two target diagonals is the center position of the checkerboard target. Therefore, the pixel coordinates of the intersection of the two diagonals can be determined as the center position coordinates of the checkerboard target.

[0089] In another embodiment, the corner point pixel coordinates include X-axis coordinates and Y-axis coordinates; step S103 includes:

[0090] S1033, determining the maximum value of the X-axis coordinate, the minimum value of the X-axis coordinate, the maximum value of the Y-axis coordinate, and the minimum value of the Y-axis coordinate from the pixel coordinates of each preset chessboard corner point.

[0091] In this step, the pixel coordinates of each preset chessboard corner point include X-axis coordinates and Y-axis coordinates; with respect to the X-axis coordinates, the X-axis coordinates of each preset chessboard corner point are analyzed to determine the maximum value and the minimum value of the X-axis coordinates; correspondingly, with respect to the Y-axis coordinates, the Y-axis coordinates of each preset chessboard corner point are analyzed to determine the maximum value and the minimum value of the Y-axis coordinates.

[0092] S1034. Determine the center position coordinates of the checkerboard target based on the X-axis coordinate maximum value, the X-axis coordinate minimum value, the Y-axis coordinate maximum value, and the Y-axis coordinate minimum value.

[0093] Specifically, the center position coordinates (x c ,y c ):

[0094]

[0095] Among them, x cis the X-axis coordinate of the center position, y c is the Y-axis coordinate of the center position, x min is the minimum value of the X-axis coordinate, x max is the maximum value of the X-axis coordinate, y min is the minimum value of the Y-axis coordinate, y max is the maximum value of the Y-axis coordinate.

[0096] In step S104, after determining the center position coordinates of the checkerboard target, the horizontal setting angle and the vertical setting angle of the device gimbal can be adjusted again to ensure that the laser rangefinder can emit a laser signal to the exact center of the checkerboard target; the laser rangefinder is controlled to emit a laser signal to the center position coordinates, and the laser echo signal fed back by the total reflection prism is obtained to determine the relative distance between the ranging device and the checkerboard target based on the echo feedback delay of the laser echo signal (i.e., the time difference between the emission time of the laser signal and the echo time of the received laser echo signal).

[0097] In one embodiment, after determining the center position coordinates of the checkerboard target, the step of adjusting the horizontal setting angle and the vertical setting angle of the device gimbal again can be performed. First, according to the physical size and pixel size of the checkerboard and the camera focal length parameters of the image acquisition device, the estimated distance between the checkerboard and the distance measuring device can be calculated; using the disclosed laser spot landing point calculation method, the pixel coordinates of the laser spot landing point are calculated according to the estimated distance as the first landing point coordinates; according to the first landing point coordinates, the center position coordinates of the checkerboard target and the camera focal length parameters of the image acquisition device, the target horizontal setting angle and the target vertical setting angle of the device gimbal are calculated; the device gimbal is rotated to the target horizontal setting angle and the target vertical setting angle, and the center position coordinates of the checkerboard target are re-acquired; the above steps are repeated until the difference between the center position coordinates of the checkerboard target and the first landing point coordinates is less than a preset threshold (for example, 1 pixel); at this time, the laser rangefinder can emit a laser signal to the exact center of the checkerboard target.

[0098] In one embodiment, the step of obtaining the laser echo signal fed back by the total reflection prism and determining the relative distance between the distance measuring device and the checkerboard target includes:

[0099] S1041. In response to receiving a laser echo signal fed back by a total reflection prism, acquiring the emission time of the laser signal and the echo time of the laser echo signal.

[0100] In this step, after receiving the laser echo signal fed back by the total reflection prism, the distance measuring device can respectively obtain the emission time of the laser signal corresponding to the laser echo signal emitted by the laser rangefinder and the echo time of the laser echo signal.

[0101] S1042: Determine the relative distance between the distance measuring device and the checkerboard target based on the emission time and the echo time in combination with the emission speed of the laser signal.

[0102] In this step, the relative distance between the ranging device and the checkerboard target can be determined by calculating the time difference between the emission time and the echo time and combining it with the emission speed of the laser signal in the current engineering measurement environment.

[0103] In one embodiment, after determining the relative distance between the ranging device and the checkerboard target, the method further includes: using a laser spot landing point calculation method to calculate the pixel coordinates of the laser spot landing point as a second landing point coordinate according to the relative distance; if the difference between the second landing point coordinate and the center position coordinate of the checkerboard target is greater than a preset threshold (for example, 1 pixel), adjusting the horizontal setting angle and the vertical setting angle of the device gimbal again until the difference between the second landing point coordinate and the center position coordinate of the checkerboard target is less than the preset threshold (for example, 1 pixel).

[0104] In step S105, the relative distance (obd), the current horizontal setting angle of the device gimbal (ha), and the current vertical setting angle of the device gimbal (va) are all input into the spherical coordinate calculation formula to calculate the spatial coordinates of the position to be measured in the world coordinate system.

[0105] The position measurement method based on a checkerboard target provided in an embodiment of the present application is in response to a checkerboard target being placed at a position to be measured, by adjusting the device gimbal, so that the checkerboard target is located within the image acquisition range of an image acquisition device; by reading the checkerboard image acquired by the image acquisition device, the corner pixel coordinates of each preset checkerboard corner point in the checkerboard image are determined in the image coordinate system of the image acquisition device; based on the corner pixel coordinates of each preset checkerboard corner point, the center position coordinates of the checkerboard target are determined; the laser rangefinder is controlled to emit a laser signal to the center position coordinates, the laser echo signal fed back by the total reflection prism is obtained, and the relative distance between the distance measuring device and the checkerboard target is determined; wherein the total reflection prism is set at the center position of the checkerboard target; based on the relative distance, the current horizontal setting angle and the current vertical setting angle of the device gimbal, the spatial coordinates of the position to be measured in the world coordinate system are determined. In this way, when the spatial coordinates of the position to be measured are measured, by determining the center position coordinates of the checkerboard target, it is ensured that the laser rangefinder emits a laser signal to the center position coordinates, thereby avoiding measurement deviation and improving the accuracy of the measurement result.

[0106] See also Figure 3 , Figure 3A schematic diagram of the structure of a position measurement device based on a chessboard target provided in an embodiment of the present application. Applied to a distance measuring device; the distance measuring device includes a device pan / tilt, an image acquisition device and a laser rangefinder; Figure 3 As shown in , the position measurement device 300 includes:

[0107] A pan-tilt adjustment module 310 is used for adjusting the device pan-tilt in response to the checkerboard target being placed at the position to be measured so that the checkerboard target is located within the image acquisition range of the image acquisition device;

[0108] A first coordinate determination module 320 is used to determine the corner pixel coordinates of each preset chessboard corner point in the chessboard image by reading the chessboard image acquired by the image acquisition device;

[0109] A second coordinate determination module 330, configured to determine the center position coordinates of the checkerboard target based on the pixel coordinates of each preset checkerboard corner point;

[0110] The distance determination module 340 is used to control the laser rangefinder to emit a laser signal to the center position coordinate, obtain the laser echo signal fed back by the total reflection prism, and determine the relative distance between the distance measuring device and the checkerboard target; wherein the total reflection prism is set at the center position of the checkerboard target;

[0111] The spatial coordinate determination module 350 is used to determine the spatial coordinates of the position to be measured based on the relative distance, the current horizontal setting angle and the current vertical setting angle of the device gimbal.

[0112] Further, when the pan / tilt adjustment module 310 is used to adjust the device pan / tilt so that the checkerboard target is located within the image acquisition range of the image acquisition device, the pan / tilt adjustment module 310 is used to:

[0113] By adjusting the horizontal setting angle and the vertical setting angle of the equipment pan / tilt, the checkerboard target is set within the image acquisition range of the image acquisition device.

[0114] Further, when the first coordinate determination module 320 is used to determine the corner pixel coordinates of each preset checkerboard corner point in the checkerboard image by reading the checkerboard image acquired by the image acquisition device, the first coordinate determination module 320 is used to:

[0115] Calculating the checkerboard image according to a checkerboard corner point recognition algorithm to determine a pixel coordinate array of corner points of the checkerboard image;

[0116] The corner point pixel coordinate array includes the corner point pixel coordinates of each preset chessboard corner point in the chessboard image.

[0117] Further, the corner point pixel coordinates include X-axis coordinates and Y-axis coordinates; when the second coordinate determination module 330 is used to determine the center position coordinates of the checkerboard target based on the corner point pixel coordinates of each preset checkerboard corner point, the second coordinate determination module 330 is used to:

[0118] Based on the pixel coordinates of each preset checkerboard corner point, a straight line equation of two target diagonals in the checkerboard target is obtained by fitting according to a straight line fitting algorithm;

[0119] Based on the straight line equations of the two target diagonals in the checkerboard target, the pixel coordinates of the intersection of the two diagonals are calculated, and the pixel coordinates of the intersection are determined as the center position coordinates of the checkerboard target.

[0120] Furthermore, when the distance determination module 340 is used to obtain the laser echo signal fed back by the total reflection prism to determine the relative distance between the distance measuring device and the checkerboard target, the distance determination module 340 is used to:

[0121] In response to receiving a laser echo signal fed back by a total reflection prism, acquiring the emission time of the laser signal and the echo time of the laser echo signal;

[0122] Based on the emission time and the echo time, combined with the emission speed of the laser signal, the relative distance between the distance measuring device and the checkerboard target is determined.

[0123] Furthermore, the number of rows and columns of the checkerboard target is a positive odd number; a prism gap is reserved in a central cell of the checkerboard target; and the prism gap is not connected to the edge of the central cell.

[0124] Furthermore, the prism notch is circular; and the total reflection prism is cylindrical.

[0125] The position measurement device based on the checkerboard target provided in the embodiment of the present application, in response to the checkerboard target being placed at the position to be measured, by adjusting the device pan-tilt, the checkerboard target is located within the image acquisition range of the image acquisition device; by reading the checkerboard image acquired by the image acquisition device, the pixel coordinates of the corner points of each preset checkerboard corner point in the checkerboard image are determined; based on the pixel coordinates of the corner points of each preset checkerboard corner point, the center position coordinates of the checkerboard target are determined; the laser rangefinder is controlled to emit a laser signal to the center position coordinates, and the laser echo signal fed back by the total reflection prism is obtained to determine the relative distance between the distance measuring device and the checkerboard target; wherein the total reflection prism is set at the center position of the checkerboard target; based on the relative distance, the current horizontal setting angle and the current vertical setting angle of the device pan-tilt, the spatial coordinates of the position to be measured are determined. In this way, when the spatial coordinates of the position to be measured are measured, by determining the center position coordinates of the checkerboard target, it is ensured that the laser rangefinder emits a laser signal to the center position coordinates, thereby avoiding measurement deviation and improving the accuracy of the measurement result.

[0126] See also Figure 4 , Figure 4 This is a schematic diagram of the structure of an electronic device provided in an embodiment of the present application. Figure 4 As shown in , the electronic device 400 includes a processor 410 , a memory 420 and a bus 430 .

[0127] The memory 420 stores machine-readable instructions executable by the processor 410. When the electronic device 400 is running, the processor 410 communicates with the memory 420 via the bus 430. When the machine-readable instructions are executed by the processor 410, the above-mentioned Figure 1 The steps of the position measurement method based on the chessboard target in the method embodiment shown, the specific implementation method can be found in the method embodiment, and will not be repeated here.

[0128] The present application also provides a computer-readable storage medium on which a computer program is stored. When the computer program is executed by a processor, the computer program can execute the above-mentioned Figure 1 The steps of the position measurement method based on the chessboard target in the method embodiment shown, the specific implementation method can be found in the method embodiment, and will not be repeated here.

[0129] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the systems, devices and units described above can refer to the corresponding processes in the aforementioned method embodiments and will not be repeated here.

[0130] In the several embodiments provided in the present application, it should be understood that the disclosed systems, devices and methods can be implemented in other ways. The device embodiments described above are merely schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some communication interfaces, and the indirect coupling or communication connection of devices or units can be electrical, mechanical or other forms.

[0131] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.

[0132] In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit.

[0133] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a non-volatile computer-readable storage medium that is executable by a processor. Based on this understanding, the technical solution of the present application can essentially be embodied in the form of a software product, or in other words, the part that contributes to the prior art or the part of the technical solution. The computer software product is stored in a storage medium, including several instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present application. The aforementioned storage medium includes: various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk.

[0134] Finally, it should be noted that the above-described embodiments are only specific implementation methods of the present application, which are used to illustrate the technical solutions of the present application, rather than to limit them. The protection scope of the present application is not limited thereto. Although the present application is described in detail with reference to the above-mentioned embodiments, ordinary technicians in the field should understand that any technician familiar with the technical field can still modify the technical solutions recorded in the above-mentioned embodiments within the technical scope disclosed in the present application, or can easily think of changes, or make equivalent replacements for some of the technical features therein; and these modifications, changes or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present application, and should be included in the protection scope of the present application. Therefore, the protection scope of the present application shall be based on the protection scope of the claims.

Claims

1. A position measurement method based on a chessboard target, characterized in that: Applied to distance measuring equipment; The distance measuring device includes a device pan / tilt, an image acquisition device and a laser rangefinder; the position measurement method includes: In response to a checkerboard target being placed at a position to be measured, adjusting the device pan / tilt so that the checkerboard target is located within an image acquisition range of the image acquisition device; Determine the pixel coordinates of each preset checkerboard corner point in the checkerboard image by reading the checkerboard image acquired by the image acquisition device; Determine the center position coordinates of the checkerboard target based on the pixel coordinates of each preset checkerboard corner point; Control the laser rangefinder to emit a laser signal to the center position coordinate, obtain the laser echo signal fed back by the total reflection prism, and determine the relative distance between the distance measuring device and the checkerboard target; wherein the total reflection prism is set at the center position of the checkerboard target; Based on the relative distance, a current horizontal setting angle and a current vertical setting angle of the device gimbal, the spatial coordinates of the position to be measured are determined.

2. The position measurement method according to claim 1, characterized in that: The step of adjusting the device pan / tilt so that the checkerboard target is located within the image acquisition range of the image acquisition device comprises: By adjusting the horizontal setting angle and the vertical setting angle of the equipment pan / tilt, the checkerboard target is set within the image acquisition range of the image acquisition device.

3. The position measurement method according to claim 1, characterized in that: The method of determining the pixel coordinates of each preset checkerboard corner point in the checkerboard image by reading the checkerboard image acquired by the image acquisition device comprises: Calculating the checkerboard image according to a checkerboard corner point recognition algorithm to determine a pixel coordinate array of corner points of the checkerboard image; The corner point pixel coordinate array includes the corner point pixel coordinates of each preset chessboard corner point in the chessboard image.

4. The position measurement method according to claim 1, characterized in that: The corner point pixel coordinates include X-axis coordinates and Y-axis coordinates; the determining the center position coordinates of the checkerboard target based on the corner point pixel coordinates of each preset checkerboard corner point includes: Based on the pixel coordinates of each preset checkerboard corner point, a straight line equation of two target diagonals in the checkerboard target is obtained by fitting according to a straight line fitting algorithm; Based on the straight line equations of the two target diagonals in the checkerboard target, the pixel coordinates of the intersection of the two diagonals are calculated, and the pixel coordinates of the intersection are determined as the center position coordinates of the checkerboard target.

5. The position measurement method according to claim 1, characterized in that: The number of rows and columns of the checkerboard target is a positive odd number; a prism gap is reserved in the central cell of the checkerboard target; and the prism gap is not connected to the edge of the central cell.

6. The position measurement method according to claim 5, characterized in that: The prism notch is circular; the total reflection prism is cylindrical.

7. A position measurement device based on a chessboard target, characterized in that: Applied to distance measuring equipment; The distance measuring device includes a device platform, an image acquisition device and a laser rangefinder; the position measuring device includes: A pan-tilt adjustment module, configured to adjust the device pan-tilt in response to a checkerboard target being placed at a position to be measured, so that the checkerboard target is located within an image acquisition range of the image acquisition device; A first coordinate determination module, configured to determine the corner pixel coordinates of each preset chessboard corner point in the chessboard image by reading the chessboard image acquired by the image acquisition device; A second coordinate determination module, used to determine the center position coordinates of the checkerboard target based on the corner point pixel coordinates of each preset checkerboard corner point; A distance determination module, used to control the laser rangefinder to emit a laser signal to the center position coordinates, obtain the laser echo signal fed back by the total reflection prism, and determine the relative distance between the distance measuring device and the checkerboard target; wherein the total reflection prism is set at the center position of the checkerboard target; The spatial coordinate determination module is used to determine the spatial coordinates of the position to be measured based on the relative distance, the current horizontal setting angle and the current vertical setting angle of the device gimbal.

8. The position measuring device according to claim 7, characterized in that: The corner point pixel coordinates include X-axis coordinates and Y-axis coordinates; when the second coordinate determination module is used to determine the center position coordinates of the checkerboard target based on the corner point pixel coordinates of each preset checkerboard corner point, the second coordinate determination module is used to: Based on the pixel coordinates of each preset checkerboard corner point, a straight line equation of two target diagonals in the checkerboard target is obtained by fitting according to a straight line fitting algorithm; Based on the straight line equations of the two target diagonals in the checkerboard target, the pixel coordinates of the intersection of the two diagonals are calculated, and the pixel coordinates of the intersection are determined as the center position coordinates of the checkerboard target.

9. An electronic device, characterized in that: include: A processor, a memory and a bus, wherein the memory stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor and the memory communicate through the bus, and the machine-readable instructions are executed by the processor to execute the steps of the position measurement method based on the checkerboard target as described in any one of claims 1 to 6.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the position measurement method based on a checkerboard target as claimed in any one of claims 1 to 6 are executed.

Citation Information

Cited By

  • Position measurement method and system based on checkerboard target and electronic equipment

    CN120765721A