Automatic mobile station switching measurement method based on mobile laser tracker
Through multi-coordinate system calibration and path planning, the automated mobile station switching measurement of laser tracker is realized, solving the problem of low efficiency of manual station switching in complex large scenarios, improving the measurement efficiency and automation level of manufacturing sites, and suitable for large components. manufacture.
Patent Information
- Application Number
- CN202411197590.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-29
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-08-29
AI Technical Summary
In complex large scenarios, laser tracker network measurement relies on manual station change, which is inefficient and low in automation, resulting in extended measurement cycles.
Using multi-coordinate system calibration, self-positioning and complex scene path planning methods, through the automated mobile station switching measurement method of mobile laser tracker, a two-dimensional map coordinate system and global coordinate system are established, the conversion relationship is calculated, and the improved A* is used. The algorithm plans the path to realize autonomous movement to the pre-planned station, reduce the movement distance between station replacement, and avoid manually pulling power supply and communication cables.
It realizes large-scale high-efficiency automated positioning within complex manufacturing sites, improves station change efficiency, is suitable for large-scale component manufacturing sites, and has good versatility and promotion.
Smart Images

Figure CN118938243A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of automated measurement, and relates to an automated mobile station-changing measurement method based on a mobile laser tracker. Background Art
[0002] Measurement-driven processing and assembly has become the mainstream mode of in-situ manufacturing of aerospace components. Improving measurement efficiency while ensuring measurement accuracy has become one of the key means to shorten the manufacturing cycle. Due to the large measurement range in the manufacturing site and severe obstruction of the field measurement line of sight, multi-station network measurement of laser trackers has become the preferred large-scene measurement technology. At present, multi-station network measurement in the manufacturing site mainly relies on manual replacement of measurement stations. In this process, manual pulling of the laser tracker is time-consuming and labor-intensive, and multiple people are required to work together to carry the laser tracker and drag power and communication cables at the same time. Therefore, the degree of automation of this station change mode is extremely low, and the station change efficiency is difficult to improve, which greatly prolongs the measurement cycle.
[0003] The high-flexibility mobile platform and the laser tracker are integrated into a mobile laser measurement system, which provides a solution to the above-mentioned inefficient station change measurement problem. However, to realize fully automated mobile station change measurement, it is necessary to break through the information island between the scene and the mobile laser tracker, and solve the problems of positioning and path planning of the mobile measurement system in complex large scenes. Therefore, the present invention is mainly aimed at the mobile station change measurement process, and proposes the idea of multi-coordinate system calibration-self-positioning in large scenes-complex scene path planning. The above idea is used to control the mobile measurement system to move autonomously to the pre-planned station position, replacing the traditional manual station change process, avoiding the dragging of power supply and communication cables, and reducing the station change movement distance through path planning, and finally realizing short-distance, high-efficiency, and automated mobile station change measurement.
[0004] The patent "AGV positioning and path planning method and device", patent number CN202410011939.1, discloses a method for planning the AGV driving path based on a multi-sensor data fusion algorithm. The patent "A global positioning method for laser-navigated AGV", patent number CN201510082486.2, discloses a technology for determining the AGV location information using laser radar data combined with the Markov method. The above two methods realize the autonomous navigation and positioning of the AGV through multi-sensor fusion and data processing, but the above patents only involve the navigation and positioning of the AGV body, and do not involve the large-scale measurement scene of the mobile laser tracker, nor the calibration modeling of multiple coordinate systems in this scene. Therefore, the present invention proposes an automated mobile station change measurement method based on a mobile laser tracker, which solves the problems of low efficiency and low degree of automation of manual station change during network measurement of laser trackers over a large range in complex sites. Summary of the invention
[0005] This invention aims at the problem of low efficiency and low automation in the process of relying on multi-person collaboration and manual station change in the multi-station network measurement of laser trackers, and invents an automated mobile station change measurement method based on a mobile laser tracker. First, a two-dimensional map coordinate system is established through offline scanning measurement of the mobile measurement system, and the three-dimensional coordinates of a series of ground control points in the global coordinate system are obtained by using a laser tracker; then, the cylindrical surface of each reflective column in the map is measured in three dimensions, and the two-dimensional equivalent center of the reflective column is reconstructed with the three-dimensional measurement data, which is defined as the equivalent reference point between the three-dimensional global coordinate system and the two-dimensional map coordinate system, and the conversion relationship between the above two is solved, and then the conversion relationship between the mobile platform coordinate system and the laser tracker coordinate system is calculated; the improved A* algorithm is used to plan the moving path of the mobile measurement system between each target measurement station, and after it arrives at the designated station, the rough positioning based on radar scanning and the precise positioning based on laser measurement are completed in sequence; finally, based on the precise positioning data and the original calibration information, the automated pointing measurement of the point to be measured is realized. This method solves the problems of low efficiency and low automation in the traditional multi-person collaborative station change process. It can realize automated station change measurement without manual control. It is suitable for large-scale automated and efficient positioning in complex manufacturing sites and has good versatility and promotability.
[0006] The technical solution of the present invention:
[0007] An automated mobile station change measurement method based on a mobile laser tracker, the steps are as follows:
[0008] The first step is to construct a two-dimensional map coordinate system and measure the coordinates of control points globally.
[0009] First, the two-dimensional map coordinate system is drawn with the initial position of the vehicle-mounted laser radar as the origin of the two-dimensional map coordinate system, the scanning direction of 0° as the +X direction, and the counterclockwise direction relative to the X axis as the positive rotation angle. The vehicle-mounted laser radar of the mobile platform scans the reflective columns in the surrounding environment to obtain the coordinates T of all reflective columns in the two-dimensional map coordinate system. w :
[0010]
[0011] Among them, (x Ti w y Ti w ) is the coordinate of the i-th reflective column in the map coordinate system, and m is the number of reflective columns;
[0012] Then, the vehicle-mounted laser tracker is used to measure all control points in the measurement field and establish a global coordinate system. The three-dimensional coordinates P of all control points in the global coordinate system are g for:
[0013]
[0014] Among them, (x pj g y pj g z pj g ) is the coordinate of the jth control point in the global coordinate system, and n is the number of control points;
[0015] Based on the installation relationship between the laser radar and the mobile platform, the ground normal is defined as the Z-axis direction of the laser radar, and the Z coordinate value of the laser radar is supplemented according to the structural size; if the Z-axis of the global coordinate system is not parallel to the Z-axis direction of the laser radar, the global coordinate system needs to be rotated using formula (3) to make the Z axes of the two parallel;
[0016]
[0017] Among them, R x , R y , R z are the rotation matrices around the X-axis, Y-axis, and Z-axis respectively. is the three-dimensional coordinate point set measured by the vehicle-mounted laser tracker, and P is the three-dimensional coordinate point set after rotation;
[0018] The second step is to calibrate the laser tracker coordinate system and the mobile platform coordinate system based on the equivalent reference point.
[0019] First, the vehicle-mounted laser tracker measures and fits the cylindrical axis vector of each reflective column, where the cylindrical surface equation of the reflective column is shown in formula (4):
[0020]
[0021] The axis of the cylinder is The radius of the circular section is r, and any point on the axis of the cylinder is [x0 y0 z0] T ;
[0022] Then, multiple points are measured on the upper surface of the cylinder and a plane is fitted. The intersection of the plane and the axis of the cylinder is calculated. Only the horizontal and vertical coordinates of the intersection are extracted and used as the two-dimensional equivalent center of the cylindrical surface of the reflective column. The two-dimensional equivalent center coordinates of all reflective columns are obtained in turn, also called equivalent reference points, to obtain the equivalent reference point sequence set Q c :
[0023] Q c =[q c,1 q c,2 ...q c,n ] T (5)
[0024] Among them, q c,i =[xc,i y c,i ] T is the coordinate of the i-th equivalent reference point;
[0025] Then, based on multiple sets of equivalent reference points, the rotation matrix R between the two-dimensional map coordinate system and the global coordinate system is solved. w_g and the translation vector T w_g , which is the transformation matrix between the current station laser tracker coordinate system and the two-dimensional map coordinate system, as shown in formula (6):
[0026]
[0027] Among them, q c,i and p w,i are the equivalent center coordinates of the i-th reflective column in the laser tracker coordinate system and the two-dimensional map coordinate system respectively;
[0028] Finally, according to the position and orientation of the mobile platform in the two-dimensional map coordinate system [x w a y w a ρ w a ] T , the conversion relationship between the two-dimensional map coordinate system and the current station laser tracker coordinate system, and the coordinates of the mobile platform in the vehicle-mounted laser tracker coordinate system and the position relationship R between the mobile platform and the laser tracker are calculated using formula (7) c_a , T c_a ;
[0029]
[0030] Among them, [x c a y c a ] T represents the coordinates of the moving platform in the laser tracker coordinate system, R c_w , T c_w is the transformation matrix between the laser tracker coordinate system and the two-dimensional map coordinate system, R a_w , T a_w It is the conversion relationship between the mobile platform coordinate system and the two-dimensional map coordinate system;
[0031] Step 3: Autonomous planning of the mobile laser tracker station change path
[0032] First, a complex three-dimensional measurement scene is reconstructed. A two-dimensional map containing obstacles is obtained by two-dimensionally projecting the measurement scene. The two-dimensional map is then binarized and rasterized, and a grid is expanded outside the boundary of the grid containing obstacles as a safety area. The size of the grid is equal to the area of the mobile platform.
[0033] Then, the iterative optimization of the moving path nodes is performed according to the evaluation function to obtain the nodes of the entire motion path, and then the motion path is obtained by reverse tracing. Considering that the measurement site often pays more attention to the motion time, the A* algorithm is improved, and the running time is used as the evaluation function. Taking into account the turning time penalty term, the optimization goal of the shortest running time is constructed. The evaluation function expression is:
[0034] f(k)=g(k)+w(k)h(k)+c(k) (8)
[0035] Where f(k) is the estimated time for the initial node to reach the target node via node k, g(k) is the actual time from the initial node to node k, h(k) is the estimated time for the best path from node k to the target node, w(k) is the weight factor of the estimated time, and c(k) is the additional time (turn penalty term);
[0036] Finally, all nodes are simplified according to the path order of the starting point and the end point, that is, multiple nodes on the same linear motion path are simplified to the first and last two nodes;
[0037] Step 4: Global accurate positioning and autonomous search measurement based on the mobile measurement system of coarse and fine combination
[0038] After the mobile platform moves to the target measurement station according to the planned path, the mobile platform positioning information [x w a ,y w a ,ρ w a ] T , solve the pose matrix R of the current vehicle-mounted laser tracker in the two-dimensional map coordinate system c_w With T c_w :
[0039]
[0040] Among them, R cu a_w , T cu a_w is the conversion relationship between the current mobile platform coordinate system and the two-dimensional map coordinate system, R c_a , T c_a They are the conversion relationship between the laser tracker coordinate system and the mobile platform coordinate system;
[0041] Combining the calibration results between the two-dimensional map coordinate system and the global coordinate system, the pose matrix of the laser tracker in the global coordinate system is calculated:
[0042]
[0043] The two-dimensional transformation matrix is upgraded to a three-dimensional transformation matrix, as shown in formula (11):
[0044]
[0045] in, are the three-dimensional rotation matrix and translation vector, d c is the height between the origin of the laser tracker coordinate system and the XOY plane of the global coordinate system;
[0046]
[0047] Among them, [x c p y c p z c p ] T ,[x g p y g p z g p ] T They are the coordinates of the corresponding measuring points in the current laser tracker coordinate system and the global coordinate system respectively;
[0048] Based on the conversion relationship R between the global coordinate system and the vehicle-mounted laser tracker coordinate system c_g , T c_g , the position and posture of the mobile platform in the global coordinate system are obtained by using multi-level matrix transfer;
[0049]
[0050] Among them, [x g a y g a ] T Represents the coordinates of the mobile platform in the global coordinate system, R g_c , T g_c Represents the pose matrix of the laser tracker in the global coordinate system;
[0051] Finally, based on the precise calculation results of the current laser tracker position and posture in the global coordinate system, the laser tracker's pointing search measurement technology and vision-assisted guidance measurement technology are used to achieve autonomous search and measurement of all points to be measured.
[0052] Beneficial effects of the invention: The invention proposes the idea of multi-coordinate system calibration - self-positioning in large scenes - path planning in complex scenes, and adopts the above idea to control the mobile measurement system to autonomously move to the pre-planned position, which solves the problems of low efficiency and low automation in the process of multi-person collaborative station switching during network measurement of laser trackers in a large range in complex sites. It is suitable for large-scale automated and efficient positioning in complex manufacturing sites, and realizes efficient automated measurement at large-scale component manufacturing sites, and has broad application prospects. BRIEF DESCRIPTION OF THE DRAWINGS
[0053] Figure 1 It is a flow chart of the automated mobile station-changing measurement method based on a mobile measurement system.
[0054] Figure 2 It is a schematic diagram of the measurement layout of the mobile measurement system with automated mobile station change.
[0055] Figure 3 It is the flow chart of path planning of mobile measurement system.
[0056] In the figure: 1-laser tracker; 2-laser radar; 3-mobile platform; 4-mobile measurement system; p1~p24-control points; q1~q12-target points to be measured, T1~T9-reflective columns. DETAILED DESCRIPTION
[0057] The specific implementation of the present invention is described in detail below in combination with the technical scheme and the accompanying drawings.
[0058] In this embodiment, the measurement range is approximately 24 m×5 m, including 24 control points, 12 target points, and 9 reflective columns.
[0059] The first step is to construct a two-dimensional map coordinate system and measure the coordinates of control points globally.
[0060] As attached Figure 2 As shown in the figure, 24 control points, 12 target points to be measured, with a spacing of 2m, and 9 reflective columns are arranged within a range of 24m×5m. The coordinates of the reflective columns in the map coordinate system are obtained by using laser radar measurement. w , use the laser tracker to measure the control point coordinates P in the global coordinate system g And according to formula (3), it is rotated to the direction defined by the laser radar Z axis:
[0061]
[0062]
[0063] The second step is to calibrate the laser tracker coordinate system and the mobile platform coordinate system based on the equivalent reference point.
[0064] First, the two-dimensional equivalent center of all reflective columns is constructed according to equations (4) and (5), and the equivalent center coordinates Q of some reflective columns are measured. c for:
[0065]
[0066] Then, the conversion relationship R between the laser tracker coordinate system and the map coordinate system is calibrated by formula (6): w_g , T w_g :
[0067]
[0068] Then, the transformation matrix R between the mobile platform and the map coordinate system is calculated based on the position of the mobile platform in the map coordinate system. a_w , T a_w :
[0069]
[0070] The position and posture of the mobile platform in the laser tracker coordinate system is calculated by equation (7), that is, the transformation relationship between the mobile platform and the vehicle-mounted laser tracker:
[0071]
[0072] Step 3: Autonomous planning of the mobile laser tracker station change path
[0073] according to Figure 3 The steps of moving the mobile platform to the specified position are planned in combination with the improved A* algorithm. Since there is no obstacle in this embodiment, a straight line path from the starting station to the target station is planned.
[0074] Step 4: Global accurate positioning and autonomous search measurement based on the mobile measurement system of coarse and fine combination
[0075] After the mobile measurement system arrives at the designated location, the rough positioning of the mobile measurement system in the map coordinate system is completed according to the calibrated information and the position of the mobile platform in the map coordinate system.
[0076] Then, a laser tracker is used to measure some control points, and the transformation matrix R between the laser tracker coordinate system and the global coordinate system is calculated by equation (10): c_g , T c_g , complete the precise positioning of the measurement system in the global coordinate system:
[0077]
[0078] Then, the current position and posture of the laser tracker in the global coordinate system is inversely calculated by equation (13):
[0079]
[0080] Finally, all the points to be measured are measured using laser tracker pointing search measurement technology and visual assisted guided measurement technology.
[0081] The present invention proposes the idea of multi-coordinate system calibration - self-positioning in large scenes - path planning in complex scenes. The above idea is used to control the mobile measurement system to autonomously move to a pre-planned position, which solves the problems of low efficiency and low automation in the process of multi-person collaborative station switching during networked measurement of laser trackers in a large range in complex sites. It is suitable for large-scale automated and efficient positioning in complex manufacturing sites, and realizes efficient automated measurement at large-scale component manufacturing sites, and has broad application prospects.
Claims
1. An automated mobile station change measurement method based on a mobile laser tracker, characterized in that: Here are the steps: The first step is to construct a two-dimensional map coordinate system and measure the global coordinates of control points. First, the two-dimensional map coordinate system is drawn with the initial position of the vehicle-mounted laser radar as the origin of the two-dimensional map coordinate system, the scanning direction of 0° as the +X direction, and the counterclockwise direction relative to the X axis as the positive rotation angle. The vehicle-mounted laser radar of the mobile platform scans the reflective columns in the surrounding environment to obtain the coordinates T of all reflective columns in the two-dimensional map coordinate system. w : Among them, (x Ti w y Ti w ) is the coordinate of the i-th reflective column in the map coordinate system, and m is the number of reflective columns; Then, the vehicle-mounted laser tracker is used to measure all control points in the measurement field and establish a global coordinate system. The three-dimensional coordinates P of all control points in the global coordinate system are g for: Among them, (x pj g y pj g z pj g ) is the coordinate of the jth control point in the global coordinate system, and n is the number of control points; Based on the installation relationship between the laser radar and the mobile platform, the ground normal is defined as the Z-axis direction of the laser radar, and the Z coordinate value of the laser radar is supplemented according to the structural size; if the Z-axis of the global coordinate system is not parallel to the Z-axis direction of the laser radar, the global coordinate system needs to be rotated using formula (3) to make the Z axes of the two parallel; Among them, R x , R y , R z are the rotation matrices around the X-axis, Y-axis, and Z-axis respectively. is the three-dimensional coordinate point set measured by the vehicle-mounted laser tracker, and P is the three-dimensional coordinate point set after rotation; The second step is to calibrate the laser tracker coordinate system and the mobile platform coordinate system based on the equivalent reference point. First, the vehicle-mounted laser tracker measures and fits the cylindrical axis vector of each reflective column, where the cylindrical surface equation of the reflective column is shown in formula (4): The axis of the cylinder is The radius of the circular section is r, and any point on the axis of the cylinder is [x0 y0 z0] T ; Then, multiple points are measured on the upper surface of the cylinder and a plane is fitted. The intersection of the plane and the axis of the cylinder is calculated. Only the horizontal and vertical coordinates of the intersection are extracted and used as the two-dimensional equivalent center of the cylindrical surface of the reflective column. The two-dimensional equivalent center coordinates of all reflective columns are obtained in turn, also called equivalent reference points, to obtain the equivalent reference point sequence set Q c : Q c =[q c,1 q c,2 ...q c,n ] T (5) Among them, q c,i =[x c,i y c,i ] T is the coordinate of the i-th equivalent reference point; Then, based on multiple sets of equivalent reference points, the rotation matrix R between the two-dimensional map coordinate system and the global coordinate system is solved. w_g and the translation vector T w_g , which is the transformation matrix between the current station laser tracker coordinate system and the two-dimensional map coordinate system, as shown in formula (6): Among them, q c,i and p w,i are the equivalent center coordinates of the i-th reflective column in the laser tracker coordinate system and the two-dimensional map coordinate system respectively; Finally, according to the position and orientation of the mobile platform in the two-dimensional map coordinate system [x w a y w a ρ w a ] T , the conversion relationship between the two-dimensional map coordinate system and the current station laser tracker coordinate system, and the coordinates of the mobile platform in the vehicle-mounted laser tracker coordinate system and the position relationship R between the mobile platform and the laser tracker are calculated using formula (7) c_a 、T c_a ; Among them, [x c a y c a ] T represents the coordinates of the moving platform in the laser tracker coordinate system, R c_w 、T c_w is the transformation matrix between the laser tracker coordinate system and the two-dimensional map coordinate system, R a_w 、T a_w It is the conversion relationship between the mobile platform coordinate system and the two-dimensional map coordinate system; Step 3: Autonomous planning of the mobile laser tracker station change path First, a complex three-dimensional measurement scene is reconstructed. A two-dimensional map containing obstacles is obtained by two-dimensionally projecting the measurement scene. The two-dimensional map is then binarized and rasterized, and a grid is expanded outside the boundary of the grid containing obstacles as a safety area. The size of the grid is equal to the area of the mobile platform. Then, the iterative optimization of the moving path nodes is performed according to the evaluation function to obtain the nodes of the entire motion path, and then the motion path is obtained by reverse tracing. Considering that the measurement site often pays more attention to the motion time, the A* algorithm is improved, and the running time is used as the evaluation function. Taking into account the turning time penalty term, the optimization goal of the shortest running time is constructed. The evaluation function expression is: f(k)=g(k)+w(k)h(k)+c(k) (8) Where f(k) is the estimated time for the initial node to reach the target node via node k, g(k) is the actual time from the initial node to node k, h(k) is the estimated time for the best path from node k to the target node, w(k) is the weight factor of the estimated time, and c(k) is the additional time (turn penalty term); Finally, all nodes are simplified according to the path order of the starting point and the end point, that is, multiple nodes on the same linear motion path are simplified to the first and last two nodes; Step 4: Global accurate positioning and autonomous search measurement based on the mobile measurement system of coarse and fine combination After the mobile platform moves to the target measurement station according to the planned path, the mobile platform positioning information [x w a ,y w a ,ρ w a ] T , solve the pose matrix R of the current vehicle-mounted laser tracker in the two-dimensional map coordinate system c_w With T c_w : Among them, R cu a_w 、T cu a_w is the conversion relationship between the current mobile platform coordinate system and the two-dimensional map coordinate system, R c_a 、T c_a They are the conversion relationship between the laser tracker coordinate system and the mobile platform coordinate system; Combining the calibration results between the two-dimensional map coordinate system and the global coordinate system, the pose matrix of the laser tracker in the global coordinate system is calculated: The two-dimensional transformation matrix is upgraded to a three-dimensional transformation matrix, as shown in formula (11): in, are the three-dimensional rotation matrix and translation vector, d c is the height between the origin of the laser tracker coordinate system and the XOY plane of the global coordinate system; Among them, [x c p y c p z c p ] T ,[x g p y g p z g p ] T They are the coordinates of the corresponding measuring points in the current laser tracker coordinate system and the global coordinate system respectively; Based on the conversion relationship R between the global coordinate system and the vehicle-mounted laser tracker coordinate system c_g 、T c_g , the position and posture of the mobile platform in the global coordinate system are obtained by using multi-level matrix transfer; Among them, [x g a y g a ] T represents the coordinates of the mobile platform in the global coordinate system, R g_c 、T g_c Represents the pose matrix of the laser tracker in the global coordinate system; Finally, based on the precise calculation results of the current laser tracker position and posture in the global coordinate system, the laser tracker's pointing search measurement technology and vision-assisted guidance measurement technology are used to achieve autonomous search and measurement of all points to be measured.
Citation Information
Patent Citations
Global positioning method of laser-navigated AGV (automatic guided vehicle)
CN104729500A
AGV positioning and path planning method and device
CN117553800A
Static smoothness measurement and analysis method for rail based on laser tracker
CN104358194A
Three-dimensional laser scanning technology-based powder stack material volume measurement device and method
CN107024174A
High-precision measuring method for three-dimensional shape of surface of large-sized measured part
CN109238168A
Cited By
A mobile station-based laser radar automatic measurement method and system
CN122776268A
