An intelligent torque wrench angle accurate measurement method based on inertial sensor
By compensating the installation error and angle accumulation algorithm, the problem of inertial sensor measurement error in intelligent torque wrench is solved, accurate measurement of workpiece angle is achieved, and the safety and quality of assembly work is improved.
Patent Information
- Application Number
- CN202211520031.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-11-30
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2042-11-30
AI Technical Summary
The existing intelligent torque wrench cannot fully grasp the operating conditions, resulting in low firmness of the workpiece when it is abnormally tightened, which brings safety hazards. There are measurement errors in the low-cost inertial sensors, which affects the assembly quality.
By obtaining the angle measured by the inertial sensor, compensating the installation error angle, measuring the gravity component with an accelerometer, calculating the actual rotation angle of the wrench, and using an angle accumulation algorithm to reduce the drift error of the inertial sensor, improving the measurement accuracy.
It realizes accurate measurement of workpiece angle, improves the safety and reliability of assembly work, reduces the error impact of inertial sensors, and improves the overall assembly quality.
Smart Images

Figure CN115655573B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of intelligent manufacturing, and more specifically, relates to an intelligent torque wrench angle precise measurement method based on an inertial sensor. Background Art
[0002] With the continuous development of the manufacturing industry, the manufacturing industry has begun to transform towards intelligent manufacturing, which brings with it the dual requirements of digitalization and high precision. Especially in industries that emphasize safety, such as aerospace and railways, the precision requirements for assembly processes such as workpiece fastening are getting higher and higher. The digitalization and intelligence of assembly tools are necessary means to achieve high-precision assembly.
[0003] For the current intelligent torque wrenches, most of them are only equipped with torque sensors to display the change of torque value during the tightening process of the workpiece, which can improve the workers' torque control during the workpiece assembly process and facilitate the achievement of the specified torque requirements. However, only torque data cannot fully grasp the working conditions (such as the workpiece is not smoothly placed, there are impurities in the nut, etc.), which may cause false tightening (the torque value is reached but the workpiece is not completely screwed in). The firmness of the workpiece is very low under such abnormal tightening conditions, which brings great safety hazards. In the prior art, the tightening angle is measured by adding an angle inertial sensor, but due to its physical properties and considering the cost of the wrench, most of the inertial sensors carried by the wrench are low-cost inertial sensors, which will have many non-negligible error terms, seriously affecting the accuracy of the angle measurement, thereby affecting the overall assembly quality. Summary of the invention
[0004] The present invention aims to overcome at least one defect of the above-mentioned prior art and provide a method for accurately measuring the angle of an intelligent torque wrench based on an inertial sensor.
[0005] The detailed technical scheme of the present invention is as follows:
[0006] In order to solve the above technical problems, the present invention provides an intelligent torque wrench angle precise measurement method based on inertial sensor to solve the problems that the prior art cannot fully grasp the working conditions, resulting in low firmness of the workpiece under such abnormal tightening conditions, which brings great safety hazards.
[0007] To achieve the above object, the present invention provides an intelligent torque wrench angle accurate measurement method based on inertial sensor, comprising:
[0008] S1: Get the angle measured by the inertial sensor; the inertial sensor measures the rotation angle of the control board, and what needs to be displayed is the actual rotation angle of the workpiece, that is, the rotation angle of the wrench;
[0009] Further, a wrench coordinate system is established with the center point of the bottom surface of the control board as the origin O2, including the x'axis, y'axis, and z'axis; a control board coordinate system is established with the center point of the bottom surface of the wrench as the origin O1, including the x-axis, y-axis, and z-axis.
[0010] S2: Compensate for the installation error angle and measure the actual rotation angle value: Due to the sensitivity of the inertial sensor, non-negligible error problems must be solved during the measurement process, among which the measurement error caused by the installation error angle cannot be ignored. The inertial sensor is welded on the control board as a patch device. When the control board is installed on the bottom surface of the wrench, there will be an installation error angle due to various welding devices and circuit problems, resulting in the control board and the bottom surface of the wrench being non-parallel. If the two planes are not parallel, the angle value measured by the inertial device will be inconsistent with the actual rotation angle value of the wrench. Therefore, it is necessary to record this error, find the relative relationship between the bottom surface of the control board and the bottom surface of the wrench for compensation, so as to eliminate the installation error and obtain the actual rotation angle of the workpiece.
[0011] S21: Determine the error angle, the error angle includes a roll angle and a pitch angle; the roll angle is the deviation angle between the bottom surface of the control board and the wrench plane when the control board rotates around the x' axis in the control board coordinate system x'O2y' during installation; the pitch angle is the deviation angle between the bottom surface of the control board and the wrench plane when the control board rotates around the y' axis in the control board coordinate system x'O2y' during installation.
[0012] Power on the wrench and keep it horizontal (keep it absolutely horizontal with the local horizontal plane). If there is no installation error angle between the bottom surface of the control board and the bottom surface of the wrench, the results displayed by the accelerometer on its own x, y, and z axes should be {0, 0, g} (the actual value of g depends on the local longitude and latitude). If there is an installation error angle, the gravity acceleration g will have components on the x and y axes, and the acceleration component measured in the z-axis direction will no longer be the local gravity acceleration g;
[0013] Assume that the gravity component of the acceleration measured by the control board on the three coordinate axes is {a x , a y , a z}. x =g*sinθ, the value of sinθ can be known according to the reading of the accelerometer in the x' axis direction, and thus the roll angle θ = arcsina x ;
[0014] Similarly, we can get a y =g*sinφ, the value of sinφ can be known according to the reading of the accelerometer in the y' axis direction, so the pitch angle φ = arcsina y ;
[0015] From this, we get the installation error angle between the plane of the inertial sensor and the installation plane of the wrench. The next step is to calculate the transformation matrix of the two coordinate systems to find the actual rotation angle of the wrench, that is, the rotation angle of the z-axis.
[0016] S22: Obtain the actual rotation angle of the workpiece through coordinate conversion: When the user uses the wrench to perform operations, the actual rotation angle of the wrench is the rotation angle of the z' axis of the bottom surface of the wrench. The angle measured by the inertial sensor is the rotation angle of the z axis under the bottom surface of the control board. To measure the actual rotation angle of the wrench, it is necessary to transform the coordinates. The control board coordinate system and the wrench coordinate system have a rotation relationship, that is, a rotation relationship due to the installation error angle. The control board coordinate system can be obtained by rotating the wrench coordinate system.
[0017] The conversion matrix from the wrench coordinate system to the control board coordinate system is calculated according to the rotation relationship of the wrench coordinate system to the control board coordinate system on the x' axis with an angle of θ (roll angle) and the rotation relationship of the wrench coordinate system to the control board coordinate system on the y' axis with an angle of φ (pitch angle);
[0018] According to the z'-axis rotation angle of the control board coordinate system measured by the inertial sensor, the actual z-axis rotation angle of the wrench coordinate system, that is, the actual rotation angle of the workpiece, can be calculated according to the conversion matrix from the wrench coordinate system to the control board coordinate system.
[0019] S3: Increase the measurement accuracy of the inertial sensor through the angle accumulation algorithm: First, set a torque threshold to determine whether the wrench is in working state. Data will be recorded only when it is in working state. When the wrench is used for tightening operation, the torque value will be greater than the set threshold. By recording the actual rotation angle of the workpiece for a single time to avoid the long-term drift error of the inertial sensor, finally, the actual rotation angle of the workpiece recorded each time is accumulated to obtain the final total rotation angle, that is, the single relative angle difference (the final angle at the end of a single tightening operation minus the initial angle at the beginning of the tightening operation) is recorded and accumulated, which can effectively avoid the drift error of the inertial sensor.
[0020] The angle accumulation algorithm process is as follows:
[0021] (1) When the wrench is tightening and the torque is greater than the set torque threshold (the torque value is monitored by the torque sensor), it is determined that the wrench has started tightening. When the torque is less than the set torque threshold, it is determined that the wrench is in a loose state or not working;
[0022] (2) Tightening a workpiece requires two processes, namely tightening and loosening. The initial angle value is recorded each time tightening begins;
[0023] (3) When the wrench rotates Angle_step degrees, the angle value and the corresponding torque value are recorded at the same time, where Angle_step is the user-defined angle value. The recorded angle value is the difference, that is, the difference between the real-time angle value during each tightening process and the initial angle value of this process, and the cumulative rotation angle and maximum torque of the entire tightening process are displayed;
[0024] (4) During the tightening process, it is also determined in real time whether the angle and torque values meet the standards, and the results are uploaded and recorded. The conditions for meeting the standards are Angle_min≤Angel≤Angle_max, Torque_min≤Torque≤Torque_max, where Angel and Torque are the angle and torque values obtained in real time, Angle_min and Angle_max represent the angle qualification range, and it is qualified within this angle value range. Torque_min and Torque_max represent the minimum and maximum values of the torque threshold range; , It is qualified within this threshold range. At the same time, it is also monitored in real time whether the torque is less than the threshold, so as to determine whether it is in the tightening process or the loosening state. If it is in the loosening state, it will enter the process (1) again; when the wrench is tightened, it will be recorded as one rotation until it is judged to be in the loosening state.
[0025] At the same time, in the entire angle accumulation algorithm, there are still some core issues that need to be addressed as follows:
[0026] 1. Angle measurement method based on relative angle difference
[0027] When a worker uses a wrench to tighten a workpiece, the workpiece will be tightened multiple times. The tightening diagram is shown in the figure below. Figure 6 As shown: 1 is clockwise tightening, 2 is counterclockwise loosening, 3 means tightening again clockwise, and repeat this process until the torque value and angle value meet the standard. The recorded angle value is the angle value rotated by the worker each time during the tightening process, and this angle value is a difference value. The angle value of each rotation needs to be accumulated and recorded to ensure that the correct tightening angle value is recorded. The tightening and loosening state of the wrench is judged by the relationship between the torque value and the torque threshold.
[0028] In actual operation, users will perform tightening operations intermittently for many times. The angle accumulation algorithm implemented by the present invention takes the relative angle difference of a single tightening as the object, avoiding the angle accumulation error caused by the absolute angle, that is, the superimposed measurement based on the previous measurement, and further improving the accuracy of angle measurement. The angle accumulation value, that is, the total rotation angle, is calculated as follows:
[0029] Angle cumulative value = relative angle difference 1 + relative angle difference 2 + ... relative angle difference n.
[0030] 2. Continuous calculation method of rotation angle
[0031] It should be noted that the angle value recorded by the inertial sensor during one rotation is not 0°~360°; under such conditions, the Differ (difference) in each interval during the rotation process is not of the same sign; therefore, corresponding processing is required, and the inertial sensor defaults to increasing the counterclockwise rotation angle, while the tightening workpiece is tightened clockwise, so first of all, it must be converted to a clockwise accumulation rule, that is, the processing involved here is as follows:
[0032] (1) Changing the direction of the inertial sensor angle increase: Last_Angle-Current_Angle=Angle_step; the Current_Angle is the currently measured angle value, and the Last_Angle is the angle value recorded last time during the tightening process, that is, the (Current_Angle+Angle_step) angle value;
[0033] (2) Dealing with the problem of the inertial sensor -179°~180° interface (negative~positive), during the entire rotation process, only this interface has a different angle transformation rule from other places, and the Differ (difference) in this interval is also different from other intervals. The solution is to add 360° to this difference, that is, Differ=Differ+360°, and transform it into the difference rule of other intervals.
[0034] Compared with the prior art, the present invention has the following beneficial effects:
[0035] (1) The present invention provides an intelligent torque wrench angle precision measurement method based on inertial sensor. Inertial sensor and torque sensor module are installed on the traditional wrench to develop a set of intelligent digital display wrenches that can measure and record the rotation angle value and torque value. In view of the measurement error problem caused by the sensitive characteristics of the inertial sensor, plane calibration is used to first solve the installation error problem of the inertial sensor. Then, in view of the drift error of the low-cost inertial sensor, the difference recording algorithm in the present invention has a good advantage and avoids the angle measurement error caused by the absolute angle. The above method is used to ensure the use of low-precision inertial sensors in this operation scenario, effectively improving the overall measurement accuracy.
[0036] (2) The present invention provides an intelligent torque wrench angle precision measurement method based on inertial sensor, which utilizes the dual information of torque value + angle value to ensure the accuracy of assembly work. In addition, the combination of torque value + angle value can show the overall state of the workpiece, so as to make a comprehensive judgment on the tightening condition of the workpiece, which greatly improves the safety and reliability of the entire assembly work. BRIEF DESCRIPTION OF THE DRAWINGS
[0037] Figure 1 It is a structural diagram of the wrench described in the present invention.
[0038] Figure 2 It is a three-axis rotation diagram in Example 1 of the present invention.
[0039] Figure 3 Schematic diagram of the error angle between the inertial sensor and the bottom surface of the wrench in Example 1 of the present invention Figure 1 .
[0040] Figure 4 Schematic diagram of the error angle between the inertial sensor and the bottom surface of the wrench in Example 1 of the present invention Figure 2 .
[0041] Figure 5 It is the component relationship of the rotation angle of the bottom surface of the wrench on the bottom surface of the control panel in Example 1 of the present invention.
[0042] Figure 6 This is a flow chart of the angle accumulation algorithm in Example 1 of the present invention.
[0043] Figure 7 It is a schematic diagram of the wrench operation process in Example 1 of the present invention.
[0044] Figure 8 It is a schematic diagram of angle recording during the tightening process of a workpiece in Example 1 of the present invention.
[0045] Fig. 9 Schematic diagram of the angle change value of the inertial sensor during the rotation process in Example 1 of the present invention.
[0046] Fig.10 This is a diagram showing the variation pattern of the angle difference interval in Example 1 of the present invention. DETAILED DESCRIPTION
[0047] The present disclosure is further described below in conjunction with the accompanying drawings and embodiments.
[0048] It should be noted that the following detailed descriptions are exemplary and are intended to provide further explanation of the present disclosure. Unless otherwise specified, all technical and scientific terms used herein have the same meanings as those commonly understood by those skilled in the art to which the present disclosure belongs.
[0049] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit the exemplary embodiments according to the present disclosure. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprising" and / or "including" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.
[0050] In the absence of conflict, the embodiments in the present disclosure and the features in the embodiments may be combined with each other.
[0051] Example 1
[0052] Based on the above situation, the present invention solves the angle measurement error caused by the installation error of the inertial sensor for the accurate measurement problem of the inertial sensor. At the same time, a method for recording the torque value + angle value is designed to solve the drift problem of the inertial sensor. The core difference accumulation algorithm in this method effectively reduces the angle drift problem caused by the inertial sensor itself. While ensuring the accurate angle measurement, the overall control of the operation process is improved.
[0053] The overall structure of the wrench is as follows Figure 1 As shown in the figure, the control panel equipped with the inertial sensor and the torque sensor is installed on the wrench. When the wrench is used to tighten the workpiece, the inertial sensor and the torque sensor will record the measured angle value and torque value according to the designed recording method as the wrench rotates. Figure 1 The installation position relationship between the bottom surface of the wrench and the control panel is shown in FIG.
[0054] This embodiment provides a method for accurately measuring the angle of an intelligent torque wrench based on an inertial sensor, comprising:
[0055] S1: Get the angle measured by the inertial sensor;
[0056] Further, the center point of the bottom surface of the control board is used as the origin O2 to establish the wrench coordinate system, including the x'axis, y'axis, and z'axis; the center point of the bottom surface of the wrench is used as the origin O1 to establish the control board coordinate system, including the x-axis, y-axis, and z-axis. Figure 1 As shown;
[0057] When using a wrench for operation, the sleeve of the wrench is put on the workpiece to tighten it. At this time, the bottom surface of the wrench and the bottom surface of the control board have been determined. When the wrench is rotated, only the angle change of the z-axis and z'-axis is involved. What the inertial sensor measures is the rotation angle of the z'-axis, that is, the rotation angle of the control board, and what needs to be displayed is the z-axis, that is, the actual rotation angle of the workpiece (the rotation angle of the bottom surface of the wrench). Figure 2 shown.
[0058] S2: Compensate for the installation error angle and measure the actual rotation angle value: Due to the sensitivity of the inertial sensor, it is necessary to solve the error problem that cannot be ignored during the measurement process. Among them, the measurement error caused by the installation error angle cannot be ignored. Figure 3 , Figure 4As shown in the figure, the inertial sensor (MPU6050) is welded on the control board as a SMD device. When the control board is installed on the bottom surface of the wrench, there will be installation error angles due to various welding devices and circuit problems. The installation error angles may exist in both the x and y directions, causing the control board and the bottom surface of the wrench to be non-parallel. The non-parallelism of the two planes will cause the angle value measured by the inertial device to be inconsistent with the actual rotation angle value of the wrench. What we want to record and display is the actual rotation angle of the workpiece, that is, the rotation angle of the wrench, but what is actually measured is the rotation angle of the control board. Therefore, it is necessary to record this error and find the relative relationship between the bottom surface of the control board and the bottom surface of the wrench to compensate, so as to eliminate the installation error and the actual rotation angle of the workpiece.
[0059] S21: Determine the error angle, the error angle includes a roll angle and a pitch angle; the roll angle is the deviation angle between the bottom surface of the control board and the wrench plane when the control board rotates around the x' axis in the control board coordinate system x'O2y' during installation; the pitch angle is the deviation angle between the bottom surface of the control board and the wrench plane when the control board rotates around the y' axis in the control board coordinate system x'O2y' during installation.
[0060] Power on the wrench and keep it horizontal (keep it absolutely horizontal with the local horizontal plane). If there is no installation error angle between the bottom surface of the control board and the bottom surface of the wrench, the results displayed by the accelerometer on its own x, y, and z axes should be {0, 0, g} (the actual value of g depends on the local longitude and latitude). If there is an installation error angle, the gravity acceleration g will have components on the x and y axes, and the acceleration component measured in the z-axis direction will no longer be the local gravity acceleration g;
[0061] Assume that the gravity component of the acceleration measured by the control board on the three coordinate axes is {a x , a y , a z},like Figure 3 , Figure 4 As shown. x =g*sinθ, the value of sinθ can be known according to the reading of the accelerometer in the x' axis direction, and thus the roll angle θ = arcsina x ;
[0062] Similarly, we can get a y =g*sinφ, the value of sinφ can be known according to the reading of the accelerometer in the y' axis direction, so the pitch angle φ = arcsina y ;
[0063] From this, we get the installation error angle between the plane of the inertial sensor and the installation plane of the wrench. The next step is to calculate the transformation matrix of the two coordinate systems to find the actual rotation angle of the wrench, that is, the rotation angle of the z-axis.
[0064] S22: Obtain the actual rotation angle of the workpiece through coordinate transformation: When the user is using the wrench to perform an operation, the actual rotation angle of the wrench is the rotation angle of the z'-axis on the bottom surface of the wrench. The angle measured by the inertial sensor is the rotation angle of the z-axis under the bottom surface of the control board. To measure the actual rotation angle of the wrench, it is necessary to transform the coordinates. There is a rotation relationship between the control board coordinate system and the wrench coordinate system, that is, a rotation relationship that exists due to the installation error angle. The control board coordinate system can be obtained by rotating the wrench coordinate system. The schematic diagram of the z-axis angle of the actual rotation of the wrench on the bottom surface of the control board is shown in the figure. Figure 5 As shown:
[0065] The relationship between the actual rotation angle of the wrench and the angle measured by the inertial sensor is shown in Formula 1:
[0066]
[0067] Among them, V g Indicates the rotation angle value measured by the inertial sensor, Represents the transformation matrix from the wrench coordinate system to the control panel coordinate system, V r Indicates the actual rotation angle of the wrench.
[0068] Calculate the transformation matrix
[0069]
[0070] Among them C θ Represents the rotation relationship between the wrench coordinate system and the control panel coordinate system at an angle of θ on the x' axis. φ Represents the rotation relationship between the wrench coordinate system and the control panel coordinate system at an angle of φ on the y′ axis.
[0071] Write the actual relationship based on formula 1:
[0072]
[0073] So we get:
[0074]
[0075] Because the bottom surface of the wrench is fixed and does not change during the rotation of the workpiece, the angles of the x-axis and y-axis will not change, both are 0, and only the z-axis will produce an angle change in the heading angle, so the angle in formula 3
[0076] So according to formula 4 we extract the angle relationship of the z-axis:
[0077] v z =cosφcosθ*V z (5)
[0078] In formula 5, v z Represents the angle value measured by the inertial sensor, V z Represents the actual rotation angle of the wrench on the z-axis.
[0079] Right now:
[0080]
[0081] Written as a symbolic expression:
[0082]
[0083] When the wrench is calibrated on the plane, the two installation angles are saved, and the value read by the inertial sensor is divided by cosφcosθ to obtain the actual rotation angle value V of the workpiece. z .
[0084] S3: Increase the measurement accuracy of the inertial sensor through the angle accumulation algorithm: First, set a torque threshold to determine whether the wrench is in working state. Data will be recorded only when it is in working state. When the wrench is used for tightening operation, the torque value will be greater than the set threshold. By recording the actual rotation angle of the workpiece for a single time to avoid the long-term drift error of the inertial sensor, finally, the actual rotation angle of the workpiece recorded each time is accumulated to obtain the final total rotation angle, that is, the single relative angle difference (the final angle at the end of a single tightening operation minus the initial angle at the beginning of the tightening operation) is recorded and accumulated, which can effectively avoid the drift error of the inertial sensor.
[0085] The angle accumulation algorithm process is as follows: Figure 6 As shown:
[0086] (1) When the wrench is tightening and the torque is greater than the set torque threshold (the torque value is monitored by the torque sensor), it is determined that the wrench has started tightening. When the torque is less than the set torque threshold, it is determined that the wrench is in a loose state or in an inoperative state.
[0087] (2) Tightening a workpiece requires two processes, namely tightening and loosening. Each time you start tightening, record the initial angle value, such as Figure 7 As shown;
[0088] (3) When the wrench rotates Angle_step degrees, the angle value and the corresponding torque value are recorded at the same time, where Angle_step is the user-defined angle value. The recorded angle value is the difference, that is, the difference between the real-time angle value during each tightening process and the initial angle value of this process, and the cumulative rotation angle and maximum torque of the entire tightening process are displayed;
[0089] (4) During the tightening process, it is also determined in real time whether the angle and torque values meet the standards, and the results are uploaded and recorded. The conditions for meeting the standards are Angle_min≤Angel≤Angle_max, Torque_min≤Torque≤Torque_max, where Angel and Torque are the angle and torque values obtained in real time, Angle_min and Angle_max represent the angle qualification range, and it is qualified within this angle value range. Torque_min and Torque_max represent the minimum and maximum values of the torque threshold range, and it is qualified within this threshold range. At the same time, it is also monitored in real time whether the torque is less than the threshold, so as to determine whether it is in the tightening process or the loosening state. If it is in the loosening state, it will enter process (1) again; when the wrench is tightened, it will be recorded as one rotation until it is judged to be in the loosening state.
[0090] At the same time, in the entire angle accumulation algorithm, there are still some core issues that need to be addressed as follows:
[0091] 1. Angle measurement method based on relative angle difference
[0092] When a worker uses a wrench to tighten a workpiece, the workpiece will be tightened multiple times. The tightening diagram is shown in the figure below. Figure 6 As shown: 1 is clockwise tightening, 2 is counterclockwise loosening, 3 means tightening again clockwise, and repeat this process until the torque value and angle value meet the standard. The recorded angle value is the angle value rotated by the worker each time during the tightening process, and this angle value is a difference value. The angle value of each rotation needs to be accumulated and recorded to ensure that the correct tightening angle value is recorded. The tightening and loosening state of the wrench is judged by the relationship between the torque value and the torque threshold.
[0093] Angle recording diagram Figure 7 As shown, in the actual operation process, the user will perform tightening operations intermittently for many times. The angle accumulation algorithm implemented by the present invention takes the relative angle difference of a single tightening as the object, avoiding the angle accumulation error caused by the absolute angle, that is, the superimposed measurement based on the previous measurement, and further improving the accuracy of the angle measurement. The angle accumulation value, that is, the total rotation angle, is calculated as follows:
[0094] Angle cumulative value = relative angle difference 1 + relative angle difference 2 + ... relative angle difference n (7)
[0095] 2. Continuous calculation method of rotation angle
[0096] It should be noted that the angle value recorded by the inertial sensor during one rotation is not 0° to 360°, but Fig. 9The angle changes shown; under such conditions, the Differ (difference) of each interval during the rotation process is not of the same sign, such as Fig.10 As shown; therefore, corresponding processing is required, and the inertial sensor defaults to increasing the counterclockwise rotation angle, while the workpiece is tightened clockwise, so first it must be converted to a clockwise accumulation rule, that is, the processing involved here is as follows:
[0097] (1) Change the direction of the inertial sensor angle increase: Last_Angle-Current_Angle=Angle_step; Current_Angle is the currently measured angle value, and Last_Angle is the angle value recorded last time during this tightening process, that is, (Current_Angle+Angle_step) angle value. In a single tightening process, starting from the recorded initial angle value, each time the angle value increases by angle_step, the angle value and the corresponding torque value are recorded until the tightening process ends. Therefore, the entire angle difference in a tightening process is recorded in units of angle_step.
[0098] (2) Dealing with the problem of the inertial sensor -179°~180° interface (negative~positive). During the entire rotation process, only this interface has a different angle change rule from the rest of the place. The Differ (difference) in this interval is also different from the rest of the interval. The solution is to add 360° to this difference, that is, Differ=Differ+360°, and transform it into the difference rule of other intervals. For example, when the rotation process changes from -170° to 170°, the measured Differ is -340, but the actual display is Differ=Differ+360°, so the actual difference is 20°.
[0099] Obviously, the above embodiments of the present invention are merely examples for clearly illustrating the technical solution of the present invention, and are not intended to limit the specific implementation methods of the present invention. Any modifications, equivalent substitutions, and improvements made within the spirit and principles of the claims of the present invention shall be included in the protection scope of the claims of the present invention.
Claims
1. An intelligent torque wrench angle accurate measurement method based on inertial sensor, characterized in that: include; S1: Get the angle measured by the inertial sensor; S2: Calculate the installation error angle between the control panel and the wrench, and use coordinate transformation to obtain the actual rotation angle of the workpiece; S3: by recording a single relative angle difference as an object, accumulating multiple relative angle differences, and finally calculating the total rotation angle; The method of accumulating multiple relative angle differences in S3 specifically includes: (1) A torque threshold is preset, and when the measured torque is greater than the set torque threshold, it is determined that the wrench starts tightening; (2) Perform one or more tightening operations on the workpiece to be tightened, and record the initial angle value at the beginning of each tightening process; (3) When the wrench rotates Angle_step degrees, the angle value and the corresponding torque value are recorded at the same time, where Angle_step is a user-defined angle value; the recorded angle value is the difference, that is, the difference between the real-time angle value during each tightening process and the initial angle value of this process, and the cumulative rotation angle and maximum torque of the entire tightening process are displayed; (4) During the tightening process, the angle and torque values will be judged in real time to see if they meet the standards. If they do, the results will be uploaded and recorded. The conditions for meeting the standards are: Angle_min≤Angel≤Angle_max (1) Torque_min≤Torque≤Torque_max (2) In formulas (1) and (2), Angel and Torque are the angle and torque values obtained in real time, respectively. Angle_min and Angle_max represent the maximum and minimum values of the angle qualified interval, respectively. Torque_min and Torque_max represent the maximum and minimum values of the torque threshold qualified interval. At the same time, the torque is monitored in real time to see if it is less than the torque threshold to determine whether it is in a tightening state or a loosening state. If it is in the released state, go to step (1) again; If it is in a tightened state, it is recorded as one rotation until it is judged to be in a loosened state.
2. According to claim 1, a method for accurately measuring the angle of an intelligent torque wrench based on an inertial sensor is characterized in that: The installation error angle includes a roll angle and a pitch angle; Taking the center point of the bottom surface of the control board as the origin, establish the control board coordinate system, including the x' axis, y' axis, and z' axis; Taking the center point of the bottom surface of the wrench as the origin, a wrench coordinate system is established, including an x-axis, a y-axis, and a z-axis; The roll angle is the deviation angle between the bottom surface of the control board and the bottom surface of the wrench when the bottom surface of the control board rotates around the x' axis in the control board coordinate system x'O2y' during installation; The pitch angle is the deviation angle between the bottom surface of the control board and the bottom surface of the wrench when the bottom surface of the control board rotates around the y' axis in the control board coordinate system x'O2y' during installation.
3. The method for accurately measuring the angle of an intelligent torque wrench based on an inertial sensor according to claim 2 is characterized in that: The calculation method of the roll angle Including: Let the gravity component measured by the three coordinate axes of the acceleration in the control panel coordinate system be {a x , a y , a z }, where a x =g*sinθ, and the sinθ value is obtained according to the reading of the accelerometer in the x'-axis direction, and the final roll angle θ=arcsina x ; The method for calculating the pitch angle includes: assuming that the gravity components measured by the three coordinate axes of the accelerometer are {a x , a y , a z }, where a y =g*sinφ, the sinφ value is obtained according to the reading of the accelerometer in the y' axis direction, and the pitch angle is finally obtained φ=arcsine y 。 4. The method for accurately measuring the angle of an intelligent torque wrench based on an inertial sensor according to claim 1 is characterized in that: The method for calculating the angle value of the actual rotation of the workpiece includes: The transformation matrix from the wrench coordinate system to the control board coordinate system is calculated according to the rotation relationship of the wrench coordinate system to the control board coordinate system on the x' axis with an angle of θ and the rotation relationship of the wrench coordinate system to the control board coordinate system on the y' axis with an angle of φ; According to the z'-axis rotation angle of the control board coordinate system measured by the inertial sensor, the actual z-axis rotation angle of the wrench coordinate system is calculated through the conversion matrix from the wrench coordinate system to the control board coordinate system.
5. The method for accurately measuring the angle of an intelligent torque wrench based on an inertial sensor according to claim 1 is characterized in that: The method of accumulating multiple relative angle differences also includes the following method: The relative angle difference recorded for a single time is the final angle at the end of a single tightening operation minus the initial angle at the beginning of the tightening operation. The angle accumulation value, i.e. the total rotation angle, is calculated as follows: Angle cumulative value = relative angle difference 1 + relative angle difference 2 + ... relative angle difference n; The inertial sensor defaults to increasing the angle of rotation counterclockwise, while tightening is done clockwise, so it needs to be converted to a clockwise accumulation rule. The processing involved is as follows: (1) Changing the direction of the inertial sensor angle increase: Last_Angle-Current_Angle=Angle_step; the Current_Angle is the currently measured angle value, and the Last_Angle is the angle value recorded last time during the tightening process, that is, the Current_Angle+Angle_step angle value; (2) Processing the problem at the interface of the inertial sensor angle -179° to 180°. The processing method for this interface during the entire rotation process is to add 360° to the difference, that is, Differ = Differ + 360°.
