Line laser scanning state control method based on motion trajectory of mobile mechanism
Through the linear laser scanning state control method that analyzes the motion trajectory of the moving mechanism, the problem of difficult to evaluate the coverage of the linear laser scanning area in the prior art is solved, real-time adjustment and automated analysis are realized, and the accuracy and efficiency of the scanning process are ensured.
Patent Information
- Application Number
- CN202210027287.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-01-11
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2042-01-11
AI Technical Summary
The prior art is difficult to ensure the coverage of the linear laser scanning area and evaluate the scanning coverage degree in real-time scanning. Especially when the workpiece consistency is poor or deformation during processing, the trajectory of the moving mechanism needs to be adjusted, resulting in the trajectory posture that is not fixed and it is difficult to evaluate the scanning state. .
By analyzing the motion trajectory of the moving mechanism, calculating the angle between the motion direction vector and the normal vector pointing to the tool point of the linear laser measurement plane, it provides a linear laser scanning state control method based on the motion trajectory of the moving mechanism, including calibration process, calculating tool points and Motion direction vector, evaluation angle relationship, used for real-time guidance and trajectory quality analysis.
Effective evaluation and real-time adjustment of the scanning state of the line laser are realized, ensuring the coverage of the scanning area, providing a method of automated analysis and optimization of the guidance trajectory, and improving the accuracy and efficiency of the scanning process.
Smart Images

Figure CN114485397B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of industrial detection, and in particular relates to a line laser scanning state control method based on the motion trajectory of a moving mechanism. Background Art
[0002] The current industrial inspection technology commonly used scanning inspection means is: install a line laser sensor at the end of the mobile mechanism, and complete the scanning process of the target workpiece through the movement of the mechanism. The mobile mechanism includes multi-degree-of-freedom mechanisms such as industrial robots and multi-axis linear modules.
[0003] However, for processes that require processing of the object to be tested during real-time scanning, such as gluing, welding, additive manufacturing, subtractive manufacturing, etc., the line laser scanning line needs to continue to cover the processing part. If the workpiece has poor consistency or overall deformation occurs during processing, and the trajectory needs to be adjusted according to the changes, the moving mechanism trajectory is often calculated by the real-time guidance device, which is different for each operation.
[0004] The main problems with using live boot are as follows:
[0005] ⑴ The trajectory posture is not fixed, and it is difficult to ensure that the laser scanning area covers the processing part every time it runs.
[0006] (2) It is impossible to evaluate the scanning coverage of the line laser scanning area and the processing area at each instant of movement. Summary of the invention
[0007] The purpose of the present invention is to overcome the situation that the instantaneous line laser scanning area coverage state is difficult to evaluate and to provide an analysis method based on the motion trajectory of a mobile mechanism for evaluating the instantaneous state of any number of line laser scanning. It can be used in the following scenarios: ⑴ Real-time guidance posture evaluation optimization. ⑵ Post-operation guidance trajectory quality analysis. ⑶ In multiple line laser sensing scenarios, analyze each sensor scanning area before or after processing. ⑷ Other scenarios where the state of the sensor scanning area needs to be judged. Another object of the present invention is to provide a method for calculating the motion direction vector of a mobile mechanism at a specified time according to the trend of motion trajectory movement. A line laser scanning state control method based on the motion trajectory of a mobile mechanism is used to determine the scanning state by the angle relationship in space between the motion direction vector and the normal vector of the line laser measurement plane pointing to the tool point side.
[0008] The technical solution of the present invention is the line laser scanning state control method based on the motion trajectory of the mobile mechanism, which is special in that it includes the following steps:
[0009] ⑴Prepare for calibration process: For the same sensor and moving mechanism, the calibration process only needs to be completed once during installation;
[0010] ⑵ Calculate the tool point P at the end of the moving mechanism at the specified time tool_now and its motion direction vector V move ;
[0011] ⑶ Calculate the sensing detection plane in the base coordinate system of the mobile mechanism robot The plane equation under is Ax+By+Cz+D=0;
[0012] (4) Calculation and evaluation: Calculate the angle between the motion direction vector and the vector from the foot point of the projection of the tool point on the sensing plane to the tool point.
[0013] As preferred: the step (1) further comprises:
[0014] (1.1) Using the three-point calibration method, calculate the actual tool point based on the end coordinate system of the moving mechanism O end The spatial position point P tool ;
[0015] (1.2) Use the line laser hand-eye calibration method to calculate the coordinate system O of each line laser sensor and the end of the mobile mechanism end The hand-eye transformation matrix T trans_1 , T trans_2 ……T trans_n .
[0016] As a preference: the step (2) further comprises:
[0017] (2.1) Continuously collect and record the spatial position T of the mobile mechanism device_1 , T device_2 ……T device_n , and according to the following formula, calculate the tool point corresponding to each moment in the mobile mechanism base coordinate system O robot The spatial coordinate P tool_n , P tool_n =T device_1 *P _tool .
[0018] (2.2) From the tool point space coordinate P tool_n Select the curve fitting control point data set from
[0019] (2.3) According to the control point data set, cubic B-spline curve fitting is used to obtain the spatial curve equation;
[0020] (2.4) According to the space curve equation, at the current tool point space coordinate P tool_m Take the derivative and get the space vector V move .
[0021] Preferably, the step (2.2) further comprises a real-time determination step:
[0022] (2.2.1) If the current data point index is m, the next predicted mobile mechanism position is T device_(m+1) , calculate the next predicted tool point spatial coordinate P tool_(m+1) =T device_(m+1) *P tool ;
[0023] (2.2.2) Record the current cumulative chord length L _sum =0, data number k1=m+1;
[0024] (2.2.3) Looking forward for the starting point: Calculate P tool_k1 To P tool_(k1-1) The spatial distance between two points is L, L _sum =L _sum +L; if the accumulated chord length is greater than the preset chord length upper limit L _limit Or if the data starting point is reached, the starting index k2 is recorded; otherwise k1=k1-1, and the current step is looped;
[0025] (2.2.4) The control point dataset is {P tool_k2 ,P tool_(k2+1) ...P tool_(m+1)}.
[0026] Preferably, the step (2.2) further comprises a historical determination step:
[0027] (2.2.1) If the current data point index is m;
[0028] (2.2.2) Record the current cumulative chord length L _sum =0, data number k1=m;
[0029] (2.2.3) Looking forward for the starting point: Calculate P tool_k1 To P tool_(k1-1) The spatial distance between two points is L, L _sum =L _sum +L; if the accumulated chord length is greater than the preset chord length upper limit L _limit / 2 Or if the data starting point is reached, the starting index k2 is recorded; otherwise k1=k1-1, and the current step is looped;
[0030] (2.2.4) Record the current cumulative chord length L _sum =0, data number k1=m;
[0031] (2.2.5) Find the end point backward: calculate P tool_k1 To P tool_(k1+1) The spatial distance between two points is L, L _sum =L _sum +L; if the accumulated chord length is greater than the preset chord length upper limit L _limit / 2 or reaches the end of the data, then record the stop index k3; otherwise k1=k1+1, and loop the current step;
[0032] (2.2.6) The control point dataset is {P tool_k2 ,P tool_(k2+1) ...P tool_k3}.
[0033] As preferred: the step (3) further comprises:
[0034] (3.1) Calculate the nth laser sensor coordinate system in the mobile mechanism base coordinate system O robot The posture T laser =T device_n *T trans_n ;
[0035] (3.2) The sensing plane is in the sensing base coordinate system O laser The equation below is A' x +B' y +C' z +D'=0; then the following relationship can be solved to obtain A, B, and C:
[0036] [ABC 1] -1 =T laser [A'B'C', 1] -1 , bring the sensor origin into the sensor base coordinate system O laser Lower coordinate P laser Solve for D; find the sensing plane in the base coordinate system of the mobile mechanism O robot The plane equation below is Ax+By+Cz+D=0.
[0037] As an advantage: the step (4) further comprises:
[0038] (4.1) Calculate the current point P tool_now Projected point on the sensing plane calculate To P tool_now Vector V laser With V move Angle A: 0 ~ 180 degrees; and according to the angle, the line laser scanning state can be divided into:
[0039] (4.1.1) 0<=A<90: The current laser line is in the processed area. The larger the angle in the interval, the lower the proportion of the processed area. When A=0, it is exactly perpendicular to the scanning path and completely covers the processed area.
[0040] (4.1.2) 90<=A<=180: The current laser line is in the unprocessed area.
[0041] Compared with the prior art, the present invention has the following beneficial effects:
[0042] (1) The present invention provides a simple and effective method for evaluating the state of line laser scanning.
[0043] (2) The present invention assists in adjusting the posture of the mobile mechanism during real-time guidance.
[0044] ⑶ The present invention provides a basis for automatically analyzing the quality of the guidance trajectory. By analyzing the change of the angle used for evaluation in the scanning process, the closer to the zero posture calculation, the better. BRIEF DESCRIPTION OF THE DRAWINGS
[0045] Figure 1 It is a flow chart of the line laser scanning state control based on the motion trajectory of the mobile mechanism of the present invention;
[0046] Figure 2 It is a schematic diagram of the sensing scanning state of the gluing scanning of the six-axis industrial robot of the present invention. DETAILED DESCRIPTION
[0047] The present invention will be further described below in conjunction with the accompanying drawings:
[0048] Figure 1 An embodiment of the present invention using a six-axis industrial robot for gluing scanning using a sensor scanning state history determination is shown.
[0049] See also Figure 1 As shown, a six-axis industrial robot line laser gluing scanning state analysis method based on the motion trajectory of the mobile mechanism includes the following steps:
[0050] ⑴ Four calibrated line laser sensors are evenly installed at the end of the robot; the three-point calibration method is used to calculate the actual tool point based on the coordinate system O of the end of the mobile mechanism. end The spatial position point P tool ;
[0051] ⑵ Install the mounting parts to the end of the robot and complete the calibration of the hand-eye matrix of each line laser and the end of the robot. Use the standard ball calibration method to move the end posture of the robot respectively and move the laser line to the standard ball. Each sensor takes 20 positions, records the sensor data and robot posture data, and jointly calculates the coordinate system O of each line laser sensor and the end of the moving mechanism. end The hand-eye transformation matrix T trans1 , T trans2 , T trans3 , T trans4 ;
[0052] ⑶ Just move the end point along the rubber track to program the robot's running track without adjusting the end point posture;
[0053] ⑷ Start scanning and acquisition. Continuously acquire and record the spatial position T of the mobile mechanism(device_1) , T (device_2) ……T (device_n) , and according to the following formula, calculate the tool point corresponding to each moment in the mobile mechanism base coordinate system O robot The spatial coordinate P tool_n , P tool_n =T device_1 *P tool ;
[0054] ⑸Need to determine if Figure 2 The sensor scanning states at the mth data at the time shown; taking point m as the boundary, the cumulative chord length is calculated forward and backward to reach the preset chord length upper limit L limit / 2 or reach the data endpoint, get the starting index k1, the ending index k2; from the tool point space coordinates P tool_n Select the data points k1 to k2 as the curve fitting control point data set;
[0055] (6) Use cubic B-spline curve fitting to obtain the spatial curve equation;
[0056] ⑺According to the space curve equation, at the current tool point space coordinate P tool_m Take the derivative and get the space vector V move ;
[0057] ⑻ Calculate the sensor planes of sensors 1, 2, 3, and 4 in the base coordinate system of the mobile mechanism O robot The plane equation under is Ax+By+Cz=0;
[0058] ⑼ Calculate the angles A1, A2, A3, A4 between the motion direction vector and the tool point projection foot point on each sensing plane and the tool point vector;
[0059] ⑽Evaluation: A1 and A2 are greater than 90 degrees, and A3 and A4 are less than 90 degrees; therefore, at this time, sensor 1 and sensor 2 scan the unprocessed area, and sensor 3 and sensor 4 scan the processed area.
[0060] The above description is only a preferred embodiment of the present invention. All equivalent changes and modifications made within the scope of the claims of the present invention should fall within the scope of the claims of the present invention.
Claims
1. A line laser scanning state control method based on the motion trajectory of a moving mechanism, characterized in that: The following steps are involved: ⑴Prepare for calibration process: For the same sensor and moving mechanism, the calibration process only needs to be completed once during installation; (1.1) Use the three-point calibration method to calculate the actual tool point based on the end coordinate system of the moving mechanism The spatial position point below ; (1.2) Use line laser hand-eye calibration to calculate the coordinate system of each line laser sensor and the end of the moving mechanism The hand-eye transformation matrix , … ; ⑵Calculate the tool point at the end of the moving mechanism at the specified time and its motion direction vector ; (2.1) Continuously collect and record the spatial position of the mobile mechanism , … , and according to the following formula, calculate the tool point corresponding to each moment in the base coordinate system of the mobile mechanism The spatial coordinates of , ; (2.2) From the tool point space coordinates Select the curve fitting control point data set from (2.3) According to the control point data set, cubic B-spline curve fitting is used to obtain the spatial curve equation; (2.4) According to the space curve equation, the space coordinates of the current tool point Taking the derivative at , we get the space vector ; ⑶ Calculate the sensing plane in the base coordinate system of the mobile mechanism The plane equation below ; (3.1) Calculate the nth laser sensor coordinate system in the mobile mechanism base coordinate system The posture below, ; (3.2) Sensing plane in the sensing base coordinate system The following equation is ; Then we can solve A, B, and C by the following relationship: Bring the sensor origin into the sensor base coordinate system Lower coordinate Solve for D; find the sensing plane in the base coordinate system of the mobile mechanism The plane equation below ; ⑷ Calculation evaluation: Calculate the motion direction vector With tool point The angle between the foot point of the projection perpendicular to the sensing plane and the vector of the tool point; (4.1) Calculate the current point Projected point on the sensing plane ,calculate to vector and The angle A is 0 to 180 degrees; and according to the angle, the line laser scanning state can be divided into: (4.1.1) 0<=A<90 degrees: The current laser line is in the processed area. The larger the angle in the interval, the lower the proportion of the processed area. When A=0, it is exactly perpendicular to the scanning path, completely covering the processed area. (4.1.2) 90<=A<=180 degrees: The current laser line is in the unprocessed area.
2. The line laser scanning state control method based on the motion trajectory of the moving mechanism according to claim 1 is characterized in that: The step (2.2) further comprises a real-time determination step: (2.2.1) If the current data point index is m, the next predicted mobile mechanism position is , calculate the next predicted tool point spatial coordinates = ; (2.2.2) Record the current cumulative chord length , data number k1=m+1; (2.2.3) Looking forward for the starting point: Calculate to The spatial distance L between two points, ; If the cumulative chord length is greater than the preset chord length upper limit Or when the data starting point is reached, the starting index k2 is recorded; Otherwise k1=k1-1, loop the current step; (2.2.4) The control point dataset is { }.
3. The line laser scanning state control method based on the motion trajectory of the moving mechanism according to claim 1 is characterized in that: The step (2.2) further includes a history determination step: (2.2.1) If the current data point index is m; (2.2.2) Record the current cumulative chord length , data number k1=m; (2.2.3) Looking forward for the starting point: Calculate to The spatial distance L between two points, ; If the cumulative chord length is greater than the preset chord length upper limit Or when the data starting point is reached, the starting index k2 is recorded; Otherwise k1=k1-1, loop the current step; (2.2.4) Record the current cumulative chord length , data number k1=m; (2.2.5) Looking backward for the end point: Calculation to The spatial distance L between two points, ; If the cumulative chord length is greater than the preset chord length upper limit Or if the end of the data is reached, the record stops at index k3; otherwise k1=k1+1, and the current step is looped; (2.2.6) The control point dataset is { }.
Citation Information
Patent Citations
Robot operation trajectory acquisition method based on line laser sensor
CN109732589A
Mechanical arm grabbing control method based on binocular vision
CN111267095A
Calibration method for relative position of linear laser three-dimensional measurement sensor and robot
CN111504183A
Line laser sensor calibration method for gluing robot
CN113551593A
Control method for articulated robot
JP1992057691A
