Equipment motion trajectory correction method, control device and storage medium
The equipment motion trajectory correction method, which uses data acquisition and intelligent control, solves the problems of reduced production capacity and instability caused by manual correction in existing technologies. It achieves efficient automatic correction without downtime, thereby improving production efficiency and product quality.
Patent Information
- Application Number
- CN202111620189.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-12-27
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2041-12-27
AI Technical Summary
In existing technologies, equipment motion trajectory correction requires machine shutdown for manual compensation, which leads to reduced production capacity, inaccurate correction, time and labor costs, and affects production stability and product yield.
By using data acquisition, diagnosis, virtual correction, and intelligent control methods, compensation values are automatically calculated and the equipment's movement trajectory is corrected in real time, reducing manual intervention.
It achieves intelligent deviation correction without stopping the machine, improving production efficiency and product yield, reducing labor costs, and maintaining the stability of the equipment's movement trajectory.
Smart Images

Figure CN114378816B_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present disclosure relate to the fields of computer technology, control technology, algorithm technology, and communication and network technology, and more specifically, to a method for correcting the motion trajectory of equipment, a control device, and a storage medium. Background Art
[0002] In the prior art, the movement trajectory of the equipment is manually corrected and compensated, that is, the equipment's running trajectory data is exported, manually analyzed on a computer, the trajectory deviation is manually calculated, and then the deviation compensation value is set on the equipment. The following problems exist in the prior art: 1. Each time the equipment is manually corrected and compensated, the equipment needs to be shut down and production stopped, affecting production capacity; 2. Manual correction compensation often cannot accurately calculate the trend of the equipment's running trajectory, resulting in frequent corrections and equipment running trajectory jumps, affecting equipment stability; 3. Manual correction is time-consuming and labor-intensive, and often requires manual labor to spend a long time analyzing the equipment's running trend, calculating the correction compensation value, and then configuring the equipment. Long-term analysis leads to long-term skewed operation of the equipment, affecting the improvement of product yield.
[0003] Due to the long-term mechanical movement of the equipment, mechanical wear, untimely maintenance, unstable electrical signals, unstable air pressure, etc., the equipment's running trajectory will have slight deviations. These slight deviations will become larger and larger due to the inertia generated by the cooperation between the mechanical structural parts, and they need to be manually adjusted to return to the normal motion trajectory in time. This situation occurs less frequently when the equipment is relatively new, and manual correction and compensation can also make the equipment return to the normal motion trajectory, and the production quality is also relatively guaranteed. As the equipment ages, the equipment's motion trajectory also deviates frequently. At this time, manual correction seems to be unresponsive and unstable, making it difficult to maintain the previous production quality level. Summary of the invention
[0004] An object of the present disclosure is to provide a new technical solution for correcting the motion trajectory of equipment.
[0005] According to a first aspect of an embodiment of the present disclosure, a method for correcting a motion trajectory of equipment is provided, comprising:
[0006] Data collection step, collecting equipment motion trajectory data;
[0007] a diagnosis step of determining whether the collected equipment motion trajectory data is within a preset compliance range, and recording the number of motion trajectory data within the compliance range as a first number;
[0008] A first calculation step, when it is determined in the diagnosis step that the equipment motion trajectory data is outside the compliance range, calculating compensation value candidates;
[0009] A first virtual correction step, compensating all the collected motion trajectory data with the compensation value candidate to obtain virtual correction trajectory data, determining whether each of the virtual correction trajectory data is within the preset compliance range, and recording the number of virtual correction trajectory data within the compliance range as a second number;
[0010] A first comparison step, comparing whether the second number is greater than the first number;
[0011] The first control step is to set the compensation value candidate as the compensation value to perform deviation correction compensation on the equipment when the second number is greater than the first number.
[0012] Optionally, when the second number is not greater than the first number, the first control step is not performed.
[0013] Optionally, when the first control step is not performed, the method further comprises:
[0014] A second calculation step, when it is determined in the diagnosis step that the equipment motion trajectory data is outside the compliance range, calculating compensation value candidates for all previous motion trajectory data outside the compliance range to obtain a set of compensation value candidates;
[0015] A second virtual deviation correction step, using each compensation value candidate item in the set of compensation value candidate items to compensate all motion trajectory data to obtain a second number of sets;
[0016] a second comparison step, selecting a maximum value from the set of the second quantities, and comparing the maximum value with the first quantity;
[0017] The second control step is to set the compensation value candidate corresponding to the maximum value as the compensation value to perform correction compensation on the equipment when the maximum value is greater than the first number, and not perform correction compensation when the maximum value is not greater than the first number.
[0018] Optionally, after each deviation correction and compensation, the collected equipment motion trajectory data is cleared.
[0019] Optionally, the collected equipment motion trajectory data is the end point position coordinates of the equipment motion at the time of collection.
[0020] Optionally, the compensation value candidate is a vertical distance from an end point position of the equipment movement outside the compliance range to a boundary of the compliance range.
[0021] Optionally, a warning range is set, the warning range is within the compliance range, and the diagnosis step further includes a warning diagnosis step, in which it is determined whether the collected equipment motion trajectory data is within the set warning range, and the number of motion trajectory data within the warning range is recorded as a third number;
[0022] When it is determined in the early warning diagnosis step that the equipment motion trajectory data is within the compliance range and outside the early warning range, the following steps are performed:
[0023] The first warning calculation step is to calculate the candidate items of warning compensation value;
[0024] A first early warning virtual deviation correction step, compensating all motion trajectory data collected within the compliance range with the early warning compensation value candidate, obtaining early warning virtual deviation correction trajectory data, determining whether each early warning virtual deviation correction trajectory data is within the early warning range, and recording the number of early warning virtual deviation correction trajectory data within the early warning range as a fourth number;
[0025] A first early warning comparison step, comparing whether the fourth quantity is greater than the third quantity;
[0026] The first warning control step sets the warning compensation value candidate as the compensation value to perform correction compensation on the equipment when the fourth number is greater than the third number, and does not perform correction compensation when the fourth number is not greater than the third number.
[0027] Optionally, when the fourth number is not greater than the third number and no correction compensation is performed, the method further includes:
[0028] A second early warning calculation step, when it is determined in the early warning diagnosis step that the equipment motion trajectory data is within the compliance range and outside the early warning range, calculating early warning compensation value candidates for all previous motion trajectory data within the compliance range and outside the early warning range to obtain a set of early warning compensation value candidates;
[0029] A second early warning virtual deviation correction step, using each early warning compensation value candidate item in the set of early warning compensation value candidate items to compensate all motion trajectory data within the compliance range, to obtain a set of fourth quantities;
[0030] a second early warning comparison step, selecting a maximum value from the set of the fourth quantities, and comparing the maximum value with the third quantity;
[0031] The second early warning control step is to set the early warning compensation value candidate corresponding to the maximum value as the compensation value to perform correction compensation on the equipment when the maximum value is greater than the third number, and not perform correction compensation when the maximum value is not greater than the third number.
[0032] According to a second aspect of the present disclosure, there is provided a control device for equipment, comprising:
[0033] Data acquisition module, used to collect equipment motion trajectory data;
[0034] a diagnosis module, configured to determine whether the collected equipment motion trajectory data is within a preset compliance range, and record the number of motion trajectory data within the compliance range as a first number;
[0035] a calculation module, which calculates compensation value candidates when the diagnosis module determines that the equipment motion trajectory data is outside the compliance range;
[0036] a virtual correction module, configured to compensate all collected motion trajectory data using the compensation value candidate, obtain virtual correction trajectory data, determine whether each virtual correction trajectory data is within the preset compliance range, and record the number of virtual correction trajectory data within the compliance range as a second number;
[0037] A comparison module, configured to compare whether the second number is greater than the first number;
[0038] A control module is used to set the compensation value candidate as the compensation value to perform deviation correction compensation on the equipment when the second number is greater than the first number.
[0039] According to a third aspect of the present disclosure, a readable storage medium is provided, on which a computer program is stored. When the computer program is executed by a processor, the method described in the first aspect above is implemented.
[0040] The beneficial effects of the embodiments of the present disclosure are: 1. Reducing the cost of manual correction: The correction method disclosed in the present disclosure can make intelligent predictions, intelligent diagnosis, intelligent decisions, and intelligent controls according to the movement trajectory of the equipment. The entire process does not require human participation. 2. Improving production efficiency: The entire process of the correction method disclosed in the present disclosure can be completed in real time without stopping the machine or production, thereby improving production efficiency. 3. Improving product yield. The correction method disclosed in the present disclosure performs correction compensation in real time according to the movement trajectory of the equipment, so that the movement trajectory of the equipment is always in a relatively stable state, thereby reducing the occurrence of defective products.
[0041] Other features and advantages of the present specification will become apparent from the following detailed description of exemplary embodiments of the present specification with reference to the accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] The accompanying drawings, which are incorporated in and constitute a part of the specification, illustrate embodiments of the present disclosure and, together with the description, serve to explain the principles of the present disclosure.
[0043] Figure 1 It is a schematic diagram of the structure of a control device that can be used to implement an embodiment of the present disclosure.
[0044] Figure 2 A schematic diagram of the equipment motion trajectory correction method disclosed in the present invention is shown.
[0045] Figure 3 A flow chart of the deviation correction method according to the first embodiment of the present disclosure is shown.
[0046] Figure 4 The figure shows the supplementary steps of the deviation correction method according to the first embodiment when the motion trajectory of the equipment is outside the compliance range and no deviation correction is performed.
[0047] Figure 5 A diagram of the equipment motion trajectory area of the first embodiment of the present disclosure is shown.
[0048] Figure 6 A flow chart of the deviation correction method of the second embodiment of the present disclosure is shown.
[0049] Figure 7 It shows the supplementary steps of the deviation correction method according to the second embodiment when the movement trajectory of the equipment is outside the warning range and the deviation correction is not performed.
[0050] Figure 8 A diagram showing the equipment motion trajectory area of the second embodiment of the present disclosure is shown.
[0051] Fig. 9 The figure shows the correction effect of the second embodiment of the present disclosure.
[0052] Fig.10 is a block diagram of functional modules of a control device according to one embodiment. DETAILED DESCRIPTION
[0053] Various exemplary embodiments of the present disclosure will now be described in detail with reference to the accompanying drawings. It should be noted that the relative arrangement of components and steps, numerical expressions and numerical values set forth in these embodiments do not limit the scope of the present disclosure unless otherwise specifically stated.
[0054] The following description of at least one exemplary embodiment is merely illustrative in nature and is in no way intended to limit the present disclosure, its application, or uses.
[0055] Technologies, methods, and equipment known to ordinary technicians in the relevant art may not be discussed in detail, but where appropriate, the technologies, methods, and equipment should be considered as part of the specification.
[0056] In all examples shown and discussed herein, any specific values should be interpreted as merely exemplary and not limiting. Therefore, other examples of the exemplary embodiments may have different values.
[0057] It should be noted that like reference numerals and letters refer to similar items in the following figures, and therefore, once an item is defined in one figure, it need not be further discussed in subsequent figures.
[0058] <Hardware Configuration>
[0059] Figure 1 It is a schematic diagram of the structure of a control device that can be used to implement an embodiment of the present disclosure.
[0060] The control device 1000 can be a smart phone, a portable computer, a desktop computer, a tablet computer, a head-mounted device, etc., which is not limited here.
[0061] The control device 1000 may include, but is not limited to, a processor 1100, a memory 1200, an interface unit 1300, a communication unit 1400, a display unit 1500, an input unit 1600, a speaker 1700, a microphone 1800, and the like. Among them, the processor 1100 may be a central processing unit CPU, a graphics processing unit GPU, a microprocessor MCU, and the like, and is used to execute a computer program, and the computer program may be written in an instruction set of an architecture such as x86, Arm, RISC, MIPS, SSE, etc. The memory 1200 may include, for example, a ROM (read-only memory), a RAM (random access memory), a non-volatile memory such as a hard disk, and the like. The interface unit 1300 may include, for example, a USB interface, a serial interface, a parallel interface, and the like. The communication unit 1400 may, for example, be capable of wired communication using an optical fiber or a cable, or wireless communication, and may specifically include WiFi communication, Bluetooth communication, 2G / 3G / 4G / 5G communication, and the like. The display unit 1500 may be, for example, a liquid crystal display screen, a touch display screen, and the like. The input unit 1600 may, for example, include a touch screen, a keyboard, a somatosensory input, and the like. The speaker 1700 is used to output audio signals. The microphone 1800 is used to collect audio signals.
[0062] As used in the embodiments of the present disclosure, the memory 1200 of the control device 1000 is used to store a computer program, which is used to control the processor 1100 to operate to implement the method according to the embodiments of the present disclosure. A technician can design the computer program according to the scheme disclosed in the present disclosure. How the computer program controls the processor to operate is well known in the art, so it will not be described in detail here. The control device 1000 can be installed with an intelligent operating system (such as Windows, Linux, Android, IOS, etc.) and application software.
[0063] It should be understood by those skilled in the art that although Figure 1 , multiple units of the control device 1000 are shown, but the control device 1000 of the embodiment of the present disclosure may only involve some of the units, for example, only the processor 1100 and the memory 1200, etc.
[0064] Hereinafter, various embodiments and examples according to the present invention are described with reference to the accompanying drawings.
[0065] Figure 2 The schematic diagram of the method for correcting the motion trajectory of the equipment disclosed in the present invention is shown. Figure 1 The control device of the hardware configuration shown is implemented. The equipment described in the present disclosure includes but is not limited to all equipment controlled by electric cylinders or pneumatic cylinders. In the embodiments of the present disclosure, a manipulator for clamping a workpiece is used as an example for explanation.
[0066] When using a robot to clamp a workpiece, it is expected that the robot will stop after moving to the target position to perform subsequent operations on the workpiece. Ideally, the stop position (end position) of the robot is the target position. However, in actual situations, there is a certain deviation between the end position and the target position. When the deviation exceeds a reasonable range, it will cause problems in the processing of the workpiece and produce defective products. Therefore, it is necessary to correct the motion trajectory of the robot. Figure 2 The deviation correction principle of the present disclosure is summarized. In the following, the end point coordinates of the manipulator are a specific example of equipment motion trajectory data.
[0067] like Figure 2 As shown, the correction principle according to this embodiment includes steps S201 to S206.
[0068] First, the end point coordinates of the manipulator are collected (S201). Then, in S202, it is diagnosed whether the collected end point coordinates are within a preset compliance range, and the number of end point coordinates within the compliance range is recorded as a first number. The compliance range is a range pre-set according to the needs of actual production. The end point coordinates within the compliance range are compliant coordinates, and no correction operation is required. If they are compliant coordinates, the end point coordinates of the manipulator continue to be collected.
[0069] When it is determined in S202 that the end point coordinates are outside the compliance range, that is, non-compliant coordinates appear, the process proceeds to step S203, in which a compensation value candidate is calculated, that is, the vertical distance (exceeding distance) from the non-compliant coordinates to the boundary of the compliance range.
[0070] Then, in S204, all the acquired end point coordinates are virtually corrected using the compensation value candidate calculated in S203, that is, all the end point coordinates are translated by the over-limit distance, and then the number of coordinates that fall within the compliance range after translation is recorded as the second number.
[0071] Next, in S205, it is compared whether the second number is greater than the first number, that is, whether the number of compliant coordinates after translation is greater than the number of compliant coordinates before translation. In this way, it is judged whether the compensation value candidate is a reasonable correction compensation value. If a large number of compliant coordinates are out of the compliance range after virtual correction, it means that the compensation value candidate is unreasonable and is not suitable for correction operation.
[0072] If the second number is greater than the first number, it means that the number of compliant coordinates after translation is greater than the number before translation, then it is reasonable and effective to perform correction compensation on the manipulator, and then enter step S206, in which the compensation value candidate is set as the compensation value to perform correction compensation on the equipment.
[0073] <Method Example 1>
[0074] In the above reference Figure 2 The deviation correction principle of the present invention has been explained. The following is a detailed description of each step of the present invention using a robot as an example. Figure 3 A flow chart of the deviation correction method according to the first embodiment of the present disclosure is shown.
[0075] In S301, the compliance range of the end position of the manipulator is set. First, a coordinate system is established with the target position as the origin. When the manipulator moves linearly in only one direction (X direction), the deviation between the end position and the target position has only one dimension. The compliance range is, for example, the interval on the X axis represented by [x2, x1]. When the end coordinate x satisfies x2≤x≤x1, the end point is within the compliance range (not shown).
[0076] When the robot moves in a straight line in the front-to-back direction (X direction) and the left-to-right direction (Y direction) successively, or when it moves in a curve, deviations may occur in both the X direction and the Y direction. In this case, an XY coordinate system is established with the target position as the origin, and the compliance range is the area enclosed by the boundary T in the coordinate system (such as Figure 5 After setting the compliance range, proceed to step S302.
[0077] In S302, the end position coordinates of the manipulator are collected. Then, in S303, it is confirmed whether the collected coordinates are within the compliance range set in step S301. If the end coordinates of the manipulator are within the compliance range, they are compliant coordinates. If they are outside the compliance range, they are non-compliant coordinates. If it is confirmed in S303 that the collected coordinates are compliant coordinates, step S304 is entered.
[0078] In S304 , the number of compliant coordinates is recorded as the first number, and then the process returns to S302 to continue the coordinate collection step and the diagnosis step of S303 .
[0079] If it is confirmed in S303 that the collected coordinates are non-compliant coordinates, proceed to step S305. In S305, calculate the compensation value candidate. The compensation value candidate is the vertical distance from the non-compliant coordinate to the compliant range boundary T. For example, in the one-dimensional case, the end point coordinates satisfying x2≤x≤x1 are compliant coordinates. When x>x1, the compensation value candidate is "x-x1" (not shown). In the two-dimensional case, the end point coordinates (x, y) are compliant coordinates when they satisfy x2≤x≤x1 and y2≤y≤y1. Figure 5 The non-compliant coordinates shown include three situations: X-axis out of limit, Y-axis out of limit, and both X and Y axes out of limit. There are also three corresponding situations for the subsequent compensation values. When the end position is A1 (X-axis out of limit), the compensation value candidate is "x-x1"; when the end position is A2 (Y-axis out of limit), the compensation value candidate is "y2-y"; when the end position is A3 (both X and Y axes out of limit), the compensation value candidate includes the X-axis component "x-x1" and the Y-axis component "y-y2". After calculating the compensation value candidates in S305, proceed to step S306.
[0080] In S306, all the collected endpoint coordinates are virtually corrected using the compensation value candidate calculated in S305. The specific method is to make all points translate in the same direction by the same distance, where the same direction is the opposite direction of the overrun direction, and the same distance is the compensation value candidate. Figure 5 If the end point coordinate is point A1 and its overrun direction is the positive direction of the X axis, then when performing virtual correction, the translation direction of all points is toward the negative direction of the X axis. If the end point coordinate is point A3, when performing virtual correction, all points must be translated toward the negative direction of the X axis by the X axis component "x-x1" and toward the positive direction of the Y axis by the Y axis component "y-y2".
[0081] After translating all the collected endpoint coordinates in the above manner, in S307, it is determined whether each translated endpoint coordinate is within the compliance range, and the number of translated endpoint coordinates within the compliance range is recorded as the second number. Then, the process proceeds to step S308.
[0082] In S308, it is determined whether the second number is greater than the first number. If the second number is greater than the first number, it means that there are more compliant coordinates after virtual correction, and it is effective and reasonable to perform correction. Therefore, in S309, the compensation value candidate is used as the compensation value for correction compensation. After correction is performed in S309, in S310, the collected end point coordinates are cleared. That is to say, after each correction, the data is cleared, and step S302 and subsequent steps are looped.
[0083] If the result of judgment in S308 is that the second number is not greater than the first number, it means that the non-compliant coordinates cannot effectively reflect the skew trend, and it is not reasonable to perform correction compensation with the compensation value candidate. Therefore, no correction is performed, but the process returns to S302 to continue coordinate collection.
[0084] As can be seen from the previous description, there are cases where non-compliant coordinates appear but correction compensation is not performed. In this case, no data is cleared, and the process returns to S302 to continue with coordinate collection and subsequent steps in step S302. Since non-compliant coordinates appeared before but correction compensation was not performed, in S305, the compensation value candidate is no longer one item but a collection of compensation value candidates for all non-compliant coordinates from the current moment to the last correction moment. Therefore, it is necessary to replace steps S305 to S308 with steps S405 to S408. Figure 4 The following is a supplementary step of the deviation correction method according to the first embodiment when the equipment motion trajectory is outside the compliance range and the deviation correction is not performed.
[0085] If it is determined in S303 that the end point coordinates are not within the compliance range, and there are previously non-compliant coordinates without performing correction compensation, the process proceeds to step S405. In S405, a set D of compensation value candidates is calculated for all previously non-compliant coordinates. i (i=1, 2...N). Since the coordinate data is cleared after the correction compensation, the previously non-compliant coordinates mentioned here refer to all non-compliant coordinates in the time period from the current moment to the last correction execution moment. Then, the process proceeds to step S406.
[0086] In step S406, using set D i For each value in (i=1, 2...N), all coordinates in the time period from the current moment to the last correction time are virtually corrected according to the method described in S306. i After performing virtual correction on each value in , the number of compliant coordinates (second number) is calculated, so a set of the second number is generated in step S407. Then, step S407' is entered.
[0087] In S407', the maximum value in the set of the second quantity is selected. Then in S408, the selected maximum value is compared with the first quantity. If the maximum value is greater than the first quantity, it means that the virtual correction is effective and reasonable, and then enter step S309, and the correction value candidate corresponding to the maximum value is used as the correction compensation value to perform correction. If the maximum value is not greater than the first quantity, the step returns to S302 to continue coordinate collection.
[0088] According to the method described in the first embodiment, calculation and deviation correction compensation can be performed in real time during the operation of the equipment, so that the movement trajectory of the equipment is always in a relatively stable state, thereby reducing the occurrence of defective products.
[0089] <Method Example 2>
[0090] In the first embodiment, the compliance range is the threshold of the manipulator end coordinates. A warning range can also be set within the compliance range. Once the end coordinates exceed the warning range, a warning virtual deviation correction process is performed to obtain a better deviation correction control effect. Figure 8 FIG. 2 shows a diagram of the equipment movement trajectory area of the second embodiment of the present disclosure. Figure 8 As shown, the area enclosed by the warning boundary P is the warning area, and the warning area is within the compliance range.
[0091] Figure 6 The flowchart of the deviation correction method of the second embodiment of the present disclosure is shown. The following is still a detailed description using the robot as an example. The same steps as those in the first embodiment are represented by the same reference numerals, and their detailed description is omitted.
[0092] In step S601, the compliance range and the warning range are set. The compliance range covers the warning range. Figure 8 In the example, the center of gravity of the warning range and the compliance range coincide, but the present embodiment is not limited thereto, as long as the warning range is within the compliance range. Then, the coordinate collection step in step S302 and the diagnosis step in S303 are performed. If it is determined in S303 that the collected endpoint coordinates are outside the compliance range, the process proceeds to step S305. Steps S305-S310 are the same as those in the first embodiment and are not described in detail.
[0093] If it is determined in S303 that the acquired endpoint coordinates are within the compliance range, the process proceeds to step S604. In S604, it is determined whether the acquired endpoint coordinates are within the warning range. If they are within the warning range, the process proceeds to step S605, in which the number of endpoint coordinates within the warning range is recorded as the third number, and then the process proceeds to step S302 to continue coordinate acquisition.
[0094] If it is determined in S604 that the collected endpoint coordinates are outside the warning range, proceed to step S606. In the present disclosure, coordinates within the compliance range and outside the warning range are referred to as "over-warning coordinates." In S606, candidates for warning compensation values are calculated based on the over-warning coordinates. Similar to the calculation method of the compensation value candidates in Example 1, the candidates for warning compensation values are the distance from the over-warning coordinates to the boundary P of the warning range. Then, proceed to step S607.
[0095] In S607, a warning virtual correction is performed according to the warning compensation value candidate calculated in step S606. In the two-dimensional coordinate system, similar to the over-limit coordinates, there are three situations for the over-warning coordinates: over-warning in the X-axis, over-warning in the Y-axis, and over-warning in both the X and Y axes. The processing method is the same as that for the over-limit coordinates, and will not be repeated here. The method of warning virtual correction is similar to that in step S306, so that all the end point coordinates within the compliance range are translated in the same direction by the same distance. The same direction is the opposite direction of the over-warning direction. For example, if the end point coordinate exceeds the warning range in the positive direction of the X-axis, the over-warning direction is the positive direction of the X-axis, and the translation direction is toward the negative direction of the X-axis. The same distance of translation is a candidate for the warning compensation value.
[0096] After translating all coordinates within the compliance range in the above manner, in S608, it is determined whether each translated end point coordinate is within the warning range, and the number of translated end point coordinates within the warning range is recorded as the fourth number. Then, the process proceeds to step S609.
[0097] In S609, it is determined whether the fourth number is greater than the third number. If the fourth number is greater than the third number, the process proceeds to step S309. After the correction is performed in S309, the acquired end point coordinates are cleared in S310. That is, after each correction, step S302 and subsequent steps are performed cyclically.
[0098] If the result of determination in S609 is that the fourth number is not greater than the third number, the process returns to S302 to continue coordinate collection.
[0099] As can be seen from the previous description, there is a situation where the over-warning coordinates appear but the correction compensation is not performed. In this case, no data is cleared, and the process returns to S302 to continue the coordinate collection and subsequent steps in step S302. Since the over-warning coordinates appeared before but the correction compensation was not performed, in S606, the candidate for the warning compensation value is no longer one item but becomes a collection of the candidate for the warning compensation value of all over-warning coordinates from the current moment to the last correction moment. Therefore, it is necessary to replace the steps of steps S606 to S609 with the steps of S706 to S709. Figure 7The supplementary steps of the deviation correction method according to the second embodiment are shown when the equipment motion trajectory is within the compliance range and outside the warning range but no deviation correction is performed.
[0100] If it is determined in S604 that the end point coordinates are not within the warning range, and there are previously over-warning coordinates without performing correction compensation, the process proceeds to step S706. In S706, a set D' of compensation value candidates is calculated for all previously over-warning coordinates. i (i=1, 2...N). Since the coordinate data is cleared after the deviation correction compensation, the previously exceeded warning coordinates mentioned here refer to all exceeded warning coordinates in the time period from the current moment to the last deviation correction execution moment. Then, the process proceeds to step S707.
[0101] In step S707, use the set D' i For each value in (i=1, 2...N), all coordinates within the compliance range from the current moment to the last correction time are subjected to early warning virtual correction according to the method described in S607. i After performing virtual correction on each value in , the number of coordinates within the warning range (the fourth number) is calculated, so a set of the fourth number is generated in step S708. Then, the process proceeds to step S708'.
[0102] In S708', the maximum value in the set of the fourth quantity is selected. Then in S709, the selected maximum value is compared with the third quantity. If the maximum value is greater than the third quantity, the process proceeds to step S309, and the warning correction value candidate corresponding to the maximum value is used as the correction compensation value to perform correction. If the maximum value is not greater than the third quantity, the process returns to S302 to continue coordinate collection.
[0103] Fig. 9 The figure shows the correction effect of the second embodiment of the present disclosure. Since the warning value is set within the threshold value in the second embodiment, the deflection trend can be discovered earlier and the correction compensation can be carried out in time. Fig. 9 It can be seen that by applying the correction method of the second embodiment of the present disclosure, a very good correction effect can be obtained.
[0104] Fig.10 is a block diagram of functional modules of a control device according to one embodiment.
[0105] <Device Example>
[0106] Fig.10 is a schematic diagram of functional modules of a control device 1000 according to an embodiment of the present disclosure.
[0107] like Fig.10As shown, the control device 1000 includes a data acquisition module, a diagnosis module, a calculation module, a virtual correction module, a comparison module and a control module.
[0108] The data acquisition module is used to collect equipment motion trajectory data. The diagnosis module is used to determine whether the collected equipment motion trajectory data is within the preset compliance range, and record the number of motion trajectory data within the compliance range as the first number. The calculation module is used to calculate the compensation value candidate when the diagnosis module determines that the equipment motion trajectory data is outside the compliance range. The virtual correction module is used to compensate all the collected motion trajectory data with the compensation value candidate to obtain virtual correction trajectory data, determine whether each of the virtual correction trajectory data is within the preset compliance range, and record the number of virtual correction trajectory data within the compliance range as the second number. The comparison module is used to compare whether the second number is greater than the first number. The control module is used to set the compensation value candidate as the compensation value to perform correction compensation on the equipment when the second number is greater than the first number.
[0109] Those skilled in the art will appreciate that the control device 1000 can be implemented in various ways. For example, the control device 1000 can be implemented by configuring a processor with instructions. For example, instructions can be stored in a ROM, and when the device is started, the instructions are read from the ROM into a programmable device to implement the control device 1000. For example, the control device 1000 can be solidified into a dedicated device (such as an ASIC). The control device 1000 can be divided into independent units, or they can be combined together for implementation. The control device 1000 can be implemented by one of the various implementations described above, or can be implemented by a combination of two or more of the various implementations described above.
[0110] In this embodiment, the control device 1000 can have multiple implementation forms. For example, the control device 1000 can be a functional module running in any software product or application that provides control services, or it can be a peripheral embedded component, plug-in, patch, etc. of these software products or applications, or it can also be these software products or applications themselves.
[0111] <Computer Readable Storage Medium Embodiment>
[0112] This embodiment provides a computer-readable storage medium, in which executable commands are stored. When the executable commands are executed by a processor, the method described in any method embodiment of this specification is executed.
[0113] One or more embodiments of the present specification may be a system, method and / or computer program product. The computer program product may include a computer-readable storage medium carrying computer-readable program instructions for causing a processor to implement various aspects of the present specification.
[0114] A computer-readable storage medium may be a tangible device that can hold and store instructions used by an instruction execution device. A computer-readable storage medium may be, for example, but not limited to, an electrical storage device, a magnetic storage device, an optical storage device, an electromagnetic storage device, a semiconductor storage device, or any suitable combination of the foregoing. More specific examples of computer-readable storage media (a non-exhaustive list) include: a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), a static random access memory (SRAM), a portable compact disk read-only memory (CD-ROM), a digital versatile disk (DVD), a memory stick, a floppy disk, a mechanical encoding device, such as a punch card or a raised structure in a groove on which instructions are stored, and any suitable combination of the foregoing. As used herein, a computer-readable storage medium is not to be interpreted as a transient signal per se, such as a radio wave or other freely propagating electromagnetic wave, an electromagnetic wave propagating through a waveguide or other transmission medium (e.g., a light pulse through a fiber optic cable), or an electrical signal transmitted through a wire.
[0115] The computer-readable program instructions described herein can be downloaded from a computer-readable storage medium to each computing / processing device, or downloaded to an external computer or external storage device via a network, such as the Internet, a local area network, a wide area network, and / or a wireless network. The network can include copper transmission cables, optical fiber transmissions, wireless transmissions, routers, firewalls, switches, gateway computers, and / or edge servers. The network adapter card or network interface in each computing / processing device receives the computer-readable program instructions from the network and forwards the computer-readable program instructions for storage in the computer-readable storage medium in each computing / processing device.
[0116] The computer program instructions for performing the operation of the embodiments of this specification may be assembly instructions, instruction set architecture (ISA) instructions, machine instructions, machine-related instructions, microcode, firmware instructions, state setting data, or source code or object code written in any combination of one or more programming languages, including object-oriented programming languages such as Smalltalk, C++, etc., and conventional procedural programming languages such as "C" language or similar programming languages. Computer-readable program instructions may be executed completely on a user's computer, partially on a user's computer, executed as an independent software package, partially on a user's computer, partially on a remote computer, or completely on a remote computer or server. In the case of a remote computer, the remote computer may be connected to the user's computer via any type of network including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computer (e.g., using an Internet service provider to connect via the Internet). In certain embodiments, by utilizing the state information of a computer-readable program instruction to customize an electronic circuit, such as a programmable logic circuit, a field programmable gate array (FPGA) or a programmable logic array (PLA), the electronic circuit may execute a computer-readable program instruction, thereby realizing various aspects of this specification.
[0117] Various aspects of this specification are described herein with reference to flowcharts and / or block diagrams of methods, devices (systems) and computer program products according to embodiments of this specification. It should be understood that each box in the flowchart and / or block diagram and the combination of boxes in the flowchart and / or block diagram can be implemented by computer-readable program instructions.
[0118] These computer-readable program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, thereby producing a machine, so that when these instructions are executed by the processor of the computer or other programmable data processing device, a device that implements the functions / actions specified in one or more boxes in the flowchart and / or block diagram is generated. These computer-readable program instructions can also be stored in a computer-readable storage medium, and these instructions cause the computer, programmable data processing device, and / or other equipment to work in a specific manner, so that the computer-readable medium storing the instructions includes a manufactured product, which includes instructions for implementing various aspects of the functions / actions specified in one or more boxes in the flowchart and / or block diagram.
[0119] Computer-readable program instructions may also be loaded onto a computer, other programmable data processing apparatus, or other device so that a series of operating steps are performed on the computer, other programmable data processing apparatus, or other device to produce a computer-implemented process, thereby causing the instructions executed on the computer, other programmable data processing apparatus, or other device to implement the functions / actions specified in one or more boxes in the flowchart and / or block diagram.
[0120] The flowcharts and block diagrams in the accompanying drawings show the possible architecture, functions and operations of the systems, methods and computer program products according to the multiple embodiments of this specification. In this regard, each box in the flowchart or block diagram can represent a module, a program segment or a part of an instruction, and a part of a module, a program segment or an instruction contains one or more executable instructions for realizing the specified logical function. In some alternative implementations, the functions marked in the box can also occur in a different order from the order marked in the accompanying drawings. For example, two consecutive boxes can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each box in the block diagram and / or the flowchart, and the combination of the boxes in the block diagram and / or the flowchart can be implemented by a dedicated hardware-based system that performs the specified function or action, or can be implemented by a combination of dedicated hardware and computer instructions. It is well known to those skilled in the art that it is equivalent to implement it by hardware, implement it by software, and implement it by combining software and hardware.
[0121] The embodiments of the present specification have been described above, and the above description is exemplary, not exhaustive, and is not limited to the disclosed embodiments. Many modifications and changes will be apparent to those of ordinary skill in the art without departing from the scope and spirit of the described embodiments. The choice of terms used herein is intended to best explain the principles of the embodiments, practical applications, or technical improvements in the marketplace, or to enable other persons of ordinary skill in the art to understand the embodiments disclosed herein. The scope of this application is defined by the appended claims.
Claims
1. A method for correcting the motion trajectory of equipment, It is characterized in that The method comprises: Data collection step, collecting equipment motion trajectory data; a diagnosis step of determining whether the collected equipment motion trajectory data is within a preset compliance range, and recording the number of motion trajectory data within the compliance range as a first number; A first calculation step, when it is determined in the diagnosis step that the equipment motion trajectory data is outside the compliance range, calculating compensation value candidates; A first virtual correction step, compensating all the collected motion trajectory data with the compensation value candidate to obtain virtual correction trajectory data, determining whether each of the virtual correction trajectory data is within the preset compliance range, and recording the number of virtual correction trajectory data within the compliance range as a second number; A first comparison step, comparing whether the second number is greater than the first number; The first control step is to set the compensation value candidate as the compensation value to perform deviation correction compensation on the equipment when the second number is greater than the first number.
2. The method according to claim 1, It is characterized in that When the second number is not greater than the first number, the first control step is not performed.
3. The method according to claim 2, It is characterized in that When the first control step is not performed, the method further comprises: A second calculation step, when it is determined in the diagnosis step that the motion trajectory data of the equipment is outside the compliance range, calculating compensation value candidates for all previous motion trajectory data outside the compliance range to obtain a set of compensation value candidates; A second virtual deviation correction step, using each compensation value candidate item in the set of compensation value candidate items to compensate all motion trajectory data to obtain a second number of sets; a second comparison step, selecting a maximum value from the set of the second quantities, and comparing the maximum value with the first quantity; The second control step is to set the compensation value candidate corresponding to the maximum value as the compensation value to perform correction compensation on the equipment when the maximum value is greater than the first number, and not perform correction compensation when the maximum value is not greater than the first number.
4. The method according to claim 1, It is characterized in that After each deviation correction and compensation, the collected equipment motion trajectory data is cleared.
5. The method according to claim 1, It is characterized in that The collected equipment motion trajectory data is the end point position coordinates of the equipment motion at the time of collection.
6. The method according to claim 5, It is characterized in that The compensation value candidate is a vertical distance from the end position of the equipment movement outside the compliance range to the boundary of the compliance range.
7. The method according to claim 1, It is characterized in that Setting a warning range, wherein the warning range is within the compliance range, and the diagnosing step further includes a warning diagnosis step, wherein it is determined whether the collected equipment motion trajectory data is within the set warning range, and the number of motion trajectory data within the warning range is recorded as a third number; When it is determined in the early warning diagnosis step that the equipment motion trajectory data is within the compliance range and outside the early warning range, the following steps are performed: The first warning calculation step is to calculate the candidate items of warning compensation value; A first early warning virtual deviation correction step, compensating all motion trajectory data collected within the compliance range with the early warning compensation value candidate, obtaining early warning virtual deviation correction trajectory data, determining whether each early warning virtual deviation correction trajectory data is within the early warning range, and recording the number of early warning virtual deviation correction trajectory data within the early warning range as a fourth number; A first early warning comparison step, comparing whether the fourth quantity is greater than the third quantity; The first warning control step sets the warning compensation value candidate as the compensation value to perform correction compensation on the equipment when the fourth number is greater than the third number, and does not perform correction compensation when the fourth number is not greater than the third number.
8. The method according to claim 7, It is characterized in that When the fourth number is not greater than the third number and no correction compensation is performed, the method further includes: A second early warning calculation step, when it is determined in the early warning diagnosis step that the equipment motion trajectory data is within the compliance range and outside the early warning range, calculating early warning compensation value candidates for all previous motion trajectory data within the compliance range and outside the early warning range to obtain a set of early warning compensation value candidates; A second early warning virtual deviation correction step, using each early warning compensation value candidate item in the set of early warning compensation value candidate items to compensate all motion trajectory data within the compliance range, to obtain a set of fourth quantities; a second early warning comparison step, selecting a maximum value from the set of the fourth quantities, and comparing the maximum value with the third quantity; The second early warning control step is to set the early warning compensation value candidate corresponding to the maximum value as the compensation value to perform correction compensation on the equipment when the maximum value is greater than the third number, and not perform correction compensation when the maximum value is not greater than the third number.
9. A control device for equipment, It is characterized in that The control device comprises: Data acquisition module, used to collect equipment motion trajectory data; a diagnosis module, configured to determine whether the collected equipment motion trajectory data is within a preset compliance range, and record the number of motion trajectory data within the compliance range as a first number; a calculation module, which calculates compensation value candidates when the diagnosis module determines that the equipment motion trajectory data is outside the compliance range; a virtual correction module, configured to compensate all collected motion trajectory data using the compensation value candidate, obtain virtual correction trajectory data, determine whether each virtual correction trajectory data is within the preset compliance range, and record the number of virtual correction trajectory data within the compliance range as a second number; A comparison module, configured to compare whether the second number is greater than the first number; A control module is used to set the compensation value candidate as the compensation value to perform deviation correction compensation on the equipment when the second number is greater than the first number.
10. A readable storage medium having a computer program stored thereon, wherein the computer program implements the method according to any one of claims 1 to 8 when executed by a processor.
