A detection trajectory control method

Abstract

The present invention provides a detection trajectory control method. Utilizing the parameter program calculation function of a CNC machine tool, the method first calculates the angle of a slash line based on trigonometric functions. After the probe is initially triggered, it retracts a certain distance based on the previously calculated angle and then performs a second precise detection to obtain the precise position. The calculation process is as follows: reading parameters; determining the movement direction; using an interrupt instruction to rapidly move toward the target; generating an interrupt; detecting the retraction distance; moving toward the target point; and detecting the position coordinates. This detection trajectory control method can be applied to various similar detection systems to achieve position detection and dimensional measurement of special-shaped parts, performing detection functions that cannot be completed by conventional control programs, and improving the system's automation level. Furthermore, by utilizing the parameter program calculation function of a CNC machine tool, the method can also obtain the precise position of a workpiece during machining, providing accurate data for other measurement modules.

Description

Technical Field

[0001] The present invention relates to the technical field of numerical control machining, and in particular to a detection trajectory control method. Background Art

[0002] In current CNC machining, automatic probes serve as an important auxiliary device, reducing tool setting, workpiece alignment, and online measurement of machining elements. They are widely used. The conventional probes are trigger-type probes. Once the trigger mechanism is activated, an audible and visual signal is emitted to indicate the trigger status. These probes can measure position and dimensions through single-point and multi-point measurement, and can also be converted by the CNC system. The results can be written to the CNC system to enable post-measurement compensation and other functions.

[0003] However, this detection method has problems such as low detection efficiency and single form. Straight-line measurement along the axis can meet the processing needs of general situations. In the process of alignment measurement of complex parts, such as complex parts after precision casting, since some processing content has been cast, the measurement of some positions along the axis cannot be achieved, which has a great impact on the size and position measurement. Summary of the Invention

[0004] In view of the shortcomings of the existing technology, the purpose of the present invention is to provide a detection trajectory control method to solve the problems raised in the above background technology. The present invention can obtain accurate positions, provide more accurate data for other measurement modules, expand the scope of application, and have a high degree of automation.

[0005] In order to achieve the above-mentioned purpose, the present invention is implemented through the following technical solutions: a detection trajectory control method, which utilizes the parameter program calculation function of the CNC machine tool, first calculates the angle of the oblique line according to the trigonometric function, and after the probe is triggered for the first time, retreats a certain distance according to the previously calculated angle and then performs a second precise detection to obtain the precise position. The calculation process is: read the parameters; determine the moving direction; use the interrupt instruction to move quickly to the target; interruption occurs; detect the retreat distance; move to the target point; detect the position coordinates.

[0006] Furthermore, in the process of determining the moving direction, if the workpiece moves in the positive X direction, the sign of the moving value variable #17 is reversed.

[0007] Furthermore, during the process of determining the moving direction, if the workpiece moves in the negative X direction, an interrupt instruction can be used to quickly move to the target point.

[0008] Furthermore, during the interruption process, a subsequent detection process is performed based on whether the workpiece contacts the part.

[0009] Furthermore, when an interruption occurs, the probe does not contact the part, which directly triggers an alarm and ends the running program early.

[0010] Furthermore, if the probe has already contacted the part when the interruption occurs, a subsequent process of calculating the retraction distance along the probing path according to the movement value #17 is performed, which includes calculating the retraction X relative position and calculating the retraction Y relative position.

[0011] Furthermore, when moving toward the target point, the target point is moved slowly through an interrupt instruction.

[0012] Furthermore, after the recording is interrupted, the coordinates of the detection position are accurately recorded.

[0013] Furthermore, after completing the entire detection process, the workpiece is returned to the initial point and restored to the state before initialization.

[0014] Beneficial effects of the present invention:

[0015] 1. This detection trajectory control method realizes high freedom of use of the probe in the process of using the probe in an efficient and adaptable manner by designing a control program for multi-directional automatic detection trajectory, achieving the expected effect. It can be used on CNC systems above FANUC-0i, and can be applied on Siemens, Huazhong and other systems after relevant conversion.

[0016] 2. This detection trajectory control method can be applied to various similar detection systems to realize position detection and size measurement of special-shaped parts, realize detection functions that cannot be completed by general control programs, and improve the degree of automation of the system.

[0017] 3. This detection trajectory control method utilizes the parameter program calculation function of the CNC machine tool. First, the angle of the oblique line is calculated according to trigonometric functions. After the probe is triggered for the first time, it retreats a certain distance based on the previously calculated angle and then performs a second precise detection to obtain the precise position and provide accurate data for other measurement modules. BRIEF DESCRIPTION OF THE DRAWINGS

[0018] Figure 1 This is a flow chart of a detection trajectory control method of the present invention;

[0019] Figure 2 This is a measurement position diagram of a detection trajectory control method of the present invention. DETAILED DESCRIPTION

[0020] In order to make the technical means, creative features, objectives and effects achieved by the present invention easier to understand, the present invention is further described below in conjunction with specific implementation methods.

[0021] See also Figures 1 to 2The present invention provides a technical solution: a detection trajectory control method, which uses a measurement in any direction, such as the attached Figure 2 As shown, the process mainly utilizes the parameter program calculation function of the CNC machine tool. First, the oblique line angle is calculated according to the trigonometric function. After the probe is triggered for the first time, it retreats a certain distance according to the previously calculated angle and then performs a second precise detection to obtain the precise position and provide accurate data for other measurement modules. The control source code is shown in the list below. The control program for automatically collecting the measurement position is the basic program for the automatic probe to realize the function. By designing a control program for multi-directional automatic detection trajectory, it realizes the high degree of freedom of use during the use of the probe with high efficiency and high adaptability, achieving the expected effect. It can be used on CNC FANUC-0i and above systems, and can be applied on Siemens, Huazhong and other systems after relevant conversion.

[0022] This embodiment:

[0023] Call command: G65 P8854 X Target point X value Y Target point Y value

[0024] Parameter description: G65 is the instruction for Fanuc to call the module. P8854 is the code for calling the module (i.e. the following program).

[0025] List of programs

[0026] 08854 (XY plane arbitrary direction detection program)

[0027] #1=.05

[0028] G65P8852 probe initialization

[0029] IF[#17EQ#0]THEN#17=3

[0030] #4 = ATAN[#25-#5042] / [#24-#5041] Calculate the retraction angle. Angle value = inverse tangent ((end point coordinate Y - current coordinate Y) / (end point coordinate X / current coordinate X))

[0031] IF[#5041LE#24]G0T0100

[0032] #17=-#17

[0033] N100

[0034] G31X[#24+#17]F2500Y[#25+#17] Interrupt move command

[0035] M98P9723

[0036] IF[ABS[#5061-[#24+#17]LT#1]G0T0110 calculates the difference between the detection position and the interruption position

[0037] IF[ABS[#5061-#5041]LT#1]G0T0115

[0038] IF[ABS[#5062-[#25+#17]]LT#1]G0T0110

[0039] IF[ABS[#5062-#5042]LT#1]G0T0115

[0040] #2=#5061

[0041] #3=#5062

[0042] #6=#17*COS[#4] Calculate the relative position of retreat X (movement value × sine of retreat angle)

[0043] #7=#17*SIN[#4] Calculate the relative Y position of the retraction (movement value × cosine value of the retraction angle)

[0044] G1X[#2-#6]Y[#3-#7]F3000

[0045] #3004=2 specifies single block, program stop, and feedrate override is invalid

[0046] M98P9723

[0047] G31X[#24+#17]Y[#25+#17]F30 interrupts the movement command

[0048] M98P9723

[0049] IF[ABS[#5061-[#24+#17]LT#1]]G0T0110

[0050] IF[ABS[#5062-[#25+#17]LT#1]G0T0110 calculates the difference between the detection position and the interruption position

[0051] IF[ABS[#5061-[#2-#6]]LT#1]G0T0110

[0052] IF[ABS[#5062-[#3-#7]]LT#1]G0T0110

[0053] N110#3000=110(MEI-TAN-ZHA0) Position alarm not detected

[0054] N115#3000=115(TAN-TOU-GU-ZHANG) Probe detection position abnormality alarm

[0055] N120G1X#24Y#25F3000 Return to the initial point

[0056] G65P8853 restores the state before initialization

[0057] #3004=0

[0058] M99.

[0059] The above shows and describes the basic principles and main features of the present invention and the advantages of the present invention. It will be apparent to those skilled in the art that the present invention is not limited to the details of the exemplary embodiments described above and that the present invention can be implemented in other specific forms without departing from the spirit or essential characteristics of the present invention. Therefore, from all perspectives, the embodiments should be regarded as illustrative and non-restrictive. The scope of the present invention is defined by the appended claims, not the foregoing description, and it is intended that all variations that come within the meaning and range of equivalents of the claims be included within the present invention. Any reference signs in the claims should not be construed as limiting the claim to which they relate.

[0060] In addition, it should be understood that although this specification is described in terms of implementation methods, not every implementation method contains only one independent technical solution. This narrative method of the specification is only for the sake of clarity. Those skilled in the art should regard the specification as a whole. The technical solutions in each embodiment can also be appropriately combined to form other implementation methods that can be understood by those skilled in the art.

Claims

1. A detection trajectory control method, characterized in that: Using the parameter program calculation function of the CNC machine tool, the angle of the oblique line is first calculated according to trigonometric functions. After the probe is triggered for the first time, it retreats a certain distance based on the previously calculated angle and then performs a second precise detection to obtain the precise position. The calculation process is as follows: read the parameters; determine the moving direction; Use the interrupt instruction to move quickly toward the target; an interrupt occurs; detect the retraction distance; move toward the target point; detect the position coordinates. During the process of judging the movement direction, if the workpiece moves in the positive X direction, the movement value variable #17 is inverted. During the process of judging the movement direction, if the workpiece moves in the negative X direction, the subsequent interrupt instruction can be used to move quickly toward the target point. During the interruption, the subsequent detection process is carried out according to whether the workpiece contacts the part. If the probe does not contact the part when the interruption occurs, an alarm is directly triggered and the running program ends early. If the probe has contacted the part when the interruption occurs, the subsequent process of calculating the retraction distance along the detection path according to the movement value #17 is carried out. This process includes calculating the retraction X relative position and calculating the retraction Y relative position. When moving toward the target point, the interrupt instruction is used to move slowly toward the target point.

2. A detection trajectory control method according to claim 1, characterized in that: After the recording is interrupted, the coordinates of the detection position are accurately recorded.

3. A detection trajectory control method according to claim 2, characterized in that: After completing the entire detection process, the workpiece will be returned to the initial point and restored to the state before initialization.

Images