Calibration method and device for mechanical control and computer readable storage medium
By using multiple fixtures for calibration detection and phased correction, the problem of the reduction in accuracy of the medical device mechanical control system after long-term operation is solved, and the calibration accuracy and correction effect of the multi-axis motion system are improved.
Patent Information
- Application Number
- CN202411169057.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-23
- Publication Date
- 2024-11-29
AI Technical Summary
After long-term operation, the accuracy of the existing medical device mechanical control system is reduced due to structural aging and environmental factors, and cannot meet the requirements of high efficiency and accuracy. Especially in multi-axis operation, the calibration accuracy is low, resulting in an increase in error and affecting the working effect.
Using multiple fixtures as calibration reference parts, through the detection and correction process, the actual control amount and deviation amount of the working part in each direction are obtained, and the phased correction is carried out, and the deviation amount of the multiple reference parts is combined for comprehensive judgment and compensation. Improve mechanical control accuracy.
It effectively solves the problem of low mechanical control accuracy, improves the calibration accuracy and correction effect of multi-axis motion system, and ensures high-precision operation of mechanical equipment in multi-axis space.
Smart Images

Figure CN119045539A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of medical devices, and in particular to a calibration method and device for mechanical control. Background Art
[0002] As the automation of equipment becomes increasingly high, the efficiency and precision requirements of equipment are also getting higher and higher, especially in the field of medical equipment. Insufficient precision will affect subsequent work and lead to adverse problems. For example, in medical equipment for liquid injection, if the mechanical precision is inaccurate, it will cause the injection position of the sample needle to deviate, resulting in waste of sample liquid and even pollution of the site environment.
[0003] The existing machines have relatively high accuracy when they are first shipped from the factory, but after long-term operation, the motor movement will have certain deviations due to structural aging, environmental and other external factors. This deviation will gradually increase and cause the accuracy of the machine operation to decrease, which cannot meet the accuracy requirements of the machine operation.
[0004] In the prior art, the position detection value of the calibration platform is compared with the actual position value. If the deviation is within a certain range, the deviation is ignored. If the deviation exceeds the threshold range, the deviation is corrected at the original position, that is, the deviation value is added or subtracted from the original control value. However, this method has the problem of low correction accuracy, especially for machines with three axes or other multi-axis operations, the correction effect is not good. Summary of the invention
[0005] In order to overcome the deficiencies of the prior art, an object of the present invention is to provide a calibration method and device for mechanical control, so as to solve the problem of low calibration accuracy in the control method in the prior art.
[0006] In a first aspect, the present invention provides a calibration method for mechanical control, which is applied to a motion system, wherein the motion system comprises a working component, a driving component for driving the working component to move in at least one direction, and at least two fixing components with different positions in each direction of the at least one direction, wherein the at least two fixing components are both located within a movable range of the working component. The calibration method includes a detection and correction process, and the detection and correction process includes: sequentially executing a calibration detection process of the working component in each direction of the at least one direction; During the calibration detection process of each detected direction, obtaining the actual control amount of the working component moving to each of the fixed components in the detected direction; Determine the actual deviation of the working component in the corresponding detection direction according to the actual control amount of the working component moving to each of the fixing parts during the calibration detection process; Based on each of the actual deviation amounts, the position deviation of the working component in the corresponding detection direction is corrected in stages.
[0007] The calibration method according to the first aspect of the present invention has at least the following beneficial effects: The present calibration correction method utilizes two or more fixings as calibration reference components, and each fixing is different in each direction. Therefore, during the calibration process in each direction, since the position of each fixing on the motion system is fixed, the driving component has at least two calibration reference components in this direction, which can effectively solve the problem of inaccurate calibration caused by having only one reference component, and conducts a combined judgment on the deviation amounts detected by multiple calibration reference components to accurately judge the deviation value of the current mechanical control accuracy, discover the driving accuracy problem of the driving component, and at the same time, combine the staged compensation method to correct the working component, identify and match the correction method of the working component at different deviation stages, and further improve the accuracy correction effect.
[0008] In a preferred embodiment of the present invention, the calibration detection process includes executing a plurality of calibration detection sub-processes corresponding to each of the fixing members respectively. Wherein, the calibration detection subprocess includes: Controlling the driving component to move the working component to a target position, wherein the target position is located in a direction opposite to a detected direction of a target fixing member; The driving component controls the working component to move along the detection direction to the target fixing component, and obtains the actual control amount of the working component moving from the target position to the target fixing component.
[0009] In a preferred embodiment of the present invention, the step of controlling the driving component to move the working component to a target position comprises: Based on the motion coordinate system of the motion system and the position information of the initial position in the motion coordinate system, the driving component is controlled by a preset control amount in each direction in the motion coordinate system to drive the working component to move from the initial position to the target position; The step of controlling the working component to move along the detection direction to the target fixing component by the driving component comprises: The driving component is controlled to move the working component along the detected direction until the sensor detects that the working component reaches the target fixing member.
[0010] In a preferred embodiment of the present invention, controlling the working component to move along the detection direction to the target fixed component by the driving component, and obtaining the actual control amount of the working component moving from the target position to the target fixed component, includes: Execute the detection movement process multiple times, and record the control amount of the driving component in each detection movement process, wherein the detection movement process is to control the working component to move from the target position along the detection direction to the target fixed component by the driving component; According to the control amount of the driving component recorded in all the detection movement processes executed in this calibration detection sub-process, the actual control amount of the working component moving from the target position to the target fixed part is obtained; The multiple executions of the detection movement process and recording the control amount of the driving component during each detection movement process include: During the first detection movement, recording the control amount of the working component moving from the target position to the target firmware; Before the non-first detection movement process is executed, controlling the driving component to move the working component in the opposite direction of the detection direction according to the control amount recorded in the last detection movement process to reset the working component; and In the non-first detection movement process, controlling the driving component to move the working component along the detection direction to the target fixed component, and recording the control amount of the working component moving from the target position to the target fixed component; The step of obtaining the actual control amount of the working component moving from the target position to the target fixed component according to the control amount of the driving component recorded in all the detection movement processes executed in the current calibration detection subprocess includes: The control amount of the driving component recorded in all the detection movement processes executed in this calibration detection sub-process is calculated as the average value except the maximum value and the minimum value, and the obtained average value is the actual control amount of the working component moving from the target position to the target fixed part.
[0011] In a preferred embodiment of the present invention, determining the actual deviation of the working component in the corresponding detection direction according to the actual control amount of the working component moving to each of the fixing parts during the calibration detection process includes: Calculating each actual deviation amount of the working component moving along the detection direction to each of the fixing components based on a preset control amount and an actual control amount of the working component moving along the detection direction to each of the fixing components; The step of correcting the position deviation of the working component in the corresponding detection direction in stages based on each of the actual deviations includes: Determining whether the position deviation of the fixing member in the detected direction needs to be corrected according to each of the actual deviations; If correction is required, determine the total actual deviation value based on each of the actual deviation amounts; Based on the preset numerical range division, determining the numerical range into which the total actual deviation value falls; A correction strategy for the numerical range that the value falls into is obtained, and the position deviation of the working component in the detected direction is corrected according to the correction strategy.
[0012] In a preferred embodiment of the present invention, judging whether the position deviation of the fixing member needs to be corrected according to each of the actual deviations includes: If the detected direction is only a single direction, a total deviation value is obtained based on each of the actual deviations, and it is determined whether the total deviation value is greater than a first threshold value. If so, correction needs to be performed; If the detected direction has a positive direction and a reverse direction, it is determined in turn whether the deviation value of the working component on each of the fixing components is greater than a second threshold value. If one of the deviation values is greater than the second threshold value, correction is required. Among them, the deviation value is determined by a positive actual deviation value and a negative actual deviation value. The positive actual deviation value is the actual deviation between the working component along the positive direction of the detected direction and the corresponding fixed component, and the reverse actual deviation value is the actual deviation between the working component along the reverse direction of the detected direction and the corresponding fixed component.
[0013] In a preferred embodiment of the present invention, the at least two fixing members include a first fixing member and a second fixing member, and the obtaining of the actual control amount of the working component moving to each of the fixing members in the detected direction includes: If the detected direction is only a single direction, obtaining a first actual control amount of the working component moving along the detected direction to the first fixing component, and obtaining a second actual control amount of the working component moving along the detected direction to the second fixing component; If the detected direction has a positive direction and a negative direction, respectively obtain a first actual control amount of the working component moving along the positive direction and the negative direction of the detected direction to the first fixing component, and respectively obtain a second actual control amount of the working component moving along the positive direction and the negative direction of the detected direction to the second fixing component; Determining the actual deviation of the working component in the corresponding detection direction according to the actual control amount of the working component moving to each of the fixing parts during the calibration detection process includes: comparing the first actual control amount with a first preset control amount of the working component moving along the detection direction to the first fixing component to obtain a first actual deviation amount of the working component moving along the detection direction to the first fixing component, and Comparing the second actual control amount with a second preset control amount by which the working component moves along the detection direction to the second fixing component, so as to obtain a second actual deviation amount by which the working component moves along the detection direction to the second fixing component; Calculating an absolute value of a difference between the first actual deviation and the second actual deviation to obtain the total actual deviation; When the detected direction has a positive direction and a negative direction, the first actual deviation and the second actual deviation are the first actual deviation and the second actual deviation obtained in the positive direction of the detected direction.
[0014] In a preferred embodiment of the present invention, the preset numerical range division includes a first range and a second range which are sorted from small to large and have continuous numerical values, and the correction strategy for obtaining the numerical range into which the position deviation of the working component is corrected according to the correction strategy includes: In the first range, the position deviation of the working component is corrected according to the relative size of the first actual deviation and the second actual deviation; Within the second range, a deviation correction value and a correction direction are determined based on the position information of the first fixing member, the position information of the second fixing member, the linearity between the first actual deviation and the second actual deviation, and the position of the working part is corrected according to the deviation correction value and the correction direction.
[0015] In a preferred embodiment of the present invention, the correction of the position deviation of the working component according to the relative size of the first actual deviation and the second actual deviation includes: Calculating an average value of the first actual deviation and the second actual deviation to obtain a correction value; The compensation direction is determined based on the relative size of the first actual deviation and the second actual deviation, so that the position deviation is corrected in the compensation direction.
[0016] In a preferred embodiment of the present invention, the linear determination of the deviation correction value and the correction direction based on the position information of the first fixing member, the position information of the second fixing member, the first actual deviation amount, and the second actual deviation amount, and the correction of the position of the working component according to the deviation correction value and the correction direction includes: The deviation correction value ΔN is obtained according to the following equation: ΔN=|((N 02 -N2)-(N 01 -N1)) / (N2-N1)*N+(N2(N 01 -N1)-N1(N02 -N2)) / (N2-N1)| Among them, N 01 is the first actual control variable, N1 is the first preset control variable, N 02 is a second actual control amount, N2 is a second preset control amount, and N is a coordinate value of the position of the working component between the first fixing member and the second fixing member relative to the initial position in the detected direction; Determine the correction direction based on the relative size of the first actual deviation and the second actual deviation, so that the position deviation of the working component is corrected in the correction direction. Among them, if the detected direction has a positive direction and a negative direction, the first actual control amount, the first preset control amount, the second actual control amount and the second preset control amount all take the first actual control amount, the first preset control amount, the second actual control amount and the second preset control amount in the positive direction of the detected direction.
[0017] In a preferred embodiment of the present invention, the calibration method further includes a reliability calibration process performed after the detection correction process, and the reliability calibration process includes: sequentially executing a calibration detection process of the working component in each direction of the at least one direction; During the calibration test process in each detected direction, a test control amount of the working component moving to each of the fixed components in the detected direction is obtained; Comparing the test control amount obtained in the detected direction with the actual control amount in the detected direction during the detection and correction process, to determine whether the position deviation of the fixing member needs to be corrected in the detected direction; If necessary, cancel the correction action performed in the previous detection and correction process, and perform the next detection and correction process; The comparing the test control amount obtained in the detected direction with the actual control amount in the detected direction during the detection and correction process to determine whether the position deviation of the fixing part needs to be corrected in the detected direction includes: Determine whether the difference between the test control amount and the actual control amount in the detected direction is within a threshold range in the detected direction; If so, no correction is necessary; If not, a correction process needs to be performed; The reliability calibration process also includes: When the detection and correction process is executed more than a preset number of times, the motion system is controlled to report an error.
[0018] In a preferred embodiment of the present invention, the driving component includes a driving motor and a mechanical arm drivingly connected to the driving motor and driven by the driving motor, and the working component is arranged on a moving end of the mechanical arm. The actual control amount of the working component moving to each of the fixed components in the detected direction is the actual control step number of the driving motor, and the actual deviation amount between the working component and each of the fixed components in the corresponding detection direction is the actual deviation step number of the driving motor that enables the working component to move to each of the fixed components along the corresponding detection direction; The driving component can drive the working component to move in at least two directions, so that the working component moves within the movable range of the three-axis space. Wherein, the positions of the fixing members in any of the at least two directions are different.
[0019] In a preferred embodiment of the present invention, the at least two directions include an X-axis direction, a Y-axis direction and a Z-axis direction that are perpendicular to each other, and the fixing members have different heights in the Z-axis direction and different positions in the X-axis direction and the Y-axis direction. Among them, the calibration detection process in each direction performed during the detection correction process includes the following detection directions: the positive direction of the X-axis direction, the negative direction of the X-axis direction, the positive direction of the Y-axis direction, the negative direction of the Y-axis direction, and the negative direction of the Z-axis direction.
[0020] In a second aspect, the present invention further provides a calibration control device for mechanical control, which is applied to a motion system, wherein the motion system comprises a working component, a driving component for driving the working component to move in at least one direction, and at least two fixing components with different positions in each direction of the at least one direction, wherein the at least two fixing components are both located within a movable range of the working component. The calibration control device comprises: An execution unit, used for controlling the driving component to drive the working component to move in each direction of the at least one direction; A detection unit, used for detecting the control amount of the driving component and detecting whether the working component reaches each of the fixing parts; a processing unit, configured to control the execution unit to sequentially execute the calibration detection process of the working component in each direction of the at least one direction, and calculate each actual deviation amount between the working component and each fixed component in the corresponding detection direction according to the actual control amount of the working component moving to each fixed component during the calibration detection process acquired by the detection unit; The correction unit corrects the position deviation of the working component in the corresponding detection direction in stages based on the actual deviation amounts and the directions of the actual deviation amounts.
[0021] Compared with the prior art, the calibration control device of the second aspect of the present invention has at least the following beneficial effects: This calibration control device is combined with the calibration method of the first aspect embodiment. After the execution unit executes the calibration process in each direction, the processing unit uses the detection information obtained by the detection unit to analyze the deviation of the working part, so as to obtain the best correction plan, and controls the correction unit to compensate the accuracy of the machine in stages based on the correction plan, so as to ensure that the correction method under different deviation stages of the working part is identified, thereby improving the accuracy correction effect.
[0022] In a third aspect, the present invention further provides a computer-readable storage medium, wherein a program is stored in the computer-readable storage medium, and when the program is running, a device controls the computer-readable storage medium to execute the calibration method described in the embodiment of the first aspect.
[0023] Other features and advantages of the present invention will be described in the following description, and partly become apparent from the description, or understood by implementing the technical solution of the present invention. The purpose and other advantages of the present invention can be achieved and obtained by the structures and / or processes specifically pointed out in the description, claims and drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0024] Figure 1 A schematic diagram of the structure of a motion system used in a calibration method according to an embodiment of the present invention;
[0025] Figure 2 Schematic diagram of the positions of the first fixing member and the second fixing member in the motion system according to an embodiment of the present invention;
[0026] Figure 3 for Figure 1 The schematic diagram of the structure of the motion system when performing the calibration detection process in the Z-axis direction;
[0027] Figure 4 for Figure 1 The schematic diagram of the structure of the motion system when executing the calibration detection process in the X-axis direction;
[0028] Figure 5 for Figure 1 The schematic diagram of the structure of the motion system when executing the calibration tutorial process in the Y-axis direction;
[0029] Figure 6 A flow chart of the detection and correction process of the calibration method provided in an embodiment of the present invention;
[0030] Figure 7 A flow chart of a reliability calibration process of a calibration method provided in an embodiment of the present invention;
[0031] Figure 8 A schematic diagram of the structure of a calibration control device provided in an embodiment of the present invention.
[0032] Description of Figure Numbers: 11 a first fixing member, 12 a second fixing member; 21 base, 22 Z-axis slide rail, 23 Y-axis slide rail, 24 X-axis slide rail, 25 slider; 30 reference control device, 31 execution unit, 32 detection unit, 33 processing unit, 34 correction unit; 40 working parts. DETAILED DESCRIPTION
[0033] The following will describe the implementation methods of the present invention in detail in combination with the accompanying drawings and embodiments, so that the implementation process of how the present invention applies technical means to solve technical problems and achieve technical effects can be fully understood and implemented accordingly. It should be noted that these specific descriptions are only for ordinary technicians in this field to understand the present invention more easily and clearly, rather than a restrictive interpretation of the present invention; for example, the first and second mentioned in the embodiments of the present invention do not constitute a limitation thereto, but are only for expressing the serial numbers of multiple identical or similar devices and mechanisms. Ordinary technicians in this field can also readjust these serial numbers for the convenience of expression or in the process of arranging technical solutions; and alternative solutions are described for some mechanisms in different embodiments, and these alternatives can also be applied to other identical or similar devices and mechanisms; and as long as there is no conflict, the various embodiments in the present invention and the various features in each embodiment can be combined with each other, and the technical solutions formed are all within the protection scope of the present invention.
[0034] The technical solution of the present invention is described in detail below through the accompanying drawings and specific embodiments.
[0035] In a first aspect, an embodiment of the present invention provides a calibration method for mechanical control, which is used to detect precision failures of mechanical control and can perform precision correction on the calibrated machine based on the detection results.
[0036] First, the mechanically controlled motion system used in the calibration method of the first embodiment is described. Figure 1The motion system includes a working component 40, a driving component (not shown in the figure) and at least two fixing components. The working component 40 is used to perform tasks such as injection, grasping, and detection. The driving component is used to drive the working component 40 to move in at least one direction, so that the working component 40 moves to a target position to perform corresponding work. The at least two fixing components are located within the movable range of the working component 40 and can be touched or collided with by the working component 40. The positions of the fixing components in each direction in which the working component 40 is driven by the driving component are different, that is, in any driving direction of the working component 40 by the driving component, the positions of the fixing components do not overlap.
[0037] For example Figure 2 In the embodiment, the driving component drives the working component 40 in the XYZ three-axis direction, and the fixed component includes a first fixed component 11 and a second fixed component 12. The coordinate positions of the first fixed component 11 and the second fixed component 12 in the X-axis direction are different, the coordinate positions in the Y-axis direction are different, and the coordinate positions of the tops of the two fixed components in the Z-axis direction are also different. Therefore, the positions of the two fixed components in each direction in which the working component 40 driven by the driven component moves are different. Of course, if the driving component drives the working component 40 only in the XY two-axis direction, the positions of the two or more fixed components in the two-axis direction are different, and the same is true for other implementations, which will not be described in detail here.
[0038] In this embodiment, Figure 1 The driving component shown in the figure is a three-axis driving component, including a base 21, a Z-axis slide rail 22 arranged on the base 21, a Y-axis slide rail 23 moving on the Z-axis slide rail 22, an X-axis slide rail 24 moving on the Y-axis slide rail 23, and a slider 25 sliding on the X-axis slide rail 24, wherein a working component 40 is arranged on the slider 25, and a Z-axis motor, a Y-axis motor and an X-axis motor are respectively arranged on the Z-axis slide rail 22, the Y-axis slide rail 23 and the X-axis slide rail 24 slider 25, the Z-axis motor is used to drive the Y-axis slide rail 23 to move along the Z-axis direction, the Y-axis motor is used to drive the X-axis slide rail 24 to move along the Y-axis direction, and the X-axis motor is used to drive the slider 25 to move along the X-axis direction, thereby realizing the movement of the working component 40 in the spatial range of the XYZ three axes.
[0039] Next, the calibration method of the embodiment of the first aspect of the present invention is described.
[0040] The calibration method includes a detection and correction process, which detects the accuracy problem of the applied motion system and corrects and compensates for its deviation.
[0041] See also Figure 6 , the detection and correction process includes: S100, sequentially executing calibration and detection processes of the working component in each direction of at least one direction.
[0042] Because the working part 40 can move in one or more directions under the drive of the driving part, so as to achieve position movement within a predetermined range, and because the positions of the fixing parts in each direction are different, the working part 40 will not touch two or more of the fixing parts at the same time when moving in the direction, thus providing conditions for the detection and calibration process on the fixing parts in the direction. Figure 1 In the embodiment, since the moving directions of the working component 40 include the X-axis, Y-axis and Z-axis directions, the calibration detection process performed by S100 includes calibration detection processes in the X-axis, Y-axis and Z-axis directions, and the positions of the two fixing parts in each direction are different.
[0043] Specifically, the calibration detection process in the detected direction includes executing a plurality of calibration detection sub-processes corresponding to each fixture in the detected direction, that is, in the detected direction, a separate calibration detection sub-process needs to be performed for each fixture one by one.
[0044] The calibration and detection sub-process includes: S110, controlling the driving component to move the working component to a target position, the target position being located in the opposite direction of the detected direction of the target fixing component; S120, controlling the working component to move to the target fixed component along the detection direction through the driving component, and obtaining the actual control amount of the working component moving from the target position to the target fixed component.
[0045] The target position is the initial position in the calibration detection sub-process. Before the detection, the working component 40 needs to be moved to the predetermined target position, and the driving component is controlled to drive the working component 40 to move to the target fixed part, thereby obtaining the actual control amount from the target position to the target fixed part. The actual control amount can be a distance value, or an actual driving amount of the driving component, or other related parameters that can reflect the control amount, which are not limited here.
[0046] exist Figures 2 to 5 In the illustrated embodiment, since there are two fixing members, the calibration detection sub-process includes two calibration detection sub-processes in any detection direction. For example, when the calibration detection process is performed in the X-axis direction, it includes a first calibration detection sub-process corresponding to the X-axis direction of the first fixing member 11 and a second calibration detection sub-process corresponding to the X-axis direction of the second fixing member 12, and the actual control quantities obtained in the two sub-processes are respectively obtained.
[0047] For ease of understanding, the execution process of the above calibration detection sub-process is described below in terms of coordinate positions. Figure 3, if the detection direction is the Z axis, since the positions of the first fixing member 11 and the second fixing member 12 are fixed, the first target position corresponding to the first fixing member 11 should be at a fixed distance from the first fixing member 11, and the second target position corresponding to the second fixing member 12 should be at a fixed distance from the second fixing member 12, wherein the first target position and the second target position can be overlapping positions or different positions. Based on this, during the execution of the calibration detection sub-process in the Z axis direction, it is assumed that the first target position is the first initial position Z 01 , the second target position is the second initial position Z 02 , then in the first calibration detection sub-process, the working part 40 is moved to the first target position Z 01 The working component 40 is driven to move to the position of the first fixing component 11 along the Z axis direction. When the first touch sensing signal is triggered, the driving component is stopped and the actual control amount is calculated. The actual control amount can be the distance Z1, and then the second target position Z is moved to the second target position Z. 02 , further in the second calibration detection sub-process, the working component 40 is driven to move along the Z-axis direction to the position of the second fixing member 12. After the second touch sensing signal is triggered, the driving component is stopped and the movement performed in this calibration detection sub-process is calculated as the distance Z2 of the actual control amount.
[0048] In a further expanded embodiment, the control driving component in S110 moves the working component to the target position, including: based on the motion coordinate system of the motion system and the position information of the initial position in the motion coordinate system, controlling the driving component to drive the working component from the initial position to the target position with preset control amounts in each direction in the motion coordinate system.
[0049] For example, if the initial position is the origin, then Figures 1 to 5 In the illustrated embodiment, the position of the first target position in the first calibration detection subprocess in the motion coordinate system of the motion system is set to (X 01 , Y 01 , Z 01 ), thus, during the execution of S110, the working component 40 starts from the initial position and moves in the X-axis direction. 01 The preset control amount of the X axis moves the Y axis in the Y direction. 01 The Y-axis preset control amount and the Z-axis movement 01 The preset Z-axis control amount is set to reach the top of the first fixing member 11. At this time, it should be noted that in order to facilitate the detection and calibration sub-process in the Z-axis direction, the X-axis and Y-axis coordinates of the first fixing member 11 should be X 01 and Y 01 , or with X 01 and Y 01The position that the working part 40 can touch when moving in the Z-axis direction is close to the working part 40. Similarly, the second target position in the second calibration detection subprocess is set as the motion coordinate system of the motion system (X 02 , Y 02 , Z 02 ), then during the execution of S110, the working component 40 starts from the initial position and moves X in the X-axis direction. 02 The preset control amount of the X axis moves the Y axis in the Y direction. 02 The Y-axis preset control amount and the Z-axis movement 02 The Z-axis preset control amount is set to reach the top of the second fixing member 12, and in order to facilitate the calibration detection sub-process in the Z-axis direction, the X-axis and Y-axis coordinates of the second fixing member 12 should be X 02 and Y 02 , or with X 02 and Y 02 The working member 40 is close to the position that can be touched when moving in the Z-axis direction.
[0050] See also Figure 4 and Figure 5 When performing the calibration detection process in the X-axis or Y-axis direction, the corresponding actual control amount in the X-axis direction and the Y-axis direction on the first fixing member 11 can also be obtained by the above method, and the corresponding actual control amount in the X-axis direction and the Y-axis direction on the second fixing member 12 can be obtained, which will not be described in detail here.
[0051] In another further extended embodiment, controlling the working component by the driving component to move the working component along the detection direction to the target fixed component in S120 includes: controlling the driving component to move the working component along the detection direction until the sensor detects that the working component arrives at the target fixed component.
[0052] In this process, when the driving component reaches the target position in the calibration detection sub-process, such as the first target position in the first calibration detection sub-process, the driving component starts to control the control component to move the working component 40 along the detection direction of the Z-axis direction until the sensor at the working component 40 or the target fixed part detects that the working component 40 touches the target fixed part. At this time, the sensor sends a signal of arrival to the control component used to execute the calibration method, and controls the working component 40 to stop moving, and senses the actual control amount of the movement of the working component 40 through the sensing component set separately. Among them, the sensor in this embodiment can be set as a collision sensor on the working component 40. When the working component 40 touches and causes the detection component on the collision sensor to move, the collision sensor is triggered and sends a signal of arrival to the control component. The sensing component can be set inside the driving component, or a corresponding displacement sensor can be set on the moving slide rail of the working component 40 to obtain the actual control amount of the working component 40. Of course, the actual control amount of the driving component can also be obtained by detecting the number of rotation steps when the driving component is used as a motor, passing current, etc., and further converted into the actual control amount of the working component 40 for subsequent calculation. It is not specifically limited here. It should also be noted that the target fixture is the fixture touched by the working component 40 during the calibration and detection sub-process, such as the first fixture 11 corresponding to the first calibration and detection sub-process, or the second fixture 12 corresponding to the second calibration and detection sub-process.
[0053] In addition, in S120, controlling the working component to move to the target fixed component along the detection direction by the driving component and obtaining the actual control amount of the working component moving from the target position to the target fixed component includes the following steps: S121, executing the detection movement process multiple times and recording the control amount of the driving component during each detection movement process, wherein the detection movement process is to control the working component to move from the target position along the detection direction to the target fixed component by the driving component; S122, obtaining the actual control amount of the working component moving from the target position to the target fixed part according to the control amount of the driving component recorded in all the detection movement processes executed by this calibration detection sub-process.
[0054] In order to accurately obtain the actual control amount in each calibration detection sub-process and reduce the accidental errors caused by the detection method, it is necessary to execute the detection movement process multiple times and record the control amount in each detection movement process. After the data of all detected control amounts are sorted, the actual control amount of the working part 40 moving from the target position to the target fixed part is obtained.
[0055] Specifically, the detection movement process is executed multiple times in S121, and the control amount of the driving component in each detection movement process is recorded, including: S1211, during the first detection movement, recording the control amount of the working part moving from the target position to the target fixed part; S1212, before the non-first detection movement process is executed, the driving component is controlled to move the working component in the opposite direction of the detection direction according to the control amount recorded in the last detection movement process to reset; S1213, in a non-first detection movement process, controlling the driving component to move the working component to the target fixed component along the detection direction, and recording the control amount of the working component moving from the target position to the target fixed component.
[0056] by Figure 3 In the embodiment, the first calibration detection sub-process and the second calibration detection sub-process in the Z-axis direction are taken as examples. Assuming that the detection movement process of the first calibration detection sub-process and the second calibration detection sub-process are both executed 10 times, in the first calibration detection sub-process, when the working target moves to the first target position (X 01 , Y 01 , Z 01 ), the process of moving the working component 40 along the positive direction of the Z-axis to the first fixing member 11 is the first detection movement process, at which the first control amount Z of the working component 40 is obtained. 10 , and then drive the working component 40 based on the first control amount Z 10 Based on the detection direction of the Z-axis, the positive direction of the Z-axis is returned to the upper side of the first fixing member 11. Figure 1 The downward direction, the opposite direction is Figure 2 In the upward direction, after the working component 40 returns to the reset position, the working component 40 is continued to be controlled to move along the positive direction of the Z axis to the first fixing member 11, and the secondary control amount Z of the working component 40 is obtained. 11 , and the secondary control quantity Z 11 Reset, repeat this process 10 times, and obtain the control amount Z of the working part 40 for 10 times. 10 ~Z 19 Similarly, after the second calibration detection sub-process repeats the detection movement process 10 times, the control amount of the working part 40 performing the detection movement process 10 times is obtained as Z 20 ~Z 29 Therefore, in the first calibration detection sub-process and the second calibration detection sub-process, the control obtained when each detection movement process is executed may be different, and in order to improve the accuracy of mechanical control, in each detection movement process, the driving speed of the driving component can be gradually reduced to avoid the collision process between the working component 40 and the target fixed component being too strong and affecting the detection result.
[0057] Of course, the above-mentioned repeated detection movement process can also be repeated by directly combining the position of the target fixing part and the movement control amount between the target position to control the working part 40 to return to the first target position or the second target position, but its control accuracy is not as high as the detection accuracy of the aforementioned method, and it can also realize the accurate detection of the actual control amount in the present invention.
[0058] Furthermore, in S122, the actual control amount of the working component moving from the target position to the target fixed component is obtained based on the control amount of the driving component recorded in all the detection movement processes executed in this calibration detection sub-process, including: calculating the average value of the control amount of the driving component recorded in all the detection movement processes executed in this calibration detection sub-process except the maximum value and the minimum value, and the obtained average value is the actual control amount of the working component moving from the target position to the target fixed component.
[0059] This method integrates all the control quantities obtained in this calibration detection sub-process to obtain the actual control quantity. In addition to eliminating the accidental maximum and minimum values, the method of obtaining the actual control quantity by calculating the average value can better reduce the detection error and obtain a more accurate actual control quantity. For example, Z obtained in the first calibration detection sub-process above 10 ~Z 19 After removing the maximum and minimum values, the total is divided by 8 to obtain the arithmetic mean Z1, that is, the actual control quantity obtained in the first calibration sub-process is Z1. Similarly, in the second calibration detection sub-process, the obtained Z 20 ~Z 29 After the above processing, the actual control quantity after the arithmetic mean is obtained as Z2.
[0060] In addition, data sorting can be achieved by directly averaging or taking the median, mode, etc., which can also meet the calculation requirements of the actual control quantity required by the present invention.
[0061] S200, in each calibration detection process of the detected direction, obtaining the actual control amount of the working component moving to each fixed component in the detected direction.
[0062] That is, during the calibration test of S100, the control amount of the driving component used to move the working component 40 to each working piece is detected in each detection direction, so as to obtain the actual control amount. In the actual control process, the working component 40 can be first moved to the to-be-determined initial calibration position, and then the driving component drives the working component 40 to move along the specified detection direction until the working component 40 touches each fixing part and stops the driving component from continuing to drive. At this time, the sensor unit detects the actual control amount in the calibration test process.
[0063] It can be seen from the above-mentioned embodiment that after each calibration detection sub-process in each detection direction is executed, the actual control amount of each sub-process is obtained, and the actual control amount of the working part 40 moving to each fixed part in the detection direction is obtained based on the actual control amount of each sub-process.
[0064] S300, determining the actual deviation of the working component in the corresponding detection direction according to the actual control amount of the working component moving to each fixed component during the calibration detection process.
[0065] After obtaining the actual control amount of each fixture, it is necessary to merge the actual control amount of the working part 40 to each fixture during each calibration test process, so as to accurately obtain the actual deviation amount in the corresponding test direction. The actual deviation amount is obtained by the actual control amount obtained when multiple fixtures are calibrated and tested, which can take advantage of the relative position fixation of multiple fixtures and eliminate the problem of inaccurate deviation correction caused by the deviation between the position of a single fixture as a reference part and the preset position of the reference part, which makes the deviation phenomenon unable to be effectively solved.
[0066] Specifically, S300 may include the following steps: Based on the preset control amount and the actual control amount of the working part moving along the detected direction to each fixing part, each actual deviation amount of the working part moving along the detected direction to each fixing part is calculated.
[0067] Among them, since the target position as the starting point of the working part 40 is preset and fixed in each calibration detection sub-process in the detected direction, and since the position of each fixing part is also relatively fixed, the preset control amount of the working part 40 moving from the target position to the target fixing part in the first detection movement process is also fixed. Based on this, after comparing the actual control amount of each calibration detection sub-process of the working part 40 in the detected direction with the preset control amount of each corresponding calibration detection sub-process, the actual deviation amount of the working part 40 moving to each fixing part in the detection direction can be calculated, that is, the actual deviation amount of the working part 40 moving on each fixing part in the detected direction is obtained. The preset control amount can be stored in the storage of the control component that executes this method, and can also be stored in an external device, terminal or cloud, and obtained by the control component from the external device, terminal or cloud.
[0068] For example, Figure 1 In the actual deviation process of the embodiment, when the calibration detection process in the Z-axis direction is performed, if the preset control amount when the working component 40 moves from the first target position to the first fixing member 11 in the Z-axis direction is Z x1 , the preset control amount when moving from the second target position to the second fixing member 12 is Z x2According to the actual control amount Z1 of the first calibration detection subprocess and the actual control amount Z2 of the second calibration detection subprocess obtained above, the first actual deviation of the working part 40 moving from the first target position along the Z-axis direction to the first fixing part 11 is ΔZ1=(Z x1 -Z1), and the second actual deviation of the working component 40 moving from the second target position along the Z-axis direction to the second fixing member 12 is ΔZ2=(Z x2 -Z2).
[0069] S400, based on each actual deviation amount, the position deviation of the working component in the corresponding detection direction is corrected in stages.
[0070] This step is based on the actual deviation amounts obtained in S300. After obtaining the actual deviation amounts, the actual deviation of the working component 40 in the detected direction is judged, and after the situation is judged, compensation is performed in stages according to the severity of the deviation, thereby improving the precision correction effect.
[0071] In this embodiment, based on each actual deviation, the position deviation of the working component in the corresponding detection direction is corrected in stages, including: S410, judging whether the position deviation of the fixing member in the detected direction needs to be corrected according to each actual deviation amount; S420, if correction is required, determining a total actual deviation value according to each actual deviation amount; S430, based on the preset numerical range division, determining the numerical range into which the total actual deviation value falls; S440, obtaining a correction strategy for the range of values that the value falls into, and correcting the position deviation of the working component in the detected direction according to the correction strategy.
[0072] Since the motion system will have precision deviations of varying degrees during the control process, during the implementation of this embodiment of the method, when it is detected that the position deviation of the working part 40 moving to the fixed part in the corresponding detection direction is within the allowable error range, no correction is required. If it is greater than the corresponding allowable error range, the position deviation needs to be corrected to restore the precise control of the motion system.
[0073] The step of determining whether the position deviation needs to be corrected in S410 includes: S411, if the detected direction is only a single direction, a total deviation value is obtained based on each actual deviation amount, and it is determined whether the total deviation value is greater than a first threshold value. If so, correction needs to be performed; S412, if the detected direction has a positive direction and a reverse direction, determine in turn whether the deviation value of the working component 40 on each fixing part is greater than the second threshold value. If one of the deviation values is greater than the second threshold value, correction needs to be performed.
[0074] In all the detection directions, due to the movement restriction of the working component 40 in the detection direction, the working component 40 can only move in the positive direction in a certain detection direction, for example Figure 1 In the embodiment shown in , each fixing member is fixed on a fixing seat. When the detection direction is the Z-axis direction, the working component 40 can only move downward along the Z-axis direction from the top of each fixing member. Therefore, the detection direction in the Z-axis direction is a single direction. When the detection direction of the working component 40 has a positive direction and a negative direction, it means that the positions of the fixing members on both sides along the detection direction are within the movable range of the working component 40. Therefore, the working component 40 can move from the positive direction of the detection direction to the target fixing member, and move from the negative direction of the detection direction to the target fixing member. Figure 4 and Figure 5 In the X-axis direction and the Y-axis direction in the embodiment shown in the figure, the working component 40 can move to the lower position of the first fixing member 11 in the X-axis direction, and move from the lower position of the first fixing member 11 along the positive direction of the X-axis, that is, upward to the first fixing member 11. At the same time, the working component 40 can also move to the upper position of the first fixing member 11 in the X-axis direction, and move from the upper position of the first fixing member 11 along the reverse direction of the X-axis, that is, downward to the first fixing member 11. Therefore, the detection direction in the X-axis direction is a bidirectional detection direction including a positive direction and a reverse direction. Similarly, the working component 40 can also move to the two side positions of the second fixing member 12 in the Y-axis direction, and the working component 40 moves from the front and rear sides of the first fixing member 11 and the second fixing member 12 to the first fixing member 11 and the second fixing member 12 respectively in the Y-axis direction.
[0075] Among them, when there is a positive direction and a reverse direction in the detection direction, the deviation value in S412 is determined by the positive actual deviation value and the negative actual deviation value. The positive actual deviation value is the actual deviation between the working component 40 and the corresponding fixing part along the positive direction of the detection direction, and the negative actual deviation value is the actual deviation between the working component 40 and the corresponding fixing part along the reverse direction of the detection direction. That is, during the implementation of S412, the deviation used to determine whether the working component 40 needs to be corrected is obtained based on the calibration detection process of the positive direction of the detection direction and the calibration detection process of the reverse direction of the detection direction. After comprehensive calculation, it is determined whether to correct or not, thereby improving the accuracy of deviation recognition in the detection direction.
[0076] Continue with Figure 4Taking the embodiment shown in as an example, when the detected direction is the X-axis direction, the working component 40 is controlled to move to the first target position of the first fixing member 11 in the opposite direction of the X-axis direction during the calibration detection process in the X-axis direction, and the calibration detection sub-process for this process is performed from the first target position. After repeatedly performing the corresponding detection movement process multiple times, the actual deviation ΔX of the working component 40 moving from the positive direction of the X-axis to the first fixing member 11 is obtained based on the multiple actual control quantities obtained. +1 After that, the working part 40 is controlled to move to the second target position of the second fixing part 12 in the reverse direction of the X-axis direction and the positive direction of the Y-axis direction, and the actual deviation ΔX of the working part 40 moving to the second fixing part 12 is obtained through the calibration detection sub-process in this direction. +2 Similarly, in the calibration detection process in the reverse direction of the X-axis direction, the working component 40 is moved to the first target position of the first fixing component 11 in the positive direction of the X-axis direction and to the second target position of the second fixing component 12 in the positive direction of the X-axis direction, and the first calibration detection subprocess and the second calibration detection subprocess in the reverse direction of the X-axis direction are performed, so as to obtain the actual deviation ΔX of the working component 40 moving in the reverse direction of the X-axis to the first fixing component 11. -1 and the actual deviation ΔX moved to the second fixing member 12 -2 .
[0077] The actual deviation ΔX is obtained above +1 , ΔX +2 , ΔX -1 , ΔX -2 The order can be interchanged, that is, the actual deviation ΔX of the first fixing member 11 can also be obtained first. +1 , ΔX -1 , and then obtain the actual deviation ΔX of the second fixing member 12 +2 , ΔX -2 .
[0078] After obtaining the corresponding actual deviation, S420 can obtain a total actual deviation value based on the actual deviation through calculation and sorting, so that the calibration control method can determine the execution strategy according to the total actual deviation value and correct the position deviation of the working part in the detected direction.
[0079] Among them, due to the different control methods of different machines during the control process, the different numbers of directions in which the working component 40 can run, etc., the degree of influence of the deviation is also different. Therefore, the preset numerical range divided in S430 can be preset according to actual test conditions or experience, etc., and combined with the severity of the numerical range, the best correction strategy within each numerical range is judged, and the position deviation of the working component 40 in the detection direction is corrected according to the best correction strategy.
[0080] The following is a detailed Figures 1 to 5 The embodiment shown in is used to illustrate the calibration method of the embodiment of the first aspect of the present invention.
[0081] like Figure 2 As shown, when the fixing member is the first fixing member 11 and the second fixing member 12, obtaining the actual control amount of the working component moving to each fixing member in the detected direction in S200 includes: S210, if the detected direction is only a single direction, obtaining a first actual control amount of the working component moving along the detected direction to the first fixed component, and obtaining a second actual control amount of the working component moving along the detected direction to the second fixed component; S220, if the detected direction has a positive direction and a negative direction, respectively obtain a first actual control amount of the working component moving along the positive direction and the negative direction of the detected direction to the first fixed component, and respectively obtain a second actual control amount of the working component moving along the positive direction and the negative direction of the detected direction to the second fixed component.
[0082] When the detected direction is a single direction, such as the Z-axis direction, combined with the implementation method of the calibration and testing process in the aforementioned embodiment, the first actual control amount of the working part 40 moving in the detection direction to the first fixed part 11 is Z1, and the second actual control amount of moving in the detection direction to the second fixed part 12 is Z2.
[0083] When the detected direction has a positive direction and a negative direction, the first actual control amount and the second actual control amount in the positive direction of the detected direction and the first actual control amount and the second actual control amount in the negative direction of the detected direction need to be acquired. Figure 4 When the detected direction is the X axis, combined with the implementation of the calibration detection process in the above embodiment, the first actual control amount X of the working component 40 moving in the positive direction of the X axis to the first fixing member 11 is obtained. +1 and the second actual control amount X moved to the second fixing member 12 +2 , and obtain the first actual control amount X of the working component 40 moving in the opposite direction of the X axis to the first fixing member 11 -1 and the second actual control amount X moved to the second fixing member 12 -2 Similarly, see Figure 5 , when the detected direction is the Y axis, obtain the first actual control amount Y of the working component 40 moving in the positive direction of the Y axis to the first fixing member 11 +1 and the second actual control amount Y moved to the second fixing member 12 +2 , and obtain the first actual control amount Y of the working component 40 moving in the opposite direction of the Y axis to the first fixing member 11 -1and the second actual control amount Y moved to the second fixing member 12 -2 .
[0084] Furthermore, in S300, according to the actual control amount of the working component 40 moving to each fixing part during the calibration test, the actual deviation amount of the working component in the corresponding test direction is determined, including: S310, comparing the first actual control amount with a first preset control amount of the working component moving along the detection direction to the first fixing component to obtain a first actual deviation amount of the working component moving along the detection direction to the first fixing component; S320, comparing the second actual control amount with a second preset control amount of the working component moving along the detection direction to the second fixing component to obtain a second actual deviation amount of the working component moving along the detection direction to the second fixing component; S330, calculating the absolute value of the difference between the first actual deviation and the second actual deviation to obtain a total actual deviation.
[0085] Among them, when the detected direction has a positive direction and a negative direction, the first actual deviation and the second actual deviation are obtained by taking the first actual deviation and the second actual deviation obtained in the positive direction of the detected direction. Since the first actual control amount and the second actual control amount have been obtained in S200, the first actual deviation and the second actual deviation can be obtained according to the first preset control amount and the second preset control amount preset in the control component or external device, cloud and other locations, and the total actual deviation value can be obtained according to the absolute value of the difference between the two actual deviations. Since the first actual deviation is obtained according to the first calibration detection sub-process of the first fixing member 11, and the second actual deviation is obtained according to the second calibration detection sub-process of the second fixing member 12, and since the distance between the two fixing members will not change, the absolute value of the difference between the two actual deviations is taken, and the total actual deviation value occurring during the operation of the motion system can be known.
[0086] The preset numerical range division in S430 includes a first range, a second range, and a third range which are sorted from small to large and have continuous numerical values. Then, the correction strategy for obtaining the numerical range in S440, and correcting the position deviation of the working component in the detected direction according to the correction strategy, includes: S441, within the first range, correcting the position deviation of the working component according to the relative magnitude of the first actual deviation and the second actual deviation; S442, within the second range, according to the position information of the first fixing member, the position information of the second fixing member, the linear relationship between the first actual deviation and the second actual deviation, determine a deviation correction value and a correction direction, and correct the position of the working component according to the deviation correction value and the correction direction; S443: within the third range, it indicates a motion system calibration failure.
[0087] When within the first range, the position deviation of the working component 40 in the detection direction is not large, so the position of the working component 40 can be corrected directly according to the relative size of the first actual deviation and the second actual deviation, specifically including: S4411, calculating an average value of the first actual deviation and the second actual deviation to obtain a correction value; S4412, determining a compensation direction based on the relative size of the first actual deviation and the second actual deviation, so that the position deviation of the working component is corrected in the compensation direction.
[0088] Taking the detection direction as the Z-axis direction as an example, the average value of the first actual deviation ΔZ1 and the second actual deviation ΔZ2 obtained is ΔZ0, and the correction amount can be ΔZ0. When determining the compensation direction of the correction, it can be based on the following method: if the first actual deviation ΔZ1 and the second actual deviation ΔZ2 are both positive values, the driving component is controlled to compensate ΔZ0 in the positive direction along the detection direction of the Z-axis; if the first actual deviation ΔZ1 and the second actual deviation ΔZ2 are both negative values, the driving component is controlled to compensate ΔZ0 in the reverse direction along the detection direction of the Z-axis.
[0089] Taking the detection direction as the X-axis direction as an example, the first actual deviation ΔX obtained is +1 and the second actual deviation ΔX +2 The average value of is ΔX0, then the correction amount is ΔX0. When determining the compensation direction of the correction, it can be based on the following method: if the first actual deviation ΔX +1 and the second actual deviation ΔX +2 If both are positive values, the driving component controls the detection direction along the X-axis to compensate ΔX0 in the opposite direction; if the first actual deviation ΔX +1 and the second actual deviation ΔX +2 When both are negative values, the driving component controls the positive compensation ΔX0 along the detection direction of the X-axis.
[0090] When within the second range, the position deviation of the working component 40 in the detection direction is relatively large, so an additional method is required to correct and compensate the position deviation of the working component 40. In this embodiment, the deviation correction value and the correction direction are determined based on the position information of the first fixing member 11, the position information of the second fixing member 12, and the linear relationship between the first actual deviation and the second actual deviation, and the position of the working component 40 is corrected according to the deviation correction value and the correction direction, including: S4421, obtain the deviation correction value ΔN according to the following equation: ΔN=|((N02 -N2)-(N 01 -N1)) / (N2-N1)*N+(N2(N 01 -N1)-N1(N 02 -N2)) / (N2-N1)| Among them, N 01 is the first actual control variable, N1 is the first preset control variable, N 02 is the second actual control amount, N2 is the second preset control amount, and N is the coordinate value of the position of the working component 40 between the first fixing member 11 and the second fixing member 12 relative to the initial position in the detected direction; S4422, determining a correction direction based on the relative magnitudes of the first actual deviation and the second actual deviation, so that the position deviation of the working component is corrected in the correction direction, Among them, if the detected direction has a positive direction and a negative direction, the first actual control amount, the first preset control amount, the second actual control amount and the second preset control amount all take the first actual control amount, the first preset control amount, the second actual control amount and the second preset control amount in the positive direction of the detected direction.
[0091] Since there is a linear relationship between the working component 40 and the control process in its moving direction in the motion system, when there is a position deviation problem of the working component 40 in one of its moving directions, the deviation will increase as the working component 40 moves farther away from the initial position in the moving direction. Therefore, a linear relationship is used to correct and compensate the position of the working component 40.
[0092] Taking the detection direction as the Z axis as an example, the correction value ΔZ0 is ΔZ0=|((Z2-Z x2 )-(Z1-Z x1 )) / (Z x2 -Z x1 )*Z0+(Z x2 (Z1-Z x1 )-Z x1 (Z2-Z x2 )) / (Z x2 -Z x1 )| Therefore, the correction direction is determined in combination with the size of the first actual deviation ΔZ1 and the second actual deviation ΔZ2. If the first actual deviation ΔZ1 and the second actual deviation ΔZ2 are both positive values, the driving component is controlled to compensate ΔZ0 in the positive direction along the detection direction of the Z axis; if the first actual deviation ΔZ1 and the second actual deviation ΔZ2 are both negative values, the driving component is controlled to compensate ΔZ0 in the reverse direction along the detection direction of the Z axis, and the correction value in the correction direction is ΔZ0.
[0093] Taking the detection direction as the X-axis direction as an example, the correction value ΔX0 is ΔX0=|((X +2 -X +X2 )-(X +1 -X +X1 )) / (X +X2 -X +X1 )*X0+(X +X2 (X +1 -X +X1 )-X +X1 (X +2 -X +X2 )) / (X +X2 -X +X1 )| Therefore, the correction direction is determined in combination with the size of the first actual deviation ΔX1 and the second actual deviation ΔX2. If the first actual deviation ΔX1 and the second actual deviation ΔX2 are both positive values, the driving component is controlled to compensate ΔX0 in the reverse direction along the detection direction of the X-axis; if the first actual deviation ΔX1 and the second actual deviation ΔX2 are both negative values, the driving component is controlled to compensate ΔX0 in the positive direction along the detection direction of the X-axis, and the correction value in the correction direction is ΔX0.
[0094] When it is within the third range, it means that the position deviation of the working component 40 in the detection direction is too large and cannot be compensated by precision correction, indicating a motion system failure for inspection and maintenance.
[0095] In addition to the detection and correction process, this calibration method also includes a reliability calibration process performed after the detection and correction process. Figure 7 , the reliability calibration process includes: S500, sequentially executing calibration and detection processes of the working component in each direction in at least one direction; S600, in each calibration detection process of the detected direction, obtaining a test control amount of the working component moving to each fixed component in the detected direction; S700, comparing the test control amount obtained in the detected direction with the actual control amount in the detected direction during the detection and correction process, and determining whether the position deviation of the fixing member needs to be corrected in the detected direction; S800: If necessary, cancel the correction action performed in the previous detection and correction process, and execute the next detection and correction process.
[0096] The above reliability calibration process is used to verify the reliability of the correction performed in the aforementioned detection and correction process, by judging whether the corrected motion device still has a large deviation from the test control quantity. If there is a large deviation, it means that correction is still needed and the correction accuracy requirement is not met.
[0097] In S700, comparing the test control amount obtained in the detected direction with the actual control amount in the detected direction during the detection correction process, determining whether the position deviation of the fixing member needs to be corrected in the detected direction includes: Determine whether the difference between the test control amount and the actual control amount in the detected direction is within a threshold range in the detected direction, where the threshold range can be preset in the control component or stored in an external device, cloud, or other location that can be accessed by the control component; If so, no correction is necessary; If not, a correction process needs to be performed.
[0098] In addition, the reliability calibration process also includes: S900, when the detection correction process is executed more than a preset number of times, the control motion system reports an error.
[0099] In the motion system used by the calibration method of the present invention, there is an embodiment thereof, in which a driving component includes a driving motor and a robotic arm that is transmission-connected to the driving motor and driven by the driving motor, and a working component 40 is arranged on the moving end of the robotic arm. Therefore, in the calibration method, the actual control amount of the working component 40 moving to each fixed component in the detected direction is the actual control step number of the driving motor, and the actual deviation amounts between the working component 40 and each fixed component in the corresponding detection direction are the actual deviation steps of the driving motor to move the working component 40 to each fixed component along the corresponding detection direction. The correction value obtained during the correction process is converted into the correction step number of the driving motor, and the driving motor corrects the position deviation of the working component 40 based on the correction step number and the correction compensation direction.
[0100] Among them, the driving component can drive the working component 40 to move in at least two directions respectively, so that the working component 40 moves within the movable range of the three-axis space. For example, at least two directions include the XYZ three-axis directions, or include the Z-axis and the U-axis directions around the Z-axis, both of which can realize the movement of the working component 40 in the three-axis space.
[0101] Combine the following Figures 1 to 5 The detection and correction process of the calibration method of the first aspect embodiment is described in detail based on the specific implementation situation.
[0102] Z-axis direction Step S1, see Figure 3 , control the robot arm to move to the opposite direction of the Z-axis detection direction of the first fixing member 11, that is, the upper position, and obtain the first preset control amount Z according to the height value of the first fixing member 11 and the first target position x1, and controlling the robot arm to move to the opposite direction of the Z-axis detection direction of the second fixing member 12, that is, the upper position, and obtaining a second preset control amount Z according to the height value of the second fixing member 12 and the second target position x2 .
[0103] Then, the first calibration detection subprocess in the Z-axis direction is performed, and the detection movement process is repeated 10 times to obtain the control amount Z. 10 ~Z 19 , remove the maximum and minimum values of the control amount and take the average to obtain the actual control amount Z1; perform the second calibration detection sub-process in the Z-axis direction, repeat the detection movement process 10 times, and obtain the control amount Z 20 ~Z 29 , remove the maximum and minimum values of the control quantity and take the average to obtain the actual control quantity Z2.
[0104] Step S2: compare the actual control amount with the preset control amount to obtain the total actual deviation value ΔZ=|ΔZ1-ΔZ2|=|(Z1-Z x1 )-(Z2-Z x2 )|, If ΔZ ≤ h1, the deviation is acceptable and no compensation is required; If h1<ΔZ≤ h2, it falls into the first range of the Z axis direction, then the correction strategy in the first range is executed to obtain the correction value Z z ; If h2<ΔZ≤ h3, it falls into the second range of the Z axis direction, then the correction strategy in the second range is executed to obtain the correction value Z z ; If ΔZ> h3, falling into the third range of the Z-axis direction, it indicates a motion system calibration failure.
[0105] When compensation is performed, if ΔZ1>0 and ΔZ2>0, the driving component is controlled to compensate Z along the positive direction of the Z-axis detection direction. z ; If ΔZ1<0 and ΔZ2<0, the control driving component compensates Z in the opposite direction of the Z-axis detection direction z .
[0106] X-axis direction Step S1, controlling the robot arm to move to the opposite direction of the X-axis direction of the first fixing member 11, that is, the lower side position, and obtaining a first preset control amount X according to the X-axis position of the first fixing member 11 and the first target position. +x1 , and controlling the robot arm to move to the opposite direction of the X-axis direction of the second fixing member 12, that is, the lower side position, and obtaining a second preset control amount X according to the X-axis position of the second fixing member 12 and the second target position +x2 ; Subsequently, the first calibration detection subprocess in the positive direction of the X-axis direction is performed, and the detection movement process is repeated 10 times to obtain the control amount X 10 ~X 19 , remove the maximum and minimum values of the control quantity and take the average to obtain the actual control quantity X +1 ; Execute the second calibration detection subprocess in the X-axis direction, repeat the detection movement process 10 times, and obtain the control amount X 20 ~X 29 , remove the maximum and minimum values of the control quantity and take the average to obtain the actual control quantity X +2 .
[0107] The robot arm is controlled to move to the positive direction of the X-axis direction of the first fixing member 11, that is, the upper position, and a first preset control amount X is obtained according to the X-axis position of the first fixing member 11 and the first target position. -x1 , and controlling the robot arm to move to the positive direction of the X-axis direction of the second fixing member 12, that is, the upper position, and obtaining a second preset control amount X according to the height value of the second fixing member 12 and the second target position -x2 ; Subsequently, the first calibration detection subprocess in the opposite direction of the X-axis direction is performed, and the detection movement process is repeated 10 times to obtain the control amount X 30 ~X 39 , remove the maximum and minimum values of the control quantity and take the average to obtain the actual control quantity X -1 ; Execute the second calibration detection subprocess in the X-axis direction, repeat the detection movement process 10 times, and obtain the control amount X 40 ~X 49 , remove the maximum and minimum values of the control quantity and take the average to obtain the actual control quantity X -2 .
[0108] Obtain the deviation value ΔX1 of the working component 40 on the first fixing member 11 and the deviation value ΔX2 on the second fixing member 12 of the X axis. The deviation value is determined by the actual positive deviation value and the actual negative deviation value, that is, ΔX1=|(X +1 -X +x1 )-(X -1 -X -x1 )|, ΔX2=|(X +2 -X +x2 )-(X -2 -X -x2 )|, if ΔX1 and ΔX2 are both less than L1, it means that the deviation is acceptable and no compensation correction is required; If compensation correction is required, the total actual deviation value ΔX in the X-axis direction is further obtained. +2 -X +x2 )-(X+1 -X +x1 )|.
[0109] If ΔX ≤ L1, the deviation is acceptable and no compensation is required; If L1<ΔX≤ L2, it falls into the first range of the X-axis direction, then the correction strategy in the first range is executed to obtain the correction value X x ; If L2<ΔX≤ L3, it falls into the second range of the X-axis direction, then the correction strategy in the second range is executed to obtain the correction value X x ; If LX> L3, it falls into the third range of the X-axis direction, then it indicates a motion system calibration failure.
[0110] Among them, when compensation is performed, if ΔX +1 =(X +1 -X +x1 )>0 and ΔX +1 =(X +2 -X +x2 )>0, the drive component is controlled to compensate X in the opposite direction of the X axis. x ; If ΔX +1 <0 and ΔX +1 <0, the drive component is controlled to compensate X along the positive direction of the X axis. x .
[0111] In addition, the Y-axis direction also has a positive direction and a negative direction in this embodiment, so the detection and correction process of the working component 40 in the Y-axis direction is the same as the detection and correction process in the X-axis direction, which will not be repeated here.
[0112] In the second aspect, see Figure 8 The present invention further provides a calibration control device 30 for mechanical control, which is applied to a motion system and is used to implement the calibration method of the first embodiment, comprising: An execution unit 31 is used to control the driving component to drive the working component 40 to move in at least one direction; The detection unit 32 is used to detect the control amount of the driving component and to detect whether the working component 40 reaches each fixing component; The processing unit 33 is used to control the execution unit 31 to sequentially execute the calibration detection process of the working component 40 in each direction in at least one direction, and calculate each actual deviation amount between the working component 40 and each fixing part in the corresponding detection direction according to the actual control amount of the working component 40 moving to each fixing part during the calibration detection process obtained by the detection unit 32; The correction unit 34 corrects the position deviation of the working component 40 in the corresponding detection direction in stages based on each actual deviation amount and the direction of each actual deviation amount.
[0113] In a third aspect, an embodiment of the present invention further provides a computer-readable storage medium, the computer-readable storage medium comprising a stored program, wherein when the program is running, the computer-readable storage medium is controlled to execute the calibration method of the embodiment of the first aspect of the present invention in a device.
[0114] The embodiment of the present invention further provides a computer device, the computer device of the embodiment comprises: a processor, a memory, and a computer program stored in the memory and executable on the processor, the computer program when executed by the processor implements the calibration method in the embodiment, to avoid repetition, it is not described one by one here. Alternatively, the computer program when executed by the processor implements the functions of each model / unit of the control device in the embodiment, to avoid repetition, it is not described one by one here.
[0115] Computer devices include, but are not limited to, processors and memories. Those skilled in the art will appreciate that the above are merely examples of computer devices and do not constitute a limitation on computer devices. Computer devices may include more or fewer components than shown in the figure, or may combine certain components, or different components. For example, computer devices may also include input and output devices, network access devices, buses, etc.
[0116] The processor may be a central processing unit 33 (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or any conventional processor, etc.
[0117] The memory may be an internal storage unit of a computer device, such as a hard disk or memory of the computer device. The memory may also be an external storage device of the computer device, such as a plug-in hard disk, a smart media card (SMC), a secure digital (SD) card, a flash card, etc. equipped on the computer device. Furthermore, the memory may include both an internal storage unit of the computer device and an external storage device. The memory is used to store computer programs and other programs and data required by the computer device. The memory may also be used to temporarily store data that has been output or is to be output.
[0118] In the above embodiments, it can be implemented in whole or in part by software, hardware, firmware or any combination thereof. When implemented using software, it can be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer instructions. When the computer instructions are loaded and executed on a computer, the process or function described in the embodiment of the present application is generated in whole or in part. The computer can be a general-purpose computer, a special-purpose computer, a computer network, or other programmable devices. The computer instructions can be stored in a computer-readable storage medium, or transmitted from one computer-readable storage medium to another computer-readable storage medium, for example, the computer instructions can be transmitted from a website site, computer, server or data center by wired (e.g., coaxial cable, optical fiber, digital subscriber line (Digital Subscriber Line, DSL)) or wireless (e.g., infrared, wireless, microwave, etc.) mode to another website site, computer, server or data center. The computer-readable storage medium can be any available medium that a computer can access or a data storage device such as a server, data center, etc. that contains one or more available media integrated. The available medium may be a magnetic medium (eg, a floppy disk, a hard disk, a magnetic tape), an optical medium (eg, a high-density digital video disc (DVD)), or a semiconductor medium (eg, a solid state disk (SSD)).
[0119] Although some specific embodiments of the present invention have been described in detail by way of example, it will be appreciated by those skilled in the art that the above examples are for illustration only and are not intended to limit the scope of the present invention. It will be appreciated by those skilled in the art that the above embodiments may be modified without departing from the scope and spirit of the present invention. The scope of the present invention is defined by the appended claims.
[0120] Finally, it should be noted that the above description is only the best embodiment of the present invention and does not limit the present invention in any form. Any technician familiar with the art can make many possible changes and simple replacements to the technical solution of the present invention by using the above disclosed practices and technical contents without departing from the scope of the technical solution of the present invention, which all belong to the scope of protection of the technical solution of the present invention.
Claims
1. A calibration method for mechanical control, applied to a motion system, wherein the motion system comprises a working part, a driving part for driving the working part to move in at least one direction, and at least two fixing parts with different positions in each direction of the at least one direction, wherein the at least two fixing parts are both located within the movable range of the working part, It is characterized in that The calibration method includes a detection and correction process, and the detection and correction process includes: sequentially executing a calibration detection process of the working component in each direction of the at least one direction; During the calibration detection process of each detected direction, obtaining the actual control amount of the working component moving to each of the fixed components in the detected direction; Determine the actual deviation of the working component in the corresponding detection direction according to the actual control amount of the working component moving to each of the fixing parts during the calibration detection process; Based on each of the actual deviation amounts, the position deviation of the working component in the corresponding detection direction is corrected in stages.
2. The calibration method according to claim 1, characterized in that: The calibration and detection process includes executing a plurality of calibration and detection sub-processes corresponding to each of the fixtures respectively. Wherein, the calibration detection subprocess includes: Controlling the driving component to move the working component to a target position, wherein the target position is located in a direction opposite to a detected direction of a target fixing member; The driving component controls the working component to move along the detection direction to the target fixing component, and obtains the actual control amount of the working component moving from the target position to the target fixing component.
3. The calibration method according to claim 2, characterized in that: The controlling the driving component to move the working component to a target position comprises: Based on the motion coordinate system of the motion system and the position information of the initial position in the motion coordinate system, the driving component is controlled by a preset control amount in each direction in the motion coordinate system to drive the working component to move from the initial position to the target position; The step of controlling the working component to move along the detection direction to the target fixing component by the driving component comprises: The driving component is controlled to move the working component along the detected direction until the sensor detects that the working component reaches the target fixing member.
4. The calibration method according to claim 2, characterized in that: The step of controlling the working component to move along the detection direction to the target fixed component by the driving component and obtaining the actual control amount of the working component moving from the target position to the target fixed component includes: Execute the detection movement process multiple times, and record the control amount of the driving component in each detection movement process, wherein the detection movement process is to control the working component to move from the target position along the detection direction to the target fixed component by the driving component; According to the control amount of the driving component recorded in all the detection movement processes executed in this calibration detection sub-process, the actual control amount of the working component moving from the target position to the target fixed part is obtained; The multiple executions of the detection movement process and recording the control amount of the driving component during each detection movement process include: During the first detection movement, recording the control amount of the working component moving from the target position to the target firmware; Before the non-first detection movement process is executed, controlling the driving component to move the working component in the opposite direction of the detection direction according to the control amount recorded in the last detection movement process to reset the working component; and In the non-first detection movement process, controlling the driving component to move the working component along the detection direction to the target fixed component, and recording the control amount of the working component moving from the target position to the target fixed component; The step of obtaining the actual control amount of the working component moving from the target position to the target fixed component according to the control amount of the driving component recorded in all the detection movement processes executed in the current calibration detection subprocess includes: The control amount of the driving component recorded in all the detection movement processes executed in this calibration detection sub-process is calculated as the average value except the maximum value and the minimum value, and the obtained average value is the actual control amount of the working component moving from the target position to the target fixed part.
5. The calibration method according to any one of claims 1 to 4, characterized in that: Determining the actual deviation of the working component in the corresponding detection direction according to the actual control amount of the working component moving to each of the fixing parts during the calibration detection process includes: Calculating each actual deviation amount of the working component moving along the detection direction to each of the fixing components based on a preset control amount and an actual control amount of the working component moving along the detection direction to each of the fixing components; The step of correcting the position deviation of the working component in the corresponding detection direction in stages based on each of the actual deviations includes: Determining whether the position deviation of the fixing member in the detected direction needs to be corrected according to each of the actual deviations; If correction is required, determine the total actual deviation value based on each of the actual deviation amounts; Based on the preset numerical range division, determining the numerical range into which the total actual deviation value falls; A correction strategy for the numerical range that the value falls into is obtained, and the position deviation of the working component in the detected direction is corrected according to the correction strategy.
6. The calibration method according to claim 5, characterized in that: The determining whether the position deviation of the fixing member needs to be corrected according to each of the actual deviations includes: If the detected direction is only a single direction, a total deviation value is obtained based on each of the actual deviations, and it is determined whether the total deviation value is greater than a first threshold value. If so, correction needs to be performed; If the detected direction has a positive direction and a reverse direction, it is determined in turn whether the deviation value of the working component on each of the fixing components is greater than a second threshold value. If one of the deviation values is greater than the second threshold value, correction is required. Among them, the deviation value is determined by a positive actual deviation value and a negative actual deviation value. The positive actual deviation value is the actual deviation between the working component along the positive direction of the detected direction and the corresponding fixed component, and the reverse actual deviation value is the actual deviation between the working component along the reverse direction of the detected direction and the corresponding fixed component.
7. The calibration method according to claim 6, characterized in that: The at least two fixing members include a first fixing member and a second fixing member, and the obtaining of the actual control amount of the working component moving to each of the fixing members in the detected direction includes: If the detected direction is only a single direction, obtaining a first actual control amount of the working component moving along the detected direction to the first fixing component, and obtaining a second actual control amount of the working component moving along the detected direction to the second fixing component; If the detected direction has a positive direction and a negative direction, respectively obtain a first actual control amount of the working component moving along the positive direction and the negative direction of the detected direction to the first fixing component, and respectively obtain a second actual control amount of the working component moving along the positive direction and the negative direction of the detected direction to the second fixing component; Determining the actual deviation of the working component in the corresponding detection direction according to the actual control amount of the working component moving to each of the fixing parts during the calibration detection process includes: comparing the first actual control amount with a first preset control amount of the working component moving along the detection direction to the first fixing component to obtain a first actual deviation amount of the working component moving along the detection direction to the first fixing component, and Comparing the second actual control amount with a second preset control amount by which the working component moves along the detection direction to the second fixing component, so as to obtain a second actual deviation amount by which the working component moves along the detection direction to the second fixing component; Calculating an absolute value of a difference between the first actual deviation and the second actual deviation to obtain the total actual deviation; When the detected direction has a positive direction and a negative direction, the first actual deviation and the second actual deviation are the first actual deviation and the second actual deviation obtained in the positive direction of the detected direction.
8. The calibration method according to claim 7, characterized in that: The preset numerical range division includes a first range and a second range which are sorted from small to large and have continuous numerical values, and the correction strategy for obtaining the numerical range into which the position deviation of the working component is corrected according to the correction strategy, including: In the first range, the position deviation of the working component is corrected according to the relative size of the first actual deviation and the second actual deviation; Within the second range, a deviation correction value and a correction direction are determined based on the position information of the first fixing member, the position information of the second fixing member, the linearity between the first actual deviation and the second actual deviation, and the position of the working part is corrected according to the deviation correction value and the correction direction.
9. The calibration method according to claim 8, characterized in that: The correcting the position deviation of the working component according to the relative size of the first actual deviation and the second actual deviation comprises: Calculating an average value of the first actual deviation and the second actual deviation to obtain a correction value; The compensation direction is determined based on the relative size of the first actual deviation and the second actual deviation, so that the position deviation is corrected in the compensation direction.
10. The calibration method according to claim 8, characterized in that: The method of determining a deviation correction value and a correction direction according to the position information of the first fixing member, the position information of the second fixing member, the linearity between the first actual deviation and the second actual deviation, and correcting the position of the working component according to the deviation correction value and the correction direction comprises: The deviation correction value ΔN is obtained according to the following equation: ΔN=|((N 02 -N2)-(N 01 -N1)) / (N2-N1)*N+(N2(N 01 -N1)-N1(N 02 -N2)) / (N2-N1)| Among them, N 01 is the first actual control variable, N1 is the first preset control variable, N 02 is a second actual control amount, N2 is a second preset control amount, and N is a coordinate value of the position of the working component between the first fixing member and the second fixing member relative to the initial position in the detected direction; Determine the correction direction based on the relative size of the first actual deviation and the second actual deviation, so that the position deviation of the working component is corrected in the correction direction. Among them, if the detected direction has a positive direction and a negative direction, the first actual control amount, the first preset control amount, the second actual control amount and the second preset control amount all take the first actual control amount, the first preset control amount, the second actual control amount and the second preset control amount in the positive direction of the detected direction.
11. The calibration method according to any one of claims 1 to 10, characterized in that: The calibration method further includes a reliability calibration process performed after the detection correction process, and the reliability calibration process includes: sequentially executing a calibration detection process of the working component in each direction of the at least one direction; During the calibration test process in each detected direction, a test control amount of the working component moving to each of the fixed components in the detected direction is obtained; Comparing the test control amount obtained in the detected direction with the actual control amount in the detected direction during the detection and correction process, to determine whether the position deviation of the fixing member needs to be corrected in the detected direction; If necessary, cancel the correction action performed in the previous detection and correction process, and perform the next detection and correction process; The comparing the test control amount obtained in the detected direction with the actual control amount in the detected direction during the detection and correction process to determine whether the position deviation of the fixing part needs to be corrected in the detected direction includes: Determine whether the difference between the test control amount and the actual control amount in the detected direction is within a threshold range in the detected direction; If so, no correction is necessary; If not, a correction process needs to be performed; The reliability calibration process also includes: When the detection and correction process is executed more than a preset number of times, the motion system is controlled to report an error.
12. The calibration method according to any one of claims 1 to 10, characterized in that: The driving component includes a driving motor and a mechanical arm that is transmission-connected to the driving motor and driven by the driving motor, and the working component is arranged on the moving end of the mechanical arm. The actual control amount of the working component moving to each of the fixed components in the detected direction is the actual control step number of the driving motor, and the actual deviation amount between the working component and each of the fixed components in the corresponding detection direction is the actual deviation step number of the driving motor that enables the working component to move to each of the fixed components along the corresponding detection direction; The driving component can drive the working component to move in at least two directions, so that the working component moves within the movable range of the three-axis space. Wherein, the positions of the fixing members in any of the at least two directions are different.
13. The calibration method according to claim 12, characterized in that: The at least two directions include an X-axis direction, a Y-axis direction and a Z-axis direction that are perpendicular to each other, and the fixing members have different heights in the Z-axis direction and different positions in the X-axis direction and the Y-axis direction. Among them, the calibration detection process in each direction performed during the detection correction process includes the following detection directions: the positive direction of the X-axis direction, the negative direction of the X-axis direction, the positive direction of the Y-axis direction, the negative direction of the Y-axis direction, and the negative direction of the Z-axis direction.
14. A calibration control device for mechanical control, applied to a motion system, the motion system comprising a working part, a driving part for driving the working part to move in at least one direction, and at least two fixing parts with different positions in each direction of the at least one direction, wherein the at least two fixing parts are both located within the movable range of the working part, It is characterized in that The calibration control device comprises: An execution unit, used for controlling the driving component to drive the working component to move in each direction of the at least one direction; A detection unit, used for detecting the control amount of the driving component and detecting whether the working component reaches each of the fixing parts; a processing unit, configured to control the execution unit to sequentially execute the calibration detection process of the working component in each direction of the at least one direction, and calculate each actual deviation amount between the working component and each fixed component in the corresponding detection direction according to the actual control amount of the working component moving to each fixed component during the calibration detection process acquired by the detection unit; The correction unit corrects the position deviation of the working component in the corresponding detection direction in stages based on the actual deviation amounts and the directions of the actual deviation amounts.
15. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a program, and when the program is executed, the device controls the computer-readable storage medium to execute the calibration method according to any one of claims 1 to 13.
