Robot and CNC integrated system based on MCF technology

Through the integrated system of robots and CNC based on MCF technology, the problem of low efficiency of collaborative work between CNC machine tools and robots and inconsistent programming instructions is solved, seamless integration and efficient collaborative work between robots and CNC machine tools is achieved, and production efficiency and products are improved quality.

CN118915622APending Publication Date: 2024-11-08YIFANG INTELLIGENT CONTROL (SHANGHAI) CNC TECHNOLOGY CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410948883.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-15
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

In the prior art, the collaborative work efficiency of CNC machine tools and robots is low, and the programming instructions are not unified, resulting in independent control algorithms, low degree of integration, and the unification of unified mapping and driving operations cannot be performed.

Method used

The robot and CNC integrated system based on MCF technology, including communication modules, algorithm modules and control modules, realize seamless integration between robots and CNC machine tools through standardized communication protocols and motion control algorithms, and use mapping tables to convert instructions to achieve unified programming instructions for improved compatibility and scalability.

Benefits of technology

It realizes efficient collaborative work between robots and CNC machine tools, simplifies the programming process, improves production efficiency and product quality, and ensures stable operation and efficient processing in complex environments.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118915622A_ABST
    Figure CN118915622A_ABST
Patent Text Reader

Abstract

The invention provides a robot and CNC integrated system based on the MCF technology, and relates to the technical field of program control machine tools, a communication module, an algorithm module and a control module in the system are used for robot control driving, the whole system adopts a MotionControl Framework programming framework developed by an easy party, and through unification and standardization of programming instructions, the system can be used for controlling and driving the robot, so that the system can be applied to the field of computer numerical control (CNC). According to the system, seamless integration between the robot and the CNC machine tool is achieved, control instructions of the CNC machine tool can be converted into control instructions of the robot through a mapping table or a translator, the robot and the CNC machine tool are equivalent in function, the programming process is simplified, the operation difficulty is reduced, the compatibility and expandability of the system are improved, unified and standardized programming instructions are achieved, and the system is suitable for popularization and application. According to the system, the robots of different brands and models can be easily integrated with the CNC machine tool, the flexibility and adaptability of the system are further improved, efficient cooperative work of the robots and the CNC machine tool is achieved through a unified programming instruction, and the production efficiency and the product quality are greatly improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of program-controlled machine tools, in particular to a robot and CNC integrated system based on MCF technology. Background Art

[0002] In many manufacturing scenarios, robots and CNC (computer numerical control) machine tools work independently. CNC can automatically perform various cutting, milling, drilling and other processing operations according to preset programs without human intervention, greatly improving production efficiency. Robots are usually used for loading and unloading, handling, assembly, welding and other processes. Especially in dangerous environments such as handling heavy objects, high temperatures, and toxic substances, the application of robots has brought into play its unique advantages. CNC machine tools are responsible for precise processing tasks, while robots are responsible for handling operations that require flexibility and intelligence. Although robots and CNC machine tools work independently, they often complement each other in the manufacturing process.

[0003] The prior art has the following technical problems when used:

[0004] Problem 1: In the prior art, it often takes a lot of time to complete the collaborative work of CNC machine tools and robots, and the processing efficiency is low;

[0005] The second problem is that the inconsistency in programming instructions between robots and CNC machine tools leads to relatively independent transmission between control algorithms, low level of integration, and inability to perform unified mapping drive operations. Summary of the invention

[0006] Technical issues solved

[0007] In view of the shortcomings of the prior art, the present invention provides a robot and CNC integrated system based on MCF technology, which solves the following problems:

[0008] 1. The CNC machine tool and robot have a long collaboration time and low efficiency;

[0009] 2. The robot and CNC machine tool disagree on programming instructions, resulting in the problem of inability to integrate control.

[0010] Technical Solution

[0011] To achieve the above objectives, the present invention is implemented through the following technical solutions: a robot and CNC integrated system based on MCF technology, the system includes a communication module, an algorithm module and a control module, wherein:

[0012] The communication module interactively transmits information of each module in the system, uses a pre-configured communication protocol, and receives host computer software instructions through a protocol interface. The communication module calls the corresponding function in the robot control module to perform motion control according to the received instructions. The communication module feeds back the status information of the robot to the host computer software, which is monitored and adjusted by the host computer;

[0013] The algorithm module intelligently controls the operation of each module in the system. The algorithm module performs corresponding data calculations according to the motion control function called by the communication module. The algorithm module uses the MCF technology motion control algorithm to perform real-time calculations on the motion trajectory and speed parameters of the robot. The algorithm module adjusts parameters according to actual data and performs self-learning and optimization.

[0014] The control module performs overall instruction logic control and processing on each module in the system. The control module calls the robot motion planning function according to the instructions received by the communication module and the parameters calculated by the algorithm module. The control module sends the final calculated data to the control master station to control the precise movement of the robot. The control module makes the robot's control instruction syntax compatible with the control instructions of the CNC machine tool.

[0015] Preferably, the communication module uses a standard industrial communication protocol, such as one or more of EtherCAT, Profi net, and Modbus, to communicate with CNC machine tools and robots of different brands and models, and the real-time status information of the robot in the communication module includes position, speed, and acceleration.

[0016] Preferably, the algorithm module uses trajectory planning, speed control and acceleration control algorithms in the motion control algorithm to accurately control the motion trajectory and speed of the robot.

[0017] Preferably, the control module establishes a mapping table of CNC machine tool and robot instructions, and the mapping table corresponds the control instructions of the CNC machine tool to the control instructions of the robot one-to-one. When the upper computer software sends the control instructions of the CNC machine tool to the system, the system will automatically convert these instructions into the control instructions of the robot. Conversely, when the system needs to send instructions to the CNC machine tool, it will also perform corresponding syntax conversion.

[0018] Preferably, the algorithm module adopts a B-spline curve method to plan the motion trajectory of the robot, adopts a PID controller to adjust the speed of the robot, and adopts a method of limiting the second-order derivative of the acceleration to control the continuous change of the acceleration of the robot.

[0019] Preferably, the algorithm module monitors the robot's motion state and immediately adjusts the robot's motion trajectory and speed when the robot is about to collide with an obstacle.

[0020] Preferably, the control module uses linear interpolation and circular interpolation instructions to map and drive the CNC machine tool and the robot, and the control module expands the instructions by tool conversion and workpiece grasping.

[0021] Beneficial Effects

[0022] The present invention provides a robot and CNC integrated system based on MCF technology. It has the following beneficial effects:

[0023] 1. The present invention adopts the communication module, algorithm module and control module in the system to control and drive the robot, so that the entire system adopts the Motion Control Framework programming framework self-developed by Yifang. Through the unification and standardization of programming instructions, the system realizes seamless integration between the robot and the CNC machine tool. Through a mapping table or a translator, the control instructions of the CNC machine tool can be converted into the control instructions of the robot, so that the two are functionally equivalent, which not only simplifies the programming process and reduces the difficulty of operation, but also improves the compatibility and scalability of the system. At the same time, this unified and standardized programming instruction makes it easy to integrate robots and CNC machine tools of different brands and models, further improving the flexibility and adaptability of the system. Through unified programming instructions, efficient collaborative work between robots and CNC machine tools is realized, greatly improving production efficiency and product quality.

[0024] 2. The present invention adopts the system to realize efficient and accurate planning of the robot's motion trajectory through advanced trajectory planning algorithms, which not only improves the processing accuracy, but also enables the robot to operate stably in a complex working environment. At the same time, combined with PID and other speed control algorithms, the system can adjust the robot's motion speed in real time to ensure the stability and efficiency of the processing process. This efficient and accurate trajectory planning and motion control greatly improves production efficiency and product quality. BRIEF DESCRIPTION OF THE DRAWINGS

[0025] Figure 1 It is a system structure diagram of the present invention. DETAILED DESCRIPTION

[0026] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention. Specific embodiment one:

[0028] like Figure 1 As shown, the robot and CNC integrated system based on MCF technology includes a communication module, an algorithm module and a control module, among which:

[0029] The communication module transmits information between modules in the system interactively, uses the pre-configured communication protocol, and receives the host computer software instructions through the protocol interface. The communication module calls the corresponding function in the robot control module to perform motion control according to the received instructions. The communication module feeds back the robot's status information to the host computer software, which is monitored and adjusted by the host computer;

[0030] The algorithm module intelligently controls the operation of each module in the system. The algorithm module performs corresponding data calculations based on the motion control function called by the communication module. The algorithm module uses the MCF technology motion control algorithm to perform real-time calculations on the robot's motion trajectory and speed parameters. The algorithm module adjusts parameters based on actual data and performs self-learning and optimization.

[0031] The control module performs overall command logic control and processing on each module in the system. The control module calls the robot motion planning function according to the instructions received by the communication module and the parameters calculated by the algorithm module. The control module sends the final calculated data to the control master station to control the precise movement of the robot. The control module makes the robot's control command syntax compatible with the control commands of the CNC machine tool.

[0032] According to the above system structure, the communication module, algorithm module and control module in the system are used to control and drive the robot, so that the entire system adopts the Motion Control Framework programming framework developed by Yifang. Through the unification and standardization of programming instructions, the system realizes seamless integration between the robot and the CNC machine tool. Through a mapping table or a translator, the control instructions of the CNC machine tool can be converted into the control instructions of the robot, so that the two are functionally equivalent. This not only simplifies the programming process and reduces the difficulty of operation, but also improves the compatibility and scalability of the system. At the same time, this unified and standardized programming instruction makes it easy to integrate robots and CNC machine tools of different brands and models, further improving the flexibility and adaptability of the system. Through unified programming instructions, efficient collaboration between robots and CNC machine tools is achieved, greatly improving production efficiency and product quality. Specific embodiment 2:

[0034] like Figure 1 As shown, according to the content of the specific embodiment 1, the following contents are further disclosed:

[0035] The communication module uses standard industrial communication protocols, such as one or more of EtherCAT, Profinet, and Modbus, to communicate with CNC machine tools and robots of different brands and models. When the communication module receives instructions from the host computer software, it will immediately parse these instructions and call the corresponding robot control function according to the type and content of the instructions. The real-time status information of the robot in the communication module includes position, speed, and acceleration for real-time monitoring and adjustment. Specific embodiment three:

[0037] like Figure 1 As shown, according to the content of the specific embodiment 1, the following contents are further disclosed:

[0038] The algorithm module adopts the trajectory planning, speed control and acceleration control algorithms in the motion control algorithm to accurately control the robot's motion trajectory and speed. The algorithm module uses the B-spline curve method to plan the robot's motion trajectory, uses the PID controller to adjust the robot's speed, and uses the method of limiting the second-order derivative of acceleration to control the continuous change of the robot's acceleration. The algorithm module monitors the robot's motion state and immediately adjusts the robot's motion trajectory and speed when the robot is about to collide with an obstacle.

[0039] The algorithm module uses the B-spline curve method to plan the robot's motion trajectory.

[0040] A B-spline curve is a piecewise polynomial curve defined by a series of control points. n and vector node U = (U0, U1, ...U m ), the B-spline curve C(u) can be expressed as:

[0041]

[0042] in:

[0043] B i,k (u) is the i-th k-order B-spline basis function, defined as follows:

[0044] B i,0 (u) = {1, ifu i ≤u i+1 0, otherwise

[0045]

[0046] in:

[0047] B i,0 (u) is the 0th order B-spline basis function, and the B-spline basis function of any order can be obtained through the recursive relationship.​

[0048] The PID controller is used in the algorithm module to adjust the speed of the robot. The output y(t) of the PID controller is the weighted sum of the proportion, integration and differentiation of the error e(t):

[0049]

[0050] in:

[0051] K p is a proportional function;

[0052] K i is an integral function;

[0053] K d is the differential coefficient;

[0054] e(t) is the error between the set value and the current value.

[0055] The algorithm module controls the continuous change of the robot's acceleration by limiting the second-order derivative of the acceleration. This is achieved by directly considering the jerk limit in the trajectory planning stage, or by dynamically adjusting the acceleration through additional control algorithms.

[0056] The system uses advanced trajectory planning algorithms to achieve efficient and accurate planning of the robot's motion trajectory, which not only improves processing accuracy, but also enables the robot to operate stably in complex working environments. At the same time, combined with speed control algorithms such as PID, the system can adjust the robot's motion speed in real time to ensure the stability and efficiency of the processing process. This efficient and accurate trajectory planning and motion control greatly improves production efficiency and product quality. Specific embodiment four:

[0058] like Figure 1 As shown, according to the content of the specific embodiment 1, the following contents are further disclosed:

[0059] The control module establishes a mapping table of CNC machine tool and robot instructions, and the mapping table corresponds the control instructions of the CNC machine tool to the control instructions of the robot one by one. When the upper computer software sends the control instructions of the CNC machine tool to the system, the system will automatically convert these instructions into the control instructions of the robot. Conversely, when the system needs to send instructions to the CNC machine tool, it will also perform corresponding syntax conversion.

[0060] The control module uses linear interpolation and circular interpolation instructions to map and drive the CNC machine tool and the robot, and the control module expands the instructions by tool conversion and workpiece grasping. The instruction logic processing in the control module uses the logic of the state machine or finite state machine FSM to define the conversion and corresponding operations between different instructions.

[0061] In actual use, the instructions for linear interpolation and circular interpolation in the control module are as follows:

[0062] Linear interpolation instructions are used to control a machine tool or robot to move along a straight line between two or more points. This instruction usually contains the following elements:

[0063] Starting point coordinates: Specifies the coordinate position where the movement starts, X, Y, Z, and possibly other axes such as A, B, C, etc., depending on the configuration of the machine tool or robot;

[0064] End point coordinates: specify the coordinate position where the movement ends;

[0065] Speed: Specifies the speed during the move, which can be a constant speed or a speed that varies according to the path;

[0066] Acceleration / Deceleration: Optional parameter used to control acceleration and deceleration when starting and stopping to ensure smooth movement;

[0067] For example, a linear interpolation instruction may be expressed as: "G01X100Y200Z50F100",

[0068] in:

[0069] G01 means linear interpolation;

[0070] X100Y200Z50 is the end point coordinate;

[0071] F100 is the moving speed, the unit is usually mm / min or inch / min;

[0072] The circular interpolation instruction is used to control the machine tool or robot to move along a circular trajectory between three points. This is usually used in situations where curved motion is required, such as contour processing. The instruction contains the following elements:

[0073] Starting point coordinates: The coordinate position where the arc starts.

[0074] Middle point, center of circle or a point on an arc: According to the specific instruction format, it can be the coordinates of the center of circle or another point on the arc except the starting point and the end point;

[0075] End point coordinates: the coordinate position where the arc ends;

[0076] Arc direction: clockwise CW or counterclockwise CCW;

[0077] Speed, acceleration / deceleration: Same as linear interpolation, used to control the speed and acceleration of movement;

[0078] For example, a circular interpolation instruction based on the center coordinates may be expressed as: "G02 / G03X100Y100I50J0F150",

[0079] in:

[0080] G02 means clockwise circular interpolation, G03 means counterclockwise;

[0081] X100Y100 is the end point coordinate;

[0082] I50J0 is the offset of the center of the circle relative to the starting point,

[0083] I is the X-axis offset;

[0084] J is the Y-axis offset;

[0085] F150 is the moving speed.

[0086] In the CNC machine tool and robot instruction mapping table, these linear interpolation and circular interpolation instructions will be adapted and converted according to the specific machine tool and robot control system to ensure that the two can work together to achieve the predetermined processing or operation tasks. At the same time, the control module may also include other logical processing, such as the state machine FSM to manage the execution order and state transition of instructions, as well as the instruction expansion of functions such as tool conversion and workpiece grasping. Specific embodiment five:

[0088] like Figure 1 As shown, according to the content of the specific embodiment 1, the following contents are further disclosed:

[0089] Generate the corresponding control module based on the above content to establish the CNC machine tool and robot command mapping table instructions, as shown in Table 1 below:

[0090]

[0091]

[0092] Table 1

[0093] The robot instructions such as MOVEJ, MOVEL, CIRCLE, etc., and parameters such as coordinates and speed in the above table are based on assumptions and are not specific to a specific robot brand or model. When actually used, they need to be adjusted according to the specific robot control system.

[0094] CNC machine tool instructions such as G00, G01, G02, G03, M06, M08, M30, etc. are standard CNC programming instructions, but specific parameters such as coordinate values, speeds, etc. will vary according to the actual processing tasks.

[0095] The CNC machine command column in the mapping table shows examples of commands that may be sent by the CNC machine, while the robot command column shows the commands or operations that these commands may correspond to on the robot side.

[0096] For some special functions such as tool change, coolant control, etc., if the robot does not directly support these functions, additional logic or signals may need to be included in the mapping table to process these instructions. For example, coolant control may be achieved by sending signals to external devices.

[0097] The above is a simplified command mapping table example, which shows the control command mapping relationship between the CNC machine tool and the robot in a tabular form. The mapping table in actual application may be more complex and contain more commands and parameters.

[0098] It should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the statement "comprising a reference structure" do not exclude the existence of other identical elements in the process, method, article or device including the elements.

[0099] Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the appended claims and their equivalents.

Claims

1. Robot and CNC integrated system based on MCF technology, Features: The system includes a communication module, an algorithm module and a control module, wherein: The communication module interactively transmits information of each module in the system, uses a pre-configured communication protocol, and receives host computer software instructions through a protocol interface. The communication module calls the corresponding function in the robot control module to perform motion control according to the received instructions. The communication module feeds back the status information of the robot to the host computer software, which is monitored and adjusted by the host computer; The algorithm module intelligently controls the operation of each module in the system. The algorithm module performs corresponding data calculations according to the motion control function called by the communication module. The algorithm module uses the MCF technology motion control algorithm to perform real-time calculations on the motion trajectory and speed parameters of the robot. The algorithm module adjusts parameters according to actual data and performs self-learning and optimization. The control module performs overall instruction logic control and processing on each module in the system. The control module calls the robot motion planning function according to the instructions received by the communication module and the parameters calculated by the algorithm module. The control module sends the final calculated data to the control master station to control the precise movement of the robot. The control module makes the robot's control instruction syntax compatible with the control instructions of the CNC machine tool.

2. The robot and CNC integrated system based on MCF technology according to claim 1, Features: The communication module uses standard industrial communication protocols, such as one or more of EtherCAT, Profinet, and Modbus, to communicate with CNC machine tools and robots of different brands and models. The real-time status information of the robot in the communication module includes position, speed, and acceleration.

3. The robot and CNC integrated system based on MCF technology according to claim 1, Features: The algorithm module uses trajectory planning, speed control and acceleration control algorithms in the motion control algorithm to accurately control the motion trajectory and speed of the robot.

4. The robot and CNC integrated system based on MCF technology according to claim 1, Features: The control module establishes a mapping table of CNC machine tool and robot instructions, and the mapping table corresponds the control instructions of the CNC machine tool to the control instructions of the robot one by one. When the upper computer software sends the control instructions of the CNC machine tool to the system, the system will automatically convert these instructions into control instructions of the robot. Conversely, when the system needs to send instructions to the CNC machine tool, it will also perform corresponding syntax conversion.

5. The robot and CNC integrated system based on MCF technology according to claim 1, Features: The algorithm module adopts the B-spline curve method to plan the motion trajectory of the robot, adopts the PID controller to adjust the speed of the robot, and adopts the method of limiting the second-order derivative of the acceleration to control the continuous change of the acceleration of the robot.

6. The robot and CNC integrated system based on MCF technology according to claim 1, Features: The algorithm module monitors the robot's motion state and immediately adjusts the robot's motion trajectory and speed when the robot is about to collide with an obstacle.

7. The robot and CNC integrated system based on MCF technology according to claim 1, Features: The control module uses linear interpolation and circular interpolation instructions to map and drive the CNC machine tool and the robot, and the control module expands the instructions by using tool conversion and workpiece grasping.