Control device
By generating mechanical structure diagrams and inserting control points and coordinate systems through a control device, the problem of not being able to adjust the automatic operation path in the prior art is solved. This enables effective reflection of external movement and path adjustment in a five-axis machining center, reducing the computational load of interpolation processing.
Patent Information
- Application Number
- CN202180097774.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-05-28
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2041-05-28
AI Technical Summary
Existing technologies cannot reflect the amount of movement without an external coordinate system. In particular, when the worktable of a five-axis machining center rotates, the path of automatic operation cannot be effectively adjusted, and the interpolation processing has a large computational load.
The control device includes an instruction parsing unit, an interpolation unit, a pulse generation unit, a chart generation unit, a shift addition node designation unit, a shift information setting unit, and a kinematic conversion unit. By generating mechanical structure charts and inserting control points and coordinate systems, it realizes the addition and conversion of external movement.
It enables the automatic operation path to be shifted relative to any coordinate system on the mechanical structure without increasing the computational load of interpolation processing, thus adapting to complex situations such as the rotation of the worktable axis of a five-axis machining center.
Smart Images

Figure CN117255975B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to a control device. Background Technology
[0002] In the past, under-machining sometimes occurred during the automatic operation of machine tools. In such cases, there exists a function that eliminates the under-machining caused during automatic operation by providing a movement amount from the outside and shifting the path of automatic operation (for example, see Patent Documents 1 and 2).
[0003] For example, the device described in Patent Document 1 maintains the coordinate values representing the position of the processing point by reflecting the amount of movement based on the manual intervention as a displacement in the coordinate system when the processing point is changed through manual intervention. Thus, the device described in Patent Document 1 operates as if there were no manual intervention, thereby shifting the path of automatic operation.
[0004] However, the technology described in Patent Document 1 cannot, for example, handle the rotation of the worktable's rotary axis in a five-axis machining center. Furthermore, the device described in Patent Document 2 corrects for workpiece mounting errors. By performing the same process as in Patent Document 2, it is also considered that the displacement direction of the automatically operating movement path should follow the worktable's rotary axis, based on the angle of the rotary axis.
[0005] Existing technical documents
[0006] Patent documents
[0007] Patent Document 1: Japanese Patent Application Publication No. 63-308604
[0008] Patent Document 2: Japanese Patent Application Publication No. 7-299697 Summary of the Invention
[0009] The problem that the invention aims to solve
[0010] However, in the prior art, the amount of movement can only be reflected externally using the mechanical coordinate system described in Patent Document 1 or the program coordinate system described in Patent Document 2. That is, in the prior art, it is not possible to reflect the amount of movement externally using other coordinate systems. In addition, in the technology described in Patent Document 2, calculations for path displacement to enable automatic operation are required during the interpolation process.
[0011] Typically, numerical control devices need to continuously generate pulses through interpolation processing to continuously control machine tools. Therefore, the interpolation process must be completed within a certain timeframe. Thus, a control device is desired that can shift the movement path of an automatically operating machine relative to any coordinate system on the mechanical structure without increasing the computational load of the interpolation process.
[0012] Methods for solving problems
[0013] One aspect of the control device disclosed herein includes: an instruction parsing unit that parses instructions containing a machining program for machining a workpiece and outputs a parsing result containing program coordinate values; an interpolation unit that performs interpolation processing on the parsing result parsed by the instruction parsing unit to generate movement instructions for each axis of a machine tool and / or a robot; a pulse generation unit that generates drive pulses for driving each axis based on the movement instructions; a graph generation unit that generates a graph representing the mechanical structure of the machine tool and / or the robot; a shift append node designation unit that designates any node of the graph to append shift information containing an externally input external movement amount to a node of the graph; a shift information setting unit that sets the shift information based on the shift information for the position offset and / or posture offset of the designated node; and a kinematic conversion unit that converts the program coordinate values contained in the movement instructions into motor coordinate values based on the position offset and / or posture offset set at the node.
[0014] Invention Effects
[0015] According to the present invention, the movement path of automatic operation can be shifted relative to any coordinate system on the mechanical structure without increasing the computational load of interpolation processing. Attached Figure Description
[0016] Figure 1 This is a block diagram illustrating the structure of the control system in this embodiment.
[0017] Figure 2 This is a block diagram illustrating the structure of the control device in this embodiment.
[0018] Figure 3 This is a block diagram illustrating the general outline of the processing of the control device in this embodiment.
[0019] Figure 4 This is an explanatory diagram of the method for generating the mechanical structure tree in this embodiment.
[0020] Figure 5 This is an explanatory diagram of the method for generating the mechanical structure tree in this embodiment.
[0021] Figure 6 This is an explanatory diagram of the method for generating the mechanical structure tree in this embodiment.
[0022] Figure 7 This is a flowchart illustrating the method for generating the mechanical structure tree in this embodiment.
[0023] Figure 8A This is an explanatory diagram showing the parent-child relationship of the structural elements of the machine in this embodiment.
[0024] Figure 8B This is an explanatory diagram showing the parent-child relationship of the structural elements of the machine in this embodiment.
[0025] Figure 9A This is an explanatory diagram of the method for inserting units into the mechanical structure tree.
[0026] Figure 9B This is an explanatory diagram of the method for inserting units into the mechanical structure tree.
[0027] Figure 9C This is an explanatory diagram of the method for inserting units into the mechanical structure tree.
[0028] Figure 10 This is a diagram illustrating an example of the mechanical structure of an embodiment of the present invention.
[0029] Figure 11A This is a diagram representing an example of a machine that becomes a generating object in the machine structure tree.
[0030] Figure 11B This is a diagram representing an example of a machine structure tree corresponding to a machine that becomes a generator object of the machine structure tree.
[0031] Figure 12 This is a diagram showing an example of a coordinate system and control points being inserted into the nodes of a machine.
[0032] Figure 13 This is a diagram showing an example of a mechanical structure tree with a coordinate system and control points inserted.
[0033] Figure 14A This is a diagram illustrating an example of a mechanism for inserting offsets and pose matrices at each node.
[0034] Figure 14B This is a diagram illustrating an example of inserting offsets and posture matrices at various nodes of a machine.
[0035] Figure 15 It is a diagram showing the action flow of inserting control points in the mechanical structure tree.
[0036] Figure 16 This is a diagram showing an example of a mechanical structure tree with a coordinate system and control points inserted.
[0037] Figure 17 This is a flowchart illustrating the processing of the control device in this embodiment.
[0038] Figure 18 This is a perspective view of a five-axis machining center, which is an example of a machine tool controlled by the control device of this embodiment.
[0039] Figure 19It is a diagram representing the mechanical structure tree of a five-axis machining center.
[0040] Figure 20 This is a block diagram showing the structure of the control device in Application Example 1.
[0041] Figure 21 This is a diagram representing the mechanical structure tree of the five-axis machining center in Application Example 1.
[0042] Figure 22 This is a graph showing the relationship between the actual workpiece position and the desired workpiece position in Application Example 1.
[0043] Figure 23 This is a diagram representing the mechanical structure tree of the five-axis machining center in Application Example 2.
[0044] Figure 24 This is a graph showing the relationship between the actual angle of the A-axis and the desired angle of the A-axis in Application Example 2.
[0045] Figure 25 This is a diagram of the mechanical structure tree G3 representing the mechanical structure of the machine tool and robot in application example 3.
[0046] Figure 26 This is a diagram showing the positional relationship between the machine tool and the robot in Application Example 3. Detailed Implementation
[0047] <1. Overall Structure>
[0048] Figure 1 This is a diagram showing the structure of the control system 1 in this embodiment. (As shown...) Figure 1 As shown, the control system 1 includes a control device 10, a machine tool 20, and a robot 30.
[0049] The control device 10 is communicatively connected to the machine tool 20 and the robot 30 to control the machine tool 20 and the robot 30. Alternatively, the control device 10 may also be communicatively connected to one of the machine tool 20 and the robot 30 to control only one of the machine tool 20 and the robot 30.
[0050] That is, the control device 10 can also be a control device for both the machine tool 20 and the robot 30. In addition, the control device 10 can function as a numerical control device for controlling the machine tool 20, or as a robot control device for controlling the robot 30.
[0051] <2. Structure of Control Device 10>
[0052] Figure 2 This is a block diagram illustrating the structure of the control device 10 in this embodiment. Figure 3This is a block diagram illustrating the general outline of the processing of the control device 10 in this embodiment.
[0053] like Figure 2 As shown, the control device 10 includes a control unit 100 and a storage unit 150.
[0054] The control unit 100 is a processor that controls the entire control device 10. The control unit 100 performs various functions by executing system programs and application programs stored in the storage unit 150.
[0055] Furthermore, the control unit 100 includes an instruction parsing unit 101, an interpolation unit 102, a pulse generation unit 103, a servo control unit 104, a graph generation unit 105, a control point coordinate system insertion unit 106, a shift addition node specification unit 107, a shift information setting unit 108, and a kinematic conversion unit 109.
[0056] Storage unit 12 is a storage device such as ROM (Read Only Memory), RAM (Random Access Memory), hard disk drive (HDD), or SSD (Solid State Drive) that stores the OS (Operating System), applications, etc., and stores various other information. Storage unit 150 stores, for example, system programs, applications, and information related to the mechanical structure tree generated by the diagram generation unit 105 (described later).
[0057] The instruction parsing unit 101 parses the instructions containing the machining program for processing the workpiece and converts them into an executable form. The instruction parsing unit 101 outputs the parsing result, converted into an executable form, to the interpolation unit 102. Here, the machining program is a program used to automatically operate the machine tool 20 and / or the robot 30. Additionally, the parsing result includes program coordinate values. Program coordinate values represent one or more instruction values instructed in the program, and the program coordinate system represents the coordinate system of one or more instruction values instructed in the program.
[0058] The interpolation unit 102 performs interpolation processing on the analysis results parsed by the command parsing unit 101 to generate movement commands for each axis of the machine tool 20 and / or robot 30. The generated movement commands include error corrections for each axis. The interpolation unit 102 outputs the generated movement commands to the pulse generation unit 103.
[0059] Specifically, the interpolation unit 102 outputs the program coordinate values (i.e., the start and end points in the program coordinate system) contained in the analysis result to the kinematics conversion unit 109, and receives the motor coordinate values (i.e., the start and end points in the motor coordinate system) converted by the kinematics conversion unit 109. Then, the interpolation unit 102 calculates the difference between the start and end points of the motor coordinate values and outputs a movement command containing the difference to the pulse generation unit 103.
[0060] The pulse generation unit 103 generates drive pulses for driving each axis of the machine tool 20 and / or robot 30 based on the movement commands generated by the interpolation unit 102. The pulse generation unit 103 outputs the generated drive pulses to the servo control unit 104.
[0061] The servo control unit 104 rotates the motors (not shown) of each axis according to the drive pulses sent from the pulse generation unit 103. Furthermore, the servo control unit 104 refers to the servo control unit for each axis of the machine tool 20 and / or robot 30. That is, as... Figure 3 As shown, the servo control unit 104 is composed of an X-axis servo control unit 104a, a Y-axis servo control unit 104b, etc. Figure 3 In this diagram, only the X-axis servo control unit 104a and the Y-axis servo control unit 104b are shown; the servo control units for the other axes are omitted from the diagram.
[0062] The diagram generation unit 105 generates a diagram representing the mechanical structure of the machine tool 20 and / or the robot 30. Specifically, the diagram generation unit 105 generates a mechanical structure tree 121 representing the mechanical structure of the machine tool 20 and / or the robot 30. Furthermore, the diagram generation unit 105 adds nodes to the generated diagram. Specifically, the diagram generation unit 105 adds nodes to the generated mechanical structure tree 121. These detailed operations will be described in detail in "3. Generation of the Mechanical Structure Tree" described later.
[0063] The control point coordinate system insertion unit 106 inserts control points and coordinate systems into the diagrams of the mechanical structure. Detailed instructions regarding its operation are described in section 4, "Automatic Insertion of Control Points and Coordinate Values."
[0064] The shift addition node designation unit 107 designates any node in the chart generated by the chart generation unit 105 to add shift information, including externally input external shift amounts, to the nodes of the chart. Here, external shift amount refers to the shift amount input from the outside. For example, the external shift amount may be the shift amount between the start and end points of the tool position when the tool position of the machine tool 20 is moved by the manual handle. Alternatively, the shift information may be a shift amount generated other than automatic operation based on the machining program. For example, the shift information may be a value of the external shift amount after the manual handle movement is used to save the shift amount in a certain coordinate system when the tool position of the machine tool 20 is moved by the manual handle.
[0065] The shift information setting unit 108 sets shift information based on the shift information for the position offset and / or posture offset of the node specified by the shift addition node designation unit 107.
[0066] The kinematic conversion unit 109 converts the program coordinate values contained in the movement command into motor coordinate values based on the position offset and / or attitude offset set at the node. Thus, the kinematic conversion unit 109 can shift the motor coordinate values by an external movement amount according to the shift information set as position offset and / or attitude offset.
[0067] <3. Generation of the Mechanical Structure Tree>
[0068] The diagram generation unit 105 of this embodiment initially generates a diagram representing a mechanical structure. As an example of a diagram, see... Figures 4 to 10 This section describes in detail the method for generating a mechanical structure tree.
[0069] As an example, regarding performance Figure 4 The method for generating the mechanical structure tree of the machine shown is explained. Figure 4 In the machine, the X-axis is set to be perpendicular to the Z-axis, tool 1 is set on the X-axis, and tool 2 is set on the Z-axis. On the other hand, the B-axis is set on the Y-axis, the C-axis is set on the B-axis, and workpiece 1 and workpiece 2 are set on the C-axis. The method for representing this machine structure as a machine structure tree is as follows.
[0070] First, such as Figure 5 As shown, only the origin 201 and nodes 202A to 202I are configured. In this stage, there is no connection between the origin 201 and node 202, and the names of the origin and nodes are not set.
[0071] Next, set the axis name (axis type), tool name, workpiece name, origin name, and physical axis number (axis type) for each axis. Then, set the parent node (axis type), tool parent node, and workpiece parent node for each axis. Finally, set the cross offset (axis type), tool cross offset, and workpiece cross offset for each axis. The result is the generation of... Figure 6 The mechanical structure tree shown.
[0072] Furthermore, the nodes in the mechanical structure tree are not limited to the information mentioned above. For example, they may have an identifier (name), the identifier of their own parent node, the identifiers of all child nodes that are their own parents, the relative offset (cross offset) relative to the parent node, the relative coordinate value relative to the parent node, the relative direction of movement (unit vector) relative to the parent node, the node type (linear axis / rotation axis / element (described later) / control point / coordinate system / origin, etc.), the physical axis number, and the information involved in the transformation formula between the orthogonal coordinate system and the physical coordinate system, or they may not have these information.
[0073] By setting values for each node in this way, the chart generation unit 105 generates data with a mechanical tree structure. Furthermore, when other machines (or robots) are added, an origin point can be added, and thus nodes can be added.
[0074] Figure 7 This is a flowchart that generalizes the above-mentioned method for generating a mechanical structure tree, especially the method for setting the values of each node.
[0075] In step S11, the graph generation unit 105 receives the values of the parameters set for the nodes.
[0076] In step S12, if the set parameter is "its own parent node" (S12: Yes), the process proceeds to step S13. If it is not "its own parent node" (S12: No), the process proceeds to step S17.
[0077] In step S13, if the node with the set parameters has already set a parent node (S13: Yes), the process proceeds to step S14. If no parent node has been set (S13: No), the process proceeds to step S15.
[0078] In step S14, the graph generation unit 105 deletes its own identifier from the "child node" items of the current parent node of the node with set parameters, and updates the mechanical structure tree.
[0079] In step S15, the chart generation unit 105 sets values for the corresponding items of the nodes of the set parameters.
[0080] In step S16, the graph generation unit 105 adds its own identifier to the "child node" item of the parent node, and after updating the mechanical structure tree, the process ends.
[0081] In step S17, the chart generation unit 105 ends the process after setting values for the corresponding items of the nodes of the set parameters.
[0082] By using a data generation method with the aforementioned mechanical tree structure, it is possible to establish the parent-child relationships between the structural elements of the machine.
[0083] Here, the so-called father-son relationship, for example, Figure 8A In this case, when there are two rotation axis nodes 504 and 505, the change in the coordinate value of node 504 on one side has a unilateral impact on the geometric state (typically position or orientation) of node 505 on the other side. In this situation, nodes 504 and 505 are said to have a parent-child relationship, with node 504 being called the parent and node 505 being called the child.
[0084] However, for example, Figure 8B As shown, in a mechanical structure consisting of two linear axis nodes 502 and 503 and four free joints 501, a change in the coordinate value (length) of one of the nodes 502 and 503 affects not only the geometry of the other node but also the geometry of the node itself, creating a mutually influential mechanism. In this case, they can be considered as parent and child, meaning the parent-child relationship is bidirectional.
[0085] In this way, mechanisms where changes at one node affect other nodes are captured as a unit from a convenience standpoint, and the overall mechanical structure tree is generated by inserting this unit into the mechanical structure tree. For example... Figure 9A As shown, the unit has two connection points 510 and 520. In the unit as... Figure 9B When inserted into the mechanical structure tree as shown, as Figure 9C As shown, the parent node is connected to connection point 520, and the child node is connected to connection point 510. Furthermore, the element has a transformation matrix from connection point 520 to connection point 510. This transformation matrix is represented by the coordinate values of each node contained within the element. For example, in... Figure 10 In the case of such a mechanical structure, if the homogeneous matrix representing the position and orientation at connection point 520 is set to M... A Let M be the homogeneous matrix representing the position and orientation at connection point 510. B The transformation formulas between these matrices are expressed using the coordinate values x1 and x2 of the linear axis nodes contained in the cell, as follows.
[0086] [Mathematical Expression 1]
[0087] like
[0088] but,
[0089] M B =TM A Among them, by To express.
[0090] The unit representing the mechanical structure has a homogeneous transformation matrix like T in the above [Mathematical Formula 1]. The homogeneous matrix is a 4×4 matrix that can uniformly represent position and orientation, as shown in the following [Mathematical Formula 2].
[0091] [Mathematical Expression 2]
[0092]
[0093] In addition, even if they are not parent and child nodes, in order to simplify computation and setup, multiple nodes can be pre-defined as a single unit and constructed in the mechanical structure tree.
[0094] As described above, in this embodiment, the diagram of the mechanical structure can include a unit that unifies multiple axes into one as a structural element.
[0095] <4. Automatic Insertion of Control Points and Coordinate Values>
[0096] In order to designate various positions on the mechanical structure as control points and set the coordinate system of various parts on the mechanical structure, the mechanical structure tree generated in "3. Generation of Mechanical Structure Tree" above is used to implement the following method.
[0097] For example, in Figure 11A In the rotary indexing machine 350 shown, the X1 axis is set perpendicular to the Z1 axis, and a tool 1 is mounted on the X1 axis. Additionally, the X2 axis is set perpendicular to the Z2 axis, and a tool 2 is mounted on the X2 axis. Furthermore, on the worktable, axes C1 and C2 are arranged side-by-side on the C-axis, and workpiece 1 and workpiece 2 are mounted on axes C1 and C2 respectively. If this mechanical structure is represented using a mechanical structure tree, it becomes... Figure 11B The mechanical structure tree shown.
[0098] If we take a series of nodes connecting each workpiece to the machine origin as an example, then... Figure 12 As shown, coordinate systems and control points are automatically inserted at the machine origin, C-axis, C1-axis, C2-axis, workpiece 1, and workpiece 2, respectively. This is applied not only to the worktable but also to a series of nodes connected to each tool and the machine origin, namely the X1-axis, X2-axis, Z1-axis, Z2-axis, tool 1, and tool 2. The result is as follows: Figure 13 As shown, control points and coordinate systems corresponding to each node are automatically inserted for all nodes constituting the mechanical structure tree. Typically, during machining, a coordinate system is assigned to the workpiece, and the tool is designated as a control point. Thus, various situations can be addressed, such as assigning control points to the workpiece to move it to a specified position, or setting a coordinate system for the tool itself to grind other tools using a particular tool.
[0099] In addition, such as Figure 14A As shown, each control point and coordinate system has an offset. Therefore, points far from the node center can also be used as control points or the origin of the coordinate system. Furthermore, each control point and coordinate system has a pose matrix. When this pose matrix is the pose matrix of a control point, it represents the pose (orientation, tilt) of the control point; when it's the pose matrix of the coordinate system, it represents the pose of the coordinate system. Figure 14B In the illustrated mechanical structure tree, the offset and pose matrices are represented in relation to their respective nodes. Furthermore, each control point and coordinate system has information on whether or not the "movement" and "cross offset" of nodes existing on the path to the root of the mechanical structure tree are considered, and can be configured accordingly.
[0100] Figure 15 A flowchart is shown that generalizes the above-described method for automatically inserting control points. Specifically, the flowchart includes processes A and B, which, as described later, are configured to execute process B midway through process A.
[0101] First, let's explain process A.
[0102] In step S21, the chart generation unit 105 sets the mechanical structure tree.
[0103] In step S22, process B is executed, and process A ends.
[0104] Next, process B will be explained.
[0105] In step S31 of process B, if a control point / coordinate system has been inserted into the node (S31: Yes), the process ends. If no control point / coordinate system has been inserted into the node (S31: No), the process proceeds to step S32.
[0106] In step S32, the control point coordinate system insertion unit 106 inserts control points / coordinate systems into the node and stacks a variable n. Furthermore, n = 1.
[0107] In step S33, if the node has an nth child node (S33: Yes), the process proceeds to step S34. If the node does not have an nth child node (S33: No), the process proceeds to step S36.
[0108] In step S34, process B itself is recursively executed for the nth child node.
[0109] In step S35, n is incremented by 1. That is, n = n + 1, and the process returns to step S33.
[0110] In step S36, a variable n is popped, and process B ends.
[0111] Using the method described above, the control point coordinate system insertion unit 106 inserts control points and coordinate systems as nodes into each node of the mechanical structure diagram. Furthermore, the above description shows an embodiment where control points and coordinate systems are added as nodes, but... Figure 16 As shown, the control point coordinate system insertion unit 106 can also be implemented in the same way as the implementation method that gives each node of the diagram of the mechanical structure control points and coordinate system as information.
[0112] <5. Control Device Processing Flow>
[0113] Figure 17 This is a flowchart illustrating the processing of the control device 10 in this embodiment.
[0114] In step S41, the diagram generation unit 105 generates a mechanical structure tree 121 representing the mechanical structure of the machine tool 20 and / or robot 30. Then, the control point coordinate system insertion unit 106 inserts control points and coordinate systems into the diagram of the mechanical structure.
[0115] In step S42, the instruction parsing unit 101 parses the instructions containing the machining program for machining the workpiece and converts them into an executable form. The instruction parsing unit 101 outputs the parsing result containing the program coordinate values to the interpolation unit 102.
[0116] In step S43, the shift append node designation unit 107 designates any node of the chart in order to append shift information containing the external shift amount input from the outside to the node of the chart generated by the chart generation unit 105.
[0117] In step S44, the shift information setting unit 108 sets shift information based on the shift information for the position offset and / or posture offset of the node specified by the shift append node designation unit 107.
[0118] In step S45, the interpolation unit 102 performs interpolation processing on the analysis result parsed by the instruction parsing unit 101. Furthermore, the interpolation unit 102 outputs the program coordinate values included in the analysis result to the kinematic transformation unit 109.
[0119] In step S46, the kinematics conversion unit 109 converts the program coordinate values into motor coordinate values based on the program coordinate values output from the interpolation unit 102 and the position offset and / or attitude offset set at the node. Then, the kinematics conversion unit 109 outputs the converted motor coordinate values to the interpolation unit 102.
[0120] In step S47, the interpolation unit 102 receives the motor coordinate values output from the kinematic conversion unit 109 and calculates the difference between the starting point and the ending point of the motor coordinate values.
[0121] In step S48, the interpolation unit 102 sends a shift command containing the calculated difference to the pulse generation unit 103.
[0122] In step S49, the pulse generation unit 103 generates drive pulses for driving each axis of the machine tool 20 and / or robot 30 based on the movement command generated by the interpolation unit 102. Then, the servo control unit 104 rotates the motors of each axis according to the drive pulses sent from the pulse generation unit 103. Thus, the control device 10 is able to rotate the motors of each axis of the machine tool 20 and / or robot 30 when an external movement is applied.
[0123] Thus, according to this embodiment, the control device 10 includes: an instruction parsing unit 101, which parses instructions containing a machining program for machining a workpiece and outputs a parsing result containing program coordinate values; an interpolation unit 102, which performs interpolation processing on the parsing result parsed by the instruction parsing unit 101 to generate movement instructions for each axis of the machine tool 20 and / or robot 30; a pulse generation unit 103, which generates drive pulses for driving each axis based on the movement instructions; a graph generation unit 105, which generates a graph representing the mechanical structure of the machine tool 20 and / or robot 30; a shift addition node designation unit 107, which designates any node of the graph in order to add shift information containing externally input external movement amount to the node of the graph; a shift information setting unit 108, which sets shift information based on the shift information for the position offset and / or posture offset of the designated node; and a kinematic conversion unit 109, which converts the program coordinate values contained in the movement instructions into motor coordinate values based on the position offset and / or posture offset set at the node.
[0124] Thus, the control device 10 can shift the path of automatic operation (e.g., the movement path of the tool) relative to any coordinate system on the mechanical structure of the machine tool 20 and / or robot 30 without increasing the computational load of the interpolation process.
[0125] <6. Control of Five-Axis Machining Machines>
[0126] Figure 18 This is a perspective view of a five-axis machining center 20a, which is an example of a machine tool 20 controlled by the control device 10 of this embodiment. Figure 19 This is a diagram representing the mechanical structure tree G of the five-axis machining center 20a.
[0127] The five-axis machining center 20a has a base 21, a pair of columns 22, 22 erected on the base 21, and a guide rail 23 that connects the upper ends of the columns 22, 22 to each other and extends laterally. A tool head 24 is mounted on the guide rail 23.
[0128] The five-axis machining center 20a uses the X-axis, which is in the direction of the machine base 21 and along the length of the guide rail 23, the Y-axis, which is in the direction of the machine base 21 and orthogonal to the length of the guide rail 23, and the Z-axis, which is perpendicular to the direction of the machine base 21, as linear axes.
[0129] The tool head 24 is configured to move linearly along the three axes: X, Y, and Z. At the lower end of the tool head 24, the tool 25, which serves as a moving axis component, protrudes downward along the Z-axis.
[0130] The five-axis machining center 20a has the following components on its base 21: a mounting section 26 for mounting the workpiece W, which is the object to be machined, and for rotating the workpiece W about the C-axis; and a rotary table 27 for rotating the mounting section 26 about the A-axis along the X-axis direction. When the mounting section 26 is arranged perpendicular to the Z-axis (when the rotation angle of the rotary table 27 is 0°), the C-axis is arranged parallel to the Z-axis direction. The A-axis and C-axis of the five-axis machining center 20a are located on the workpiece W side and are rotation axes that determine the relative orientation of the tool 25 with respect to the workpiece W, i.e., the tool direction, through rotation.
[0131] The mechanical structure tree G representing the mechanical structure of such a five-axis machining center 20a is as follows: Figure 19 The chart shown is generated by the chart generation unit 105. Figure 19 In the mechanical structure tree G shown, node T represents tool 25, node A represents axis A, node Z represents axis Z, node Y represents axis Y, node X represents axis X, node R represents the reference position of the machine, node C represents axis C, and node W represents workpiece W.
[0132] In this embodiment, the displacement information setting unit 108 of the control device 10 sets displacement information for node C at position P1 in such a mechanical structure tree G. Therefore, the control device 10 can reflect the external movement of the rotary table 27 in the worktable coordinate system and make that external movement follow the rotation of the rotary table 27.
[0133] Furthermore, the displacement information setting unit 108 sets displacement information for node R at position P2 in such a mechanical structure tree G. As a result, the control device 10 can reflect the external movement of the five-axis machining center 20a in the mechanical coordinate system, and can prevent this external movement from following the rotation of the rotary table 27.
[0134] Thus, the control device 10 of this embodiment can switch which coordinate system of the machine tool 20 the external movement is followed by, depending on which node the displacement information is set at. As a result, the control device 10 can achieve the desired external movement, i.e., the desired tool tip point path, in the machine tool 20.
[0135] <7. Application Example 1>
[0136] Hereinafter, application examples 1 to 3 of applying the control device 10 of this embodiment to a machine tool 20 and / or a robot 30 will be described. In application example 1, as a machine tool 20, the control device 10 controls... Figure 18 The five-axis machining center 20a is shown.
[0137] Figure 20 This is a block diagram showing the structure of the control device 10 in Application Example 1. Figure 21 This is a diagram of the mechanical structure tree G1 representing the mechanical structure of the five-axis machining center 20a in application example 1.
[0138] With the above Figure 2 as well as Figure 3 Similarly, the control unit 100 of the control device 10 includes an instruction parsing unit 101, an interpolation unit 102, a pulse generation unit 103, a servo control unit 104, a graph generation unit 105, a control point coordinate system insertion unit 106, a shift addition node designation unit 107, a shift information setting unit 108, and a kinematic conversion unit 109. Furthermore, the control unit 100 includes a shift information calculation unit 110.
[0139] The shift information calculation unit 110 calculates shift information including the amount of external movement in the program coordinate system. For example, the shift information calculation unit 110 calculates the shift information based on the motor coordinate values of the five-axis machining center 20a. For example, the shift information calculation unit 110 maintains the accumulated value of the interpolation pulses output by the interpolation unit 102 to the pulse generation unit 103 in the motor coordinate system. Here, the interpolation pulses correspond to external movement. Furthermore, the shift information calculation unit 110 converts the accumulated value of the interpolation pulses into the program coordinate system as shift information.
[0140] Then, as Figure 21 As shown, the shift addition node designation unit 107 designates the node W of the workpiece coordinate system, representing the workpiece coordinate system, in the machine structure tree G1. The shift information setting unit 108 sets shift information for the position offset and / or posture offset of the leaf node WS of the node W of the workpiece coordinate system.
[0141] Figure 22 This is a graph showing the relationship between the actual workpiece position and the desired workpiece position in Application Example 1. For example... Figure 22 As shown, the control device 10 assumes that the workpiece W is located in the desired workpiece position to create the machining program, but the actual workpiece position is different from the desired workpiece position.
[0142] In this embodiment, the control device 10, taking into account such workpiece position differences, sets displacement information for the position offset and / or posture offset of node WS as described above, and calculates the difference between the program coordinate value and the motor coordinate value. Therefore, by moving only the difference between the desired workpiece position and the actual workpiece position from the outside, the control device 10 can perform the desired machining on the five-axis machining center 20a.
[0143] <8. Application Example 2>
[0144] Figure 23 This is a diagram representing the mechanical structure tree G2 of the five-axis machining center 20a in Application Example 2. In Application Example 2, as the machine tool 20, the control device 10 controls... Figure 18 The five-axis machining center 20a is shown.
[0145] In addition, in Application Example 2, the displacement information is the external movement amount in the motor coordinate system. Then, the displacement addition node designation unit 107 designates multiple nodes A, Z, Y, X, and C of the motor coordinate system representing each axis in the machine structure tree G2. The displacement information setting unit 108 sets displacement information for the position offset and / or posture offset of the root node AS of node A, the root node ZS of node Z, the root node YS of node Y, the root node XS of node X, and the root node CS of node C in the motor coordinate system.
[0146] Figure 24 This is a graph showing the relationship between the actual angle of the A-axis and the desired angle of the A-axis in Application Example 2. For example... Figure 24 As shown, there are cases where the expected angle of the A-axis caused by the machining program instructions differs from the actual angle of the A-axis.
[0147] In order to take into account such an angle difference of the A-axis, the control device 10 of this embodiment sets displacement information for the position offset and / or posture offset of the root node AS of node A in the motor coordinate system, as described above, and calculates the difference between the program coordinate value and the motor coordinate value. Therefore, by moving only the difference between the desired angle of the A-axis and the actual angle of the A-axis from the outside, the control device 10 can execute the machining program in the desired tool direction on the five-axis machining center 20a.
[0148] <9. Application Example 3>
[0149] Figure 25 This is a diagram of the mechanical structure tree G3 representing the mechanical structure of machine tool 20b and robot 30b in application example 3. Figure 26 This is a diagram showing the positional relationship between machine tool 20b and robot 30b in application example 3.
[0150] like Figure 25 As shown, the mechanical structure tree G3, which is part of machine tool 20b, includes nodes A, C, Z, R, X, Y, and W. Furthermore, the mechanical structure, which is part of robot 30b, includes nodes J1, J2, J3, J4, J5, and J6.
[0151] Then, the shift addition node designation unit 107 designates the node CS in the world coordinate system in the machine structure tree G3. The shift information setting unit 108 sets shift information for the offset and / or attitude offset of the node CS.
[0152] like Figure 26 As shown, in Application Example 3, the displacement information includes the amount of external movement representing the deviation between the positions of the machine tool 20 and the robot 30 as measured by the measuring device 50. Here, the measuring device 50 is composed of a laser tracker, a stereo camera, etc.
[0153] In this way, when the external movement is provided based on the measurement results of the external measuring device 50, it is easy to determine whether the external movement should be maintained in the world coordinate system. In such a case, there is no need for the operator to consciously specify the displacement addition node.
[0154] The embodiments of the present invention have been described above, but the control device 10 described above can be implemented by hardware, software, or a combination thereof. Furthermore, the control method performed by the control device 10 described above can also be implemented by hardware, software, or a combination thereof. Here, implementation by software means implementation by reading and executing a program using a computer.
[0155] Programs can be stored and provided to a computer using various types of non-transitory computer-readable media. Non-transitory computer-readable media include various types of tangible storage media. Examples of non-transitory computer-readable media include magnetic recording media (e.g., hard disk drives), optical-magnetic recording media (e.g., optical discs), CD-ROM (Read Only Memory), CD-R, CD-R / W, semiconductor memories (e.g., mask ROM, PROM (Programmable ROM), EPROM (Erasable PROM), flash memory ROM, RAM (random access memory)).
[0156] Furthermore, the above-described embodiments are preferred embodiments of the present invention, but are not limited to the above-described embodiments. The present invention can be implemented in various ways without departing from the spirit of the present invention.
[0157] Explanation of reference numerals in the attached figures
[0158] 1 Control System
[0159] 10 Control Devices
[0160] 20 machine tools
[0161] 30 robots
[0162] 101 Instruction Analysis Department
[0163] 102 Interpolation Section
[0164] 103 Pulse Generation Unit
[0165] 104 Servo Control Unit
[0166] 105 Chart Generation Department
[0167] 106 control point coordinate system insertion section
[0168] 107 Shift Add Node Designation
[0169] 108 Shift Information Setting Department
[0170] 109 Kinematics Conversion Department.
Claims
1. A control device characterized by comprising: have: The instruction parsing unit parses the instructions of the machining program used to process the workpiece and outputs the parsing results containing the program coordinate values. An interpolation unit performs interpolation processing on the parsing results obtained by the instruction parsing unit to generate movement instructions for each axis of the machine tool and / or robot. A pulse generation unit generates drive pulses for driving each axis based on the movement command; A diagram generation unit that generates diagrams representing the mechanical structure of the machine tool and / or the robot; The shift append node designator designates any node of the graph in order to append shift information containing an externally input external shift amount to a node of the graph. The shift information setting unit sets the shift information based on the shift information, taking into account the position offset and / or posture offset of the specified node; as well as The kinematic conversion unit converts the program coordinate values contained in the movement command into motor coordinate values based on the position offset and / or posture offset set at the node. The displacement information includes the amount of external movement representing the deviation between the positions of the machine tool and the robot as measured by the measuring device. The shift append node designator specifies a node in the world coordinate system in the graph. The displacement information setting unit sets the displacement information for the position offset and / or posture offset of the nodes in the world coordinate system.
2. The control device according to claim 1, characterized in that, The control device further includes a shift information calculation unit, which calculates the shift information including the external movement amount in the program coordinate system. The shift append node designator specifies the node representing the workpiece coordinate system in the diagram. The displacement information setting unit sets the displacement information for the position offset and / or posture offset of the nodes in the workpiece coordinate system.
3. The control device according to claim 1, characterized in that, The displacement information includes the external displacement in the motor coordinate system. The shifting and appending node designator specifies multiple nodes in the diagram that represent the motor coordinate system of each axis. The displacement information setting unit sets the displacement information for the position offset and / or posture offset of the plurality of nodes.
Citation Information
Patent Citations
Setting system for work coordinate system
JP1988308604A
Correcting method for installation error of workpiece and its correcting device
JP1995299697A
Device for controlling machine tool
CN105765473A
Positional information display system
CN110568819A
Numerical controller
CN111791088A
