Numerical control device and numerical control system
The numerical control device dynamically adjusts robot load settings based on workpiece changes, addressing the inefficiencies of separate programming and static load settings in existing systems, thereby optimizing robot operation cycle time.
Patent Information
- Application Number
- JP2023515988
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-04-23
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2041-04-23
AI Technical Summary
Existing numerical control systems require separate programming for machine tools and robots, necessitating operator familiarity with both languages, and cannot dynamically adjust robot load settings from the numerical control device, leading to inefficiencies when workpieces change.
A numerical control device that analyzes robot commands, selects and transmits load settings to a robot control device, enabling dynamic switching of robot load settings based on workpiece changes, using inverse dynamics calculations to minimize operation cycle time.
Enables dynamic adjustment of robot load settings from the numerical control device, minimizing operation cycle time and optimizing robot performance even with changing workpieces.
Smart Images

Figure 0007590554000001 
Figure 0007590554000002 
Figure 0007590554000003
Abstract
Description
[Technical field]
[0001] The present disclosure relates to a numerical control device and a numerical control system. [Background technology]
[0002] Generally, the programming languages used for the numerical control programs for controlling machine tools and the robot programs for controlling robots are different, so that in order to link the operation of the machine tool with the operation of the robot, the operator needs to be familiar with both the numerical control programs and the robot programs.
[0003] In recent years, in order to promote automation at machining sites, there has been a demand for a numerical control system that controls the operation of a machine tool that processes a workpiece in conjunction with the operation of a robot installed in the vicinity of the machine tool (see, for example, Patent Document 1). In this numerical control system, the robot is controlled using a numerical control program for the machine tool that is familiar to the user of the machine tool. [Prior art documents] [Patent documents]
[0004] [Patent Document 1] Patent No. 5752179 Summary of the Invention [Problem to be solved by the invention]
[0005] By the way, there is a known technology for changing the workpiece to be processed by using a robot to perform setup. In this technology, the load settings such as the weight of the load, the center of gravity position, and the inertia value are stored in the robot control device, and when controlling each joint angle according to the trajectory plan, the torque required to drive the angle, angular velocity, and angular acceleration of each joint of the robot is calculated by inverse dynamics calculation (Newton-Euler method, etc.), and these are input sequentially to each joint motor as command torque. This compensates for the effect of the load and minimizes the operation cycle time of the robot.
[0006] However, the load setting of the robot must be statically set in advance in the robot program, which means that the robot program cannot be rewritten from the numerical control device, and the load setting of the robot cannot be changed from the numerical control device, which poses the problem that the operation cycle time of the robot cannot be minimized when the workpiece is changed.
[0007] An object of the present disclosure is to provide a numerical control device and a numerical control system that are capable of switching the load setting of a robot from the numerical control device. [Means for solving the problem]
[0008] One aspect of the present disclosure is a numerical control device comprising: an analysis unit that analyzes a numerical control command for a robot in a numerical control program; a robot command signal generation unit that generates a robot command signal to be transmitted to a robot control device in accordance with the numerical control command for the robot analyzed by the analysis unit; a load setting selection unit that selects a load setting to be set for a robot from a plurality of load information in accordance with the numerical control command for the robot analyzed by the analysis unit; and a transmission unit that transmits the load setting selected by the load setting selection unit to a load setting update control unit of the robot control device via the robot command signal generation unit, thereby reflecting the load setting in an inverse dynamics calculation of a torque to be input to the robot. Effect of the Invention
[0009] According to the present disclosure, it is possible to provide a numerical control device and a numerical control system capable of switching the load setting of a robot from the numerical control device. [Brief description of the drawings]
[0010] [Figure 1] FIG. 1 is a schematic diagram of a numerical control system according to an embodiment of the present disclosure. [Diagram 2] FIG. 1 is a functional block diagram of a numerical control device and a robot control device according to an embodiment of the present disclosure. [Diagram 3] FIG. 4 is a diagram illustrating an example of load information. [Figure 4] FIG. 4 is a diagram illustrating an example of load information. [Diagram 5] FIG. 11 is a diagram showing numerical control commands set corresponding to each load setting. [Figure 6] FIG. 13 is a diagram showing a numerical control program for a robot. [Figure 7] FIG. 2 is a sequence diagram showing the flow of signals and information between a numerical control device and a robot control device according to an embodiment of the present disclosure. [Figure 8] FIG. 2 is a diagram showing a numerical control program for a machine tool and a numerical control program for a robot. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0011] Hereinafter, an embodiment of the present disclosure will be described in detail with reference to the drawings.
[0012] FIG. 1 is a schematic diagram of a numerical control system 1 according to an embodiment of the present disclosure.
[0013] The numerical control system 1 includes a numerical control device (CNC) 2 that controls a machine tool 20, and a robot control device 3 that is communicatively connected to the numerical control device 2 and controls a robot 30 provided in the vicinity of the machine tool 20. The numerical control system 1 according to this embodiment controls the operations of the machine tool 20 and the robot 30 in a coordinated manner by using the numerical control device 2 and the robot control device 3 that are communicatively connected to each other.
[0014] The numerical control device 2 generates machine tool command signals which are commands for the machine tool 20 and robot command signals which are commands for the robot 30 in accordance with a predetermined numerical control program, and transmits these machine tool command signals and robot command signals to the machine tool 20 and the robot control device 3. The robot control device 3 controls the operation of the robot 30 in response to the robot command signals transmitted from the numerical control device 2.
[0015] Machine tool 20 machines a workpiece (not shown) in response to a machine tool command signal transmitted from numerical control device 2. Machine tool 20 is, for example, a lathe, a drilling machine, a milling machine, a grinding machine, a laser processing machine, an injection molding machine, or the like, but is not limited to these.
[0016] The robot 30 operates under the control of the robot control device 3, and executes a predetermined task on a workpiece being machined inside a machine tool 20 such as a lathe. The robot 30 is, for example, an articulated robot, and a tool 30b for gripping, machining, and inspecting the workpiece is attached to an arm tip 30a. In the following, the robot 30 will be described as being a six-axis articulated robot, but the number of axes is not limited thereto. In the following, the robot 30 will be described as being a six-axis articulated robot, but the number of axes is not limited thereto.
[0017] FIG. 2 is a functional block diagram of the numerical control device 2 and the robot control device 3 according to an embodiment of the present disclosure.
[0018] The numerical control device 2 and the robot control device 3 are computers each composed of hardware such as a calculation processing means such as a CPU (Central Processing Unit), auxiliary storage means such as an HDD (Hard Disk Drive) or SSD (Solid State Drive) storing various computer programs, main storage means such as a RAM (Random Access Memory) for storing data temporarily required for the calculation processing means to execute the computer programs, operation means such as a keyboard for an operator to perform various operations, and display means such as a display for displaying various information to the operator. The numerical control device 2 and the robot control device 3 are capable of transmitting and receiving various signals to each other, for example, via Ethernet (registered trademark).
[0019] First, a detailed configuration of the numerical control device 2 will be described. With the above hardware configuration, the numerical control device 2 realizes a machine tool control function for controlling the operation of the machine tool 20 and a function for generating a robot command signal for controlling the operation of the control axis of the robot 30. Specifically, in order to realize these functions, the numerical control device 2 includes a load information storage unit 21, a program input unit 22, an analysis unit 23, a load setting selection unit 24, a robot command signal generation unit 25, a data transmission / reception unit 26, and the like.
[0020] The load information storage unit 21 stores load information including the weight, center of gravity position, inertia, etc. of various loads of the robot 30. Such load information is input in advance by an operator and stored in the load information storage unit 21.
[0021] 3 and 4 are diagrams showing an example of load information. The load information is displayed on the display screen of the numerical control device 2. As shown in FIG. 3, for example, a plurality of groups of loads of 50 kg are numbered and stored in the load information storage unit 21. FIG. 4 shows the contents of group 1 displayed when group 1 in FIG. 3 is selected, and the center of gravity position of the load and the inertia value of the load are stored. In this way, the weight, center of gravity position, and inertia are linked for each load and stored in the load information storage unit 21.
[0022] 2, the multiple pieces of load information stored in the load information storage unit 21 are selected by a load setting selection unit 24, which will be described later, as load settings to be set for the robot 30. That is, the load settings for the robot 30 are set based on load information including the weight of the load, the position of the center of gravity of the load, the inertia of the load, and the like.
[0023] The load information storage unit 21 stores the above-mentioned load information corresponding to the workpiece, and the load setting of the robot 30 is set corresponding to each workpiece. The load information storage unit 21 also stores load information of the workpiece before and after processing, i.e., the workpiece before and after processing whose weight, center of gravity position, and inertia have changed due to processing, and the load setting of the robot 30 is set corresponding to the workpiece before and after processing.
[0024] In addition to the load information storage unit 21, the numerical control device 2 according to this embodiment also has a program storage unit, a machine coordinate value storage unit, a robot coordinate value storage unit, and a robot teaching position storage unit, none of which are shown in the figure.
[0025] The program storage unit stores a plurality of numerical control programs created, for example, based on operations by an operator. More specifically, the program storage unit stores a numerical control program that is configured with a plurality of command blocks for the machine tool 20 to control the operation of the machine tool 20, a plurality of command blocks for the robot 30 to control the operation of the robot 30, and the like. The numerical control programs stored in the program storage unit are written in a known programming language for controlling the operation of the machine tool, such as G-code or M-code.
[0026] The machine coordinate value storage unit stores machine coordinate values indicating the positions of various axes of the machine tool 20 operating under the above-mentioned numerical control program (i.e. the positions of the tool post, table, etc. of the machine tool 20). These machine coordinate values are defined in a machine tool coordinate system having as its origin a reference point determined at an arbitrary position on the machine tool or in the vicinity of the machine tool 20. The machine coordinate value storage unit is successively updated by a process not shown in the figures so that the latest values of the machine coordinate values which change successively under the numerical control program are stored.
[0027] The robot coordinate value storage unit stores robot coordinate values indicating the position and posture of a control point (e.g., arm tip 30a of the robot 30) of the robot 30 operating under the control of the robot controller 3, in other words, the position of each control axis of the robot 30. Note that these robot coordinate values are defined under a robot coordinate system different from the machine tool coordinate system as described above. The robot coordinate value storage unit is successively updated by the robot coordinate values acquired from the robot controller 3 by processing not shown in the figures so that the latest values of the robot coordinate values which change successively under the numerical control program are stored.
[0028] The robot teaching position storage unit stores teaching positions such as the start point and end point of the robot 30 input by an operator, specifically, teaching positions of the robot 30 input from a teach pendant or the like, and teaching positions input from a keyboard or the like. The teaching positions of the robot 30 include robot coordinate values indicating the positions of each control axis of the robot 30, and these robot coordinate values are defined under a robot coordinate system different from the machine tool coordinate system.
[0029] Here, the robot coordinate system is a coordinate system whose origin is a reference point determined at an arbitrary position on the robot 30 or in the vicinity of the robot 30. In the following, a case where the robot coordinate system is different from the machine tool coordinate system will be described, but this is not limiting. The robot coordinate system may be made to coincide with the machine tool coordinate system. In other words, the origin and coordinate axis directions of the robot coordinate system may be made to coincide with the origin and coordinate axis directions of the machine tool coordinate system.
[0030] In addition, the robot coordinate system can be switched between two or more coordinate formats with different control axes. More specifically, in the numerical control program, the position and orientation of the control point of the robot 30 can be specified in the Cartesian coordinate format or the coordinate format for each axis.
[0031] In each axis coordinate format, the position and orientation of the control point of the robot 30 is specified by a total of six real coordinate values whose components are the rotation angle values (J1, J2, J3, J4, J5, J6) of the six joints of the robot 30.
[0032] In the Cartesian coordinate format, the position and orientation of the control point of the robot 30 is specified by a total of six real coordinate values, consisting of three coordinate values (X, Y, Z) along three Cartesian coordinate axes and three rotation angle values (A, B, C) around each Cartesian coordinate axis.
[0033] In the case of each axis coordinate system, the rotation angle of each joint of the robot 30 is directly specified, so that the axial arrangement of each arm and wrist of the robot 30 and the number of rotations of the joints that can rotate 360 degrees or more (hereinafter, these are collectively referred to as the "configuration of the robot 30") are uniquely determined. In contrast, in the case of the Cartesian coordinate system, the position and posture of the control point of the robot 30 are specified by six coordinate values (X, Y, Z, A, B, C), so that the configuration of the robot 30 cannot be uniquely determined. Therefore, in the numerical control program for the robot, it is possible to specify the configuration of the robot 30 by a configuration value P, which is an integer value of a predetermined number of digits. Therefore, the position and posture of the control point of the robot 30 and the configuration of the robot 30 are represented by six coordinate values (J1, J2, J3, J4, J5, J6) in the case of each axis coordinate system, and by six coordinate values and one configuration value (X, Y, Z, A, B, C, P) in the case of the Cartesian coordinate system.
[0034] The program input unit 22 reads out the numerical control program from the program storage unit, and sequentially inputs it to the analysis unit 23. In addition, the program input unit 22 reads out the load information of the robot 30 stored in the load information storage unit 21, and inputs it to the analysis unit 23.
[0035] Analysis unit 23 analyzes the command type based on the numerical control program input from program input unit 22 for each command block, and outputs the analysis result to a machine tool control unit (not shown) and to a robot command signal generation unit 25 described below. More specifically, if the command type of the command block is a command for machine tool 20, analysis unit 23 transmits it to the machine tool control unit, and if the command type of the command block is a command for robot 30, analysis unit 23 outputs it to robot command signal generation unit 25.
[0036] A machine tool control unit (not shown) generates a machine tool control signal for controlling the operation of machine tool 20 in accordance with the analysis results sent from analysis unit 23, and inputs the signal to actuators that drive various axes of machine tool 20. Machine tool 20 operates in accordance with the machine tool control signal input from the machine tool control unit, and machines a workpiece (not shown). After controlling the operation of machine tool 20 in accordance with the numerical control program as described above, the machine tool control unit updates the machine coordinate values stored in the machine coordinate value storage unit with the latest machine coordinate values.
[0037] Furthermore, the analysis unit 23 of this embodiment analyzes the command type based on the numerical control program input from the program input unit 22 for each command block, and determines whether or not the command type is a command to select a load setting for the robot 30. When the analysis results in the command type being determined to be a command to select a load setting for the robot 30, the analysis unit 23 notifies the load setting selection unit 24, which will be described later, of the determination result.
[0038] Here, Fig. 5 is a diagram showing numerical control commands set corresponding to each load setting. As shown in Fig. 5, in the numerical control program of this embodiment, numerical control commands corresponding to each load setting are specified by G codes. For example, No. 1 in Fig. 5 is load setting information corresponding to group 1 shown in Figs. 3 and 4, and is specified by G100. In this way, a G code is set for each load setting, and when the analysis unit 23 detects these G codes, it determines that the command type is a selection command for the load setting of the robot 30.
[0039] Returning to Fig. 2, the load setting selection unit 24 reads out the load information of the robot 30 stored in the load information storage unit 21 in response to a notification of the determination result from the analysis unit 23. Specifically, based on a selection command for the load setting of the robot 30 determined by the analysis unit 23, the load setting selection unit 24 reads out load information corresponding to the selection command from among the multiple pieces of load information stored in the load information storage unit 21, and selects it as the load setting to be set in the robot 30. The load setting selection unit 24 notifies the robot command signal generation unit 25, which will be described later, of the selected load setting.
[0040] The robot command signal generating unit 25 generates a robot command signal corresponding to a robot program, among the programs stored in the program storage unit, for a robot program analyzed by the analyzing unit 23 as having a command type of a command block that is a command for the robot 30. The generated robot command signal includes a robot program start command that serves as a trigger for starting the robot program stored in the storage unit 31 on the robot control device 3 side. The robot command signal generating unit 25 outputs the generated robot command signal to the data transmitting / receiving unit 26.
[0041] Furthermore, when the robot command signal generating unit 25 of this embodiment is notified of the load setting selected by the above-mentioned load setting selecting unit 24, it generates a load setting update command signal for instructing to update to the load setting. The robot command signal generating unit 25 outputs the generated load setting update command signal to the data transmitting / receiving unit 26 described later.
[0042] The data transmitter / receiver 26 transmits and receives various commands and data to and from the data transmitter / receiver 32 of the robot control device 3. When a robot command signal is written by the robot command signal generator 25, the data transmitter / receiver 26 outputs the robot command signal to the data transmitter / receiver 32 of the robot control device 3.
[0043] Furthermore, the data transmitter / receiver 26 of this embodiment transmits a load setting update command signal output from the above-mentioned robot command signal generator 25 to the robot controller 3, which will be described later. That is, the data transmitter / receiver 26 transmits the load setting selected by the above-mentioned load setting selector 24 to the robot controller 3 via the robot command signal generator 25. The load setting transmitted to the robot controller 3 is notified to a load setting update control unit 38, which will be described later, and is used for inverse dynamics calculation of the torque to be input to the robot 30.
[0044] Next, a detailed description will be given of the configuration of the robot control device 3. As shown in Fig. 2, the robot control device 3 includes a storage unit 31, a data transmission / reception unit 32, an analysis unit 33, a robot command generation unit 34, a program management unit 35, a trajectory control unit 36, a kinematics control unit 37, a load setting update control unit 38, an inverse dynamics calculation unit 39, a servo control unit 40, etc., in order to control the operation of the robot 30 based on commands transmitted from the numerical control device 2.
[0045] The data transmitter / receiver 32 receives the robot command signal transmitted from the data transmitter / receiver 26 of the numerical control device 2. The data transmitter / receiver 32 outputs the received robot command signal to the analyzer 33 in sequence.
[0046] Moreover, the data transmitter / receiver 32 of this embodiment receives the load setting selected by the above-mentioned load setting selection unit 24 and transmitted from the data transmitter / receiver 26 of the numerical control device 2. The received load setting is notified to an analysis unit 33, which will be described later.
[0047] The analysis unit 33 analyzes the robot command signal input from the data transmission / reception unit 32. The analysis unit 33 outputs the analysis result to a robot command generation unit 34 described later.
[0048] Furthermore, when a load setting update command is detected, the analysis unit 33 of this embodiment notifies a load setting update control unit 38 (described later) of load setting information.
[0049] When the load setting update control unit 38 detects a load setting update command and is notified of load setting information by the above-mentioned analysis unit 33, the load setting update control unit 38 executes an update to the notified load setting. In addition, the load setting update control unit 38 notifies the updated load setting to the inverse dynamics calculation unit 39 described later.
[0050] The inverse dynamics calculation unit 39 calculates the torque to be input to the robot 30 by inverse dynamics calculation based on the load setting updated and notified by the above-mentioned load setting update control unit 38. The inverse dynamics calculation unit 39 outputs the torque obtained by calculation to the servo control unit 40 described later.
[0051] Here, the inverse dynamics calculation of the robot 30 is a method of calculating the input torque to each motor to realize such a response, taking into consideration the hand load, gravity, and the robot's own weight acting on the robot 30, based on the desired motion (time-series data of the position, speed, and acceleration of each joint) calculated in the motion trajectory plan of the robot 30. Numerical calculation methods such as the calculated torque method and the Newton-Euler method have been disclosed as methods relating to such inverse dynamics calculation (for example, JP-A-8-118275 and JP-A-2015-58520).
[0052] The robot command generation unit 34 generates a robot command corresponding to the robot command signal based on the analysis result of the robot command signal input from the analysis unit 33. The robot command generation unit 34 outputs the generated robot command to the program management unit 35.
[0053] When the program management unit 35 receives the robot commands from the robot command generation unit 34, it executes them one by one to generate an operation plan for the robot 30 in accordance with the robot command signal, and outputs the operation plan to the trajectory control unit 36.
[0054] Furthermore, when the robot command input from the robot command generation unit 34 is a block robot command, the program management unit 35 adds the input block robot command to the robot program stored in the storage unit 31. As a result, a robot program corresponding to the robot command signal transmitted from the numerical control device 2 is generated and stored in the storage unit 31. The stored robot program is started and played back when the program management unit 35 receives a robot program start command as a robot command.
[0055] When the motion plan is input from the program management unit 35 , the trajectory control unit 36 calculates time-series data of the control points of the robot 30 and outputs it to the kinematics control unit 37 .
[0056] The kinematics control unit 37 calculates the target angle of each joint of the robot 30 by inverse kinematics calculation based on the input time series data, and outputs it to the servo control unit 40. Here, the inverse kinematics calculation of the robot 30 is a method of calculating the angle of each joint from the hand position and posture of the robot 30.
[0057] The servo control unit 40 generates robot control signals for the robot 30 by feedback controlling each servo motor of the robot 30 so as to realize the target angle input from the kinematics control unit 37 , and inputs the signals to the servo motors of the robot 30 .
[0058] Moreover, the servo control unit 40 of this embodiment generates a robot control signal that reflects the torque calculated by the above-mentioned inverse dynamics calculation unit 39. This makes it possible to control the robot 30 based on the updated load setting.
[0059] Next, the flow of various signals and information in the numerical control system 1 configured as above will be described with reference to Fig. 6 and Fig. 7. Specifically, the flow of switching to the load setting set according to the work will be described.
[0060] Fig. 6 is a diagram showing a robot numerical control program. Fig. 7 is a sequence diagram showing the flow of signals and information between the numerical control device 2 and the robot control device 3 according to this embodiment.
[0061] First, since the position of the robot 30 is unknown, "G68.8" is input, and each axis coordinate system is selected, which does not require consideration of kinematics. When "G7.3 J1=_J2=_J3=_J4=_J5=_J6=_" is commanded, the robot controller 3 positions the robot 30 at the specified position on each axis coordinate system. Note that the coordinate value of the specified position of the robot 30 is input in the underscore part in the command.
[0062] Next, "G68.9" is commanded and the Cartesian coordinate system is selected. When "G01 X_Y_Z_A_B_C_P_" is commanded, the robot controller 3 moves the robot 30 in a straight line to a specified position (work position) on the Cartesian coordinate system and positions it. Note that the coordinate value of the specified position of the robot 30 is input in the underscore part in the command.
[0063] Next, "M100" is commanded, and the robot controller 3 closes the hand of the robot 30 to grip the workpiece 1. After that, the above-mentioned G-code "G100" is commanded, and the load setting 1 corresponding to the gripped workpiece 1, which was previously stored in the load information storage unit 21, is selected. The selected load setting 1 is transmitted to the robot controller 3, and the load setting update control unit 38 updates the load setting that had been set up until then to the newly notified load setting 1. Then, the inverse dynamics calculation unit 39 performs inverse dynamics calculation based on the updated load setting 1, and the robot 30 is controlled according to the robot control command that reflects the calculated input torque.
[0064] Next, switching from load setting 1 to load setting 2 is executed. First, "G68.8" is commanded to select each axis coordinate system. When "G7.3 J1=_J2=_J3=_J4=_J5=_J6=_" is commanded, the robot controller 3 positions the robot 30 at a specified position on each axis coordinate system.
[0065] Next, "G68.9" is commanded to select the Cartesian coordinate system. When "G01 X_Y_Z_A_B_C_P_" is commanded, the robot controller 3 moves the robot 30 in a straight line to a specified position (work position) on the Cartesian coordinate system and positions it.
[0066] Next, an "M100" command is issued, and the robot controller 3 closes the hands of the robot 30 to grip the workpiece 2. After that, an "G101" command is issued, and the load setting 2 corresponding to the gripped workpiece 2, which has been stored in advance in the load information storage unit 21, is selected. The selected load setting 2 is transmitted to the robot controller 3, and the load setting update control unit 38 updates the load setting 1 that had been set up until then to the newly notified load setting 2. Then, the inverse dynamics calculation unit 39 performs an inverse dynamics calculation based on the updated load setting 2, and the robot 30 is controlled according to the robot control command that reflects the calculated input torque.
[0067] As described above, in the numerical control system 1 according to this embodiment, the load setting of the robot 30 can be switched according to the workpiece by a numerical control command from the numerical control device 2 side.
[0068] Next, the flow of switching to the load setting that is set according to the workpiece before and after machining will be described with reference to FIG.
[0069] Fig. 8 is a diagram showing a numerical control program for a machine tool and a numerical control program for a robot, in which the numerical control program for the machine tool is shown on the left side, and the numerical control program for the robot corresponding to the numerical control program for the machine tool is shown side by side on the right side.
[0070] First, in the numerical control program for the robot, "G68.9", "G01 X_Y_Z_A_B_C_P_", "M101", and "G101" are commanded in sequence, whereby the robot control device 3 moves the robot 30 in a straight line to a specified position (work position) on the Cartesian coordinate system and positions it, then closes the hand of the robot 30 to grasp the work 1, and the load setting of the robot 30 is switched to load setting 2 (work 1 before machining).
[0071] Next, in the numerical control program for the robot, "M200 (door open)", "G01 X_Y_Z_A_B_C_P_; (entry)", "G01 X_Y_Z_A_B_C_P_; (pre-chuck position)", "M210 (chuck open)", "G01 X_Y_Z_A_B_C_P_; (chuck position)", "M211 (chuck close)", "M100 (hand open)", and "G100" are sequentially commanded to load workpiece 1 onto the machine tool 20, and after loading, the load setting of the robot 30 is switched to load setting 1 (no load).
[0072] Thereafter, in the robot numerical control program, "G01 X_Y_Z_A_B_C_P_; (evacuate outside the machine)" and "M201 (close door)" are input in sequence, and the robot 30 is evacuated outside the machine tool 20. At this time, in the machine tool numerical control program, "M300" is commanded, and the robot 30 waits for completion of loading, and also in the robot numerical control program, "M300" is commanded, and the robot waits for the machine tool 20.
[0073] Next, in the numerical control program for the machine tool, "G00 X_Y_Z_", "S1000", and "G01 X_Y_Z_F4000" are commanded in sequence, and the loaded workpiece 1 is machined. After machining is completed, "G00 X_Y_Z_", "M301", "M302", and "M30" are commanded in sequence, the axis is retracted to the robot entry position, and awaiting the robot 30 and the completion of unloading is performed, and the program is terminated.
[0074] On the other hand, in the robot numerical control program, "M301" is also commanded, and the completion of processing is waited for. After the processing is completed, "M200 (door open)", "G01 X_Y_Z_A_B_C_P_; (enter)", "G01 X_Y_Z_A_B_C_P_; (chuck position)", "M101 (hand close)", and "G102" are commanded in sequence, so that the processed workpiece 1 is unloaded, and the load setting of the robot 30 is switched to load setting 3 (processed workpiece 1). After that, "M210 (chuck open)", "G01 X_Y_Z_A_B_C_P_; (evacuate outside the machine)", "M201 (door close)", "M302", and "M30" are commanded in sequence, and the program is terminated.
[0075] As described above, in the numerical control system 1 according to this embodiment, it is possible to switch the load setting of the robot 30 according to the workpiece before and after machining, by a numerical control command from the numerical control device 2 side.
[0076] According to this embodiment, the following effects are achieved.
[0077] The numerical control device 2 according to this embodiment is configured to include a load setting selection unit 24 that selects a load setting to be set for the robot 30 from a plurality of load information in accordance with the robot numerical control command analyzed by the analysis unit 23. The numerical control device 2 according to this embodiment is also configured to include a data transmission / reception unit 26 that transmits the load setting selected by the load setting selection unit 24 to a load setting update control unit 38 of the robot control device 3 via a robot command signal generation unit 25, thereby reflecting the load setting in the inverse dynamics calculation of the torque to be input to the robot 30.
[0078] This allows the load setting of the robot 30 to be dynamically changed from the numerical control program, so that the load setting of the robot 30 can be automatically switched from the numerical control device 2. Therefore, even if the workpiece is changed while the program of the machine tool 20 is running, the load setting of the robot 30 can be automatically switched from the numerical control device 2, and the operation cycle time of the robot 30 can be minimized.
[0079] Furthermore, in the numerical control device 2 according to this embodiment, the load is set based on load information including the weight of the load, the center of gravity of the load, and the inertia of the load. The load can be set according to the workpiece, and can also be set according to the workpiece before and after machining. This allows for more optimal load setting, and more reliably minimizes the operation cycle time of the robot 30.
[0080] Moreover, according to the numerical control system 1 according to this embodiment including the numerical control device 2 as described above, the same effects as those described above can be achieved.
[0081] The present disclosure is not limited to the above-described embodiment, and various modifications and variations are possible.
[0082] For example, in the above embodiment, the load information storage unit 21 for storing the load information such as the weight of the load, the position of the center of gravity of the load, and the inertia of the load is provided in the numerical control device, but is not limited to this. The load information storage unit for storing the load information may be provided in the robot control device 3, an external device, etc. [Explanation of symbols]
[0083] 1. Numerical control system 2. Numerical control device 3 Robot control device 20 Machine tools 21 Load information storage section 22 Program Input Section 23 Analysis Department 24 Load setting selection section 25 Robot command signal generator 26 Data transmission / reception unit (transmission unit) 30. Robot 31 Storage section 32 Data transmission / reception unit (reception unit) 33 Analysis Department 34 Robot command generator 35 Program Management Division 36 Trajectory control section 37 Kinematics Control Unit 38 Load setting update control section 39 Inverse dynamics calculation section 40 Servo control unit
Claims
1. an analysis unit that analyzes a robot numerical control command in a numerical control program; a robot command signal generation unit that generates a robot command signal to be transmitted to a robot control device in response to the robot numerical control command analyzed by the analysis unit; a load setting selection unit that selects a load setting to be set on the robot from a plurality of load information in response to the robot numerical control command analyzed by the analysis unit; a transmission unit that transmits the load setting selected by the load setting selection unit to a load setting update control unit of the robot control device via the robot command signal generation unit, thereby reflecting the load setting in an inverse dynamics calculation of a torque to be input to the robot.
2. The numerical control device according to claim 1 , wherein the load setting is set based on load information including a weight of the load, a center of gravity position of the load, and an inertia of the load.
3. The numerical control device according to claim 1 , wherein the load setting is set in accordance with a workpiece.
4. 4. The numerical control device according to claim 1, wherein the load setting is set in accordance with a workpiece before and after machining.
5. A numerical control device according to any one of claims 1 to 4 and a robot control device, The robot control device includes: a receiving unit that receives the load setting selected by the load setting selection unit and transmitted from the transmitting unit; a load setting update control unit that updates the load setting to the load setting received by the receiving unit; an inverse dynamics calculation unit that calculates a torque to be input to the robot by inverse dynamics calculation based on the load setting updated by the load setting update control unit.
Citation Information
Patent Citations
Photoconductive member
JP1982052179A
Robot control device
JP2006263916A
Robot arm control device, robot arm control method, and program
JP2017213631A
