Robot motion control simulation method, device and system

By generating simulation instructions and motion control models, the problems of poor simulation flexibility of robot motion control and difficulty in multi-axis control in the prior art are solved, and flexible and accurate motion control of multi-axis robots are achieved.

CN118938711APending Publication Date: 2024-11-12BEIJING RUNKE GENERAL TECH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411195616.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-28
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

The existing robot motion control simulation technology has poor flexibility, making it difficult to realize multi-axis robot motion control, and requires the replacement of different types of PLCs for simulation.

Method used

By generating simulation instructions for robot motion control, a pre-deployed motion control model is used to generate robot control signals, and multiple motor control signals are determined based on the signal, independent driving control of multiple motors is realized, and different types of robots are adapted to without any need to Replace hardware.

Benefits of technology

It improves the flexibility of robot motion control simulation, realizes accurate motion control of multi-axis robots, and simplifies the simulation process.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938711A_ABST
    Figure CN118938711A_ABST
Patent Text Reader

Abstract

The invention provides a robot motion control simulation method, device and system. The method comprises the following steps: generating a simulation instruction for performing motion control simulation on a robot; generating a robot control signal corresponding to the simulation instruction through a pre-deployed motion control model; determining a plurality of motor control signals according to the robot control signal; the plurality of motor control signals are in one-to-one correspondence with motors of the robot; and sending each motor control signal to a driver of the corresponding motor so as to drive the motor to perform motion control on the robot. According to the method, in the motion control simulation process of the robot, the motion control model is applied to generate the control signal, motion control mechanisms of different robots can be adapted through change of the motion control model, and the simulation flexibility is high. Secondly, each motor is driven based on the corresponding motor control signal, and motion control over the multi-axis robot can be achieved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of robot simulation, and in particular to a robot motion control simulation method, device and system. Background Art

[0002] In the process of robot development, it is usually necessary to simulate the motion control of the robot. In the related technologies of robot motion control simulation, the programmable logic controller (PLC) is mainly used to realize the motion control of the robot.

[0003] When applying relevant technologies to perform motion control simulation on robots in real scenarios, if motion control simulation is required for different types of robots, it is usually necessary to replace different types of PLCs for motion control, and only a single motor can be driven during the motion control process, which makes the motion control simulation less flexible and difficult to perform motion control on multi-axis robots. Summary of the invention

[0004] In view of this, an embodiment of the present invention provides a robot motion control simulation method, device and system to solve the problems of related robot motion control simulation methods, such as poor simulation flexibility and difficulty in achieving multi-axis control.

[0005] To achieve the above objectives, the embodiments of the present invention provide the following technical solutions:

[0006] A robot motion control simulation method, comprising:

[0007] generating simulation instructions for simulating motion control of the robot;

[0008] Generate a robot control signal corresponding to the simulation instruction through a pre-deployed motion control model;

[0009] Determine a plurality of motor control signals according to the robot control signal; the plurality of motor control signals correspond one to one to each motor of the robot;

[0010] Each motor control signal is sent to a driver of a corresponding motor to drive the motor to control the motion of the robot.

[0011] The above robot motion control simulation method may optionally further include:

[0012] Receiving the operating data of each of the motors; the operating data of each of the motors is collected in real time by a sensor corresponding to the motor;

[0013] Determine the actual torque corresponding to each of the motors based on the operating data of each of the motors;

[0014] Determining the desired torque corresponding to each of the motors;

[0015] For each of the motors, the desired torque and the actual torque corresponding to the motor are input into a pre-built torque model, and the control parameters output by the torque model are obtained as feedback control parameters corresponding to the motor;

[0016] Based on the feedback control parameters corresponding to each of the motors, generating a feedback control signal corresponding to each of the motors;

[0017] Each feedback control signal is sent to a driver of a corresponding motor to perform torque closed-loop control on the motor.

[0018] The above robot motion control simulation method may optionally further include:

[0019] Receiving the operating data of each of the motors; the operating data of each of the motors is collected in real time by a sensor corresponding to the motor;

[0020] Analyze the operation data of each motor to obtain the motion parameters of each motion axis of the robot;

[0021] Based on the motion parameters of each of the motion axes and the pre-constructed trajectory planning equation, a motion trajectory corresponding to the robot is generated and the motion trajectory is displayed.

[0022] The above robot motion control simulation method, optionally, generating the motion trajectory corresponding to the robot based on the motion parameters of each of the motion axes and the pre-constructed trajectory planning equation, comprises:

[0023] Performing parameter verification on the motion parameters of each of the motion axes;

[0024] If the motion parameters of each of the motion axes pass the parameter verification, then based on the preset motion axis association relationship, the motion parameters of each of the motion axes are combined to obtain a kinematic parameter set corresponding to the robot;

[0025] Inputting the kinematic parameter set into the trajectory planning equation to solve the kinematics forward solution of the robot through the trajectory planning equation to obtain the position and posture data corresponding to the end effector of the robot;

[0026] Draw a trajectory corresponding to the posture data, and use the trajectory corresponding to the posture data as the motion trajectory.

[0027] The above robot motion control simulation method may optionally further include:

[0028] According to the motion parameters of each of the motion axes, a pre-constructed three-dimensional model of the robot is subjected to motion simulation to obtain a robot simulation animation; the three-dimensional model of the robot is a three-dimensional model constructed based on the structure of the robot;

[0029] The robot simulation animation is displayed.

[0030] A robot motion control simulation device, comprising:

[0031] A first generating unit, used to generate a simulation instruction for performing motion control simulation on the robot;

[0032] A second generating unit, configured to generate a robot control signal corresponding to the simulation instruction through a pre-deployed motion control model;

[0033] A third generating unit is used to determine a plurality of motor control signals according to the robot control signal; the plurality of motor control signals correspond one to one with each motor of the robot;

[0034] The signal sending unit is used to send each of the motor control signals to the driver of its corresponding motor, so as to drive the motor to control the motion of the robot.

[0035] A robot motion control simulation system, comprising:

[0036] A main control terminal, wherein a host computer system is deployed in the main control terminal;

[0037] A real-time simulation controller, in which a motion control model corresponding to the robot to be simulated is deployed; the real-time simulation controller is in communication connection with the main control end; the host computer system is configured to generate a simulation instruction for simulating motion control of the robot, and send the simulation instruction to the real-time simulation controller;

[0038] a first programmable logic controller, the first programmable logic controller being communicatively connected to the real-time simulation controller; the real-time simulation controller being configured to, upon receiving the simulation instruction, generate a robot control signal corresponding to the simulation instruction through the motion control model, and send the robot control signal to the first programmable logic controller;

[0039] A plurality of second programmable logic controllers, each of which corresponds to each motor of the robot; the first programmable logic controller is respectively connected to each of the second programmable logic controllers in communication, and each of the second programmable logic controllers is connected to a driver of the corresponding motor;

[0040] The first programmable logic controller is configured to determine a motor control signal corresponding to each of the motors according to the robot control signal, and send each of the motor control signals to a second programmable logic controller corresponding to the corresponding motor;

[0041] Each of the second programmable logic controllers is configured to, upon receiving a motor control signal corresponding to its corresponding motor, send the motor control signal to the driver of the motor corresponding to the second programmable logic controller, so as to drive the motor to control the motion of the robot.

[0042] The above robot motion control simulation system, optionally, a sensor corresponding to each of the motors is deployed in the robot;

[0043] Each of the sensors is configured to collect operating data of the motor corresponding to the sensor in real time, and send the operating data to a second programmable logic controller corresponding to the motor;

[0044] Each of the second programmable logic controllers is further configured to send the operation data of the motor corresponding to the second programmable logic controller to the first programmable logic controller;

[0045] The first programmable logic controller is further configured to send the operation data of each of the motors to the real-time simulation controller;

[0046] The real-time simulation controller is further configured to determine the actual torque corresponding to each of the motors based on the operation data of each of the motors; determine the expected torque corresponding to each of the motors; for each of the motors, input the expected torque and actual torque corresponding to the motor into a pre-built torque model, and obtain the control parameters output by the torque model as the feedback control parameters corresponding to the motor; based on the feedback control parameters corresponding to each of the motors, generate a feedback control signal corresponding to each of the motors, send the feedback control signal corresponding to each of the motors to the first programmable logic controller, and send the operation data of each of the motors to the host computer system;

[0047] The first programmable logic controller is further configured to send the feedback control signal corresponding to each motor to the second programmable logic controller corresponding to the corresponding motor when receiving the feedback control signal corresponding to each motor;

[0048] Each of the second programmable logic controllers is also configured to, upon receiving a feedback control signal corresponding to the corresponding motor, send the feedback control signal to the driver of the motor corresponding to the second programmable logic controller, so as to perform torque closed-loop control on the motor.

[0049] The above-mentioned robot motion control simulation system, optionally, the host computer system is also configured to parse the operating data of each of the motors, obtain the motion parameters of each motion axis of the robot, and generate the corresponding motion trajectory of the robot based on the motion parameters of each motion axis and the pre-constructed trajectory planning equation, and display the motion trajectory.

[0050] The robot motion control simulation system mentioned above, optionally, the main control end is also deployed with a three-dimensional simulation system, and the host computer system and the three-dimensional simulation system are in a joint simulation mode;

[0051] The three-dimensional simulation system is configured to perform motion simulation on a pre-constructed three-dimensional robot model according to the motion parameters of each of the motion axes, obtain a robot simulation animation, and display the robot simulation animation; the robot three-dimensional model is a three-dimensional model constructed based on the structure of the robot.

[0052] A robot motion control simulation method based on the above-mentioned embodiment of the present invention includes: generating a simulation instruction for simulating motion control of the robot; generating a robot control signal corresponding to the simulation instruction through a pre-deployed motion control model; determining multiple motor control signals according to the robot control signal; the multiple motor control signals correspond to each motor of the robot one by one; sending each motor control signal to the driver of its corresponding motor to drive the motor to control the robot motion. By applying the method provided by the embodiment of the present invention, a control signal can be generated by the motion control model deployed in the simulation platform. When simulating different types of robots, only an adapted motion control model needs to be deployed, and there is no need to replace the hardware equipment, which is conducive to improving the flexibility of the simulation. Secondly, in the method provided by the embodiment of the present invention, the motor control signal corresponding to each motor of the robot is further determined based on the robot control signal, and the drive control of multiple motors is realized through each motor control signal, so that the motion control simulation of the multi-axis robot can be realized. BRIEF DESCRIPTION OF THE DRAWINGS

[0053] In order to more clearly illustrate the technical solutions in the embodiments of the present invention or related technologies, the drawings required for use in the embodiments or related technical descriptions are briefly introduced below. Obviously, the drawings described below are only embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on the provided drawings without paying creative work.

[0054] Figure 1 A method flow chart of a robot motion control simulation method provided by an embodiment of the present invention;

[0055] Figure 2A schematic diagram of the structure of a robot motion control simulation device provided by an embodiment of the present invention;

[0056] Figure 3 A schematic diagram of the architecture of a robot motion control simulation system provided by an embodiment of the present invention;

[0057] Figure 4 A schematic diagram of the system framework of a robot motion control simulation system provided by an embodiment of the present invention;

[0058] Figure 5 A schematic diagram of data flow of a robot motion control simulation system provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0059] 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.

[0060] In this application, the terms "comprises", "comprising" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device comprising 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, an element defined by the sentence "comprising a ..." does not exclude the presence of other identical elements in the process, method, article or device comprising the element.

[0061] With the development of artificial intelligence technology, robots have become one of the common devices in various fields. In the process of robot research and development, it is usually necessary to simulate the robot's motion control process to test the robot's performance. In the motion control simulation process, reliable motion control of the robot is one of the key operations to ensure the accuracy of the simulation results.

[0062] The inventor has found through research that in the relevant technologies of robot motion control simulation, motion control simulation is mainly realized based on PLC control technology. Usually, a PLC is used as a host computer, a PLC control system is deployed, and the motion control logic for the robot is realized through the motion control module inside the PLC. During the simulation process, the motion control module in the PLC generates a motion control signal, and sends the control signal to the motor controlled by the PLC to control the robot. The motion control module in the PLC is a pre-integrated module, and the control method used is fixed and cannot be modified, that is, a PLC is only adapted to one type of motion control algorithm. However, in actual application scenarios, the robot's motion form, function, etc. are diverse, and different types of robots are often controlled by different motion control algorithms. When applying related technologies to simulate different types of robots, it is necessary to select a PLC deployment control system corresponding to the current robot's motion control algorithm, and it is often necessary to replace different types of PLCs for control simulation, which makes the simulation less flexible. On the other hand, multi-axis robots are becoming more and more popular in real scenarios, and the demand for motion control simulation of multi-axis robots is also increasing. In the related technologies of motion control simulation, a PLC is used as the host computer to directly control the motor, and a single PLC can usually only control a single motor. However, a multi-axis robot is a robot driven by multiple motors. It is difficult to accurately control the motion of a multi-axis robot using related technologies.

[0063] Therefore, the present invention provides a robot motion control simulation technology. During the simulation process, the motion control logic for the robot is carried by the motion control model, the robot control signal is obtained based on the processing of the motion control model, and the control signal for each motor of the robot is obtained by decoupling the robot control signal, so that independent drive control is performed for each motor. Various types of motion control algorithms can be flexibly adapted by adjusting the motion control model, which can improve the simulation flexibility. By decoupling the robot control signal and performing drive control on each motor respectively, multiple motors can be accurately controlled, and motion control simulation for a multi-axis robot can be realized.

[0064] The embodiment of the present invention provides a robot motion control simulation method, which can be applied to a simulation platform set up to realize robot motion control simulation, and its execution subject can be a processor in the simulation platform. The method flow chart of the method is as follows: Figure 1 As shown, including:

[0065] S101: generating a simulation instruction for performing motion control simulation on a robot;

[0066] In the method provided by the embodiment of the present invention, when the user needs to perform motion control simulation on the robot, the user can input simulation parameters through the front end of the simulation platform, submit the simulation parameters, and trigger the motion control simulation process of the robot. In response to the user's triggering operation, the simulation platform can obtain the simulation parameters input by the user, and generate simulation instructions for performing motion control simulation on the robot based on the simulation parameters.

[0067] S102: Generate a robot control signal corresponding to the simulation instruction through a pre-deployed motion control model;

[0068] In the method provided by the embodiment of the present invention, a motion control model is pre-deployed in the simulation platform, and the motion control model is designed according to the motion control algorithm of the robot to be simulated. The motion control model can be an algorithm model of multi-axis motion control, which can be constructed by coupling multiple axis motion algorithms. The motion control model can output corresponding control signals according to corresponding control input parameters, and the control signal includes control signal data for each axis, that is, control signal data for each motor.

[0069] The simulation platform responds to the instructions of the simulation instructions, can extract the input parameters required for the simulation from the simulation instructions, and import the simulation input parameters into the motion control model. After being processed by the motion control model, it can output corresponding control signal data, and use the control signal data output by the motion control model as the signal data of the robot control signal to generate the robot control signal.

[0070] S103: determining a plurality of motor control signals according to the robot control signal; the plurality of motor control signals correspond one-to-one to each motor of the robot;

[0071] In the method provided in the embodiment of the present invention, a plurality of motors are deployed in the robot to drive the robot, and a driver corresponding to each motor is also deployed in the robot, and each driver is connected to the corresponding motor in communication to control and drive the motor. Specifically, a frequency converter can be used as the driver of the motor.

[0072] The simulation platform can obtain control data for each motor in the simulation based on the robot control signal analysis, and generate a motor control signal corresponding to each motor based on the control data for each motor.

[0073] S104: Send each of the motor control signals to a driver of its corresponding motor to drive the motor to perform motion control on the robot.

[0074] In the method provided by the embodiment of the present invention, the simulation platform can send each motor control signal to the driver of the motor corresponding to the motor control signal through a pre-established communication link to drive each motor and then drive the robot to achieve motion control simulation of the robot.

[0075] Based on the method provided by the embodiment of the present invention, when it is necessary to simulate the motion control of the robot, a simulation instruction for simulating the motion control of the robot is generated; a robot control signal corresponding to the simulation instruction is generated through a pre-deployed motion control model; a plurality of motor control signals are determined according to the robot control signal; the plurality of motor control signals correspond to each motor of the robot one by one; each motor control signal is sent to the driver of its corresponding motor to drive the motor to control the motion of the robot. By applying the method provided by the embodiment of the present invention, a control signal can be generated by the motion control model deployed in the simulation platform. When simulating different types of robots, only an adapted motion control model needs to be deployed, and there is no need to replace the hardware equipment, which is conducive to improving the flexibility of the simulation. Secondly, in the method provided by the embodiment of the present invention, the motor control signal corresponding to each motor of the robot is further determined based on the robot control signal, and the drive control of multiple motors is realized through each motor control signal, so that the motion control simulation of the multi-axis robot can be realized.

[0076] exist Figure 1 On the basis of the method shown, the method provided in the embodiment of the present invention further includes:

[0077] Receiving the operating data of each of the motors; the operating data of each of the motors is collected in real time by a sensor corresponding to the motor;

[0078] In the method provided by the embodiment of the present invention, a plurality of high-precision sensors are deployed in the robot for simulation, and each sensor corresponds to each motor driving the robot. During the simulation process, the sensor corresponding to each motor of the robot will collect the operation data of the corresponding motor in real time, such as the torque, speed, motion position and other data of the motor. The motor operation data collected by each sensor can be fed back to the simulation platform through a pre-built communication link. The simulation platform receives the operation data of each motor collected by each sensor through the built communication link.

[0079] Determine the actual torque corresponding to each of the motors based on the operating data of each of the motors;

[0080] In the method provided by the embodiment of the present invention, after receiving the operating data of each motor, the simulation platform can obtain various parameters associated with torque calculation from the operating data of each motor, and calculate the current actual torque of the motor based on these parameters.

[0081] Determining the desired torque corresponding to each of the motors;

[0082] In the method provided in the embodiment of the present invention, for each motor, the expected torque of the motor during the simulation process, that is, the torque under ideal conditions, can be calculated based on the control parameters in the motor control signal currently corresponding to the motor.

[0083] For each of the motors, the desired torque and the actual torque corresponding to the motor are input into a pre-built torque model, and the control parameters output by the torque model are obtained as feedback control parameters corresponding to the motor;

[0084] In the method provided by the embodiment of the present invention, a torque model is pre-built in the simulation platform, and the torque model can be integrated into the motion control model or deployed independently. The torque model can perform motion feedback control based on the torque of the motor in the ideal state and the torque generated in the actual simulation on the motion control mechanism of the motion control model, and output corresponding feedback control parameters.

[0085] During the simulation process, the simulation platform can implement torque closed-loop control based on the operating data of each motor. Specifically, for each motor, the current expected torque of the motor and the actual torque of the motor can be loaded into the torque model. After being processed by the torque model, the control parameters output by the torque model are obtained and used as the feedback control parameters corresponding to the motor.

[0086] Based on the feedback control parameters corresponding to each of the motors, generating a feedback control signal corresponding to each of the motors;

[0087] In the method provided by the embodiment of the present invention, the simulation platform may use the feedback control parameters corresponding to each motor as the control data of the control signal, thereby generating a feedback control signal corresponding to each motor.

[0088] Each feedback control signal is sent to a driver of a corresponding motor to perform torque closed-loop control on the motor.

[0089] In the method provided by an embodiment of the present invention, the simulation platform can send the feedback control signal corresponding to each motor to the driver of the corresponding motor through a pre-established communication link, so that the driver of the corresponding motor drives the motor based on the feedback control signal to achieve torque closed-loop control of the motor.

[0090] Based on the method provided in the embodiment of the present invention, the operation data of the motor can be collected in real time through a high-precision sensor, and the torque closed-loop control can be implemented using the real-time collected motor operation data, which is beneficial to improving the accuracy of motion control.

[0091] exist Figure 1 On the basis of the method shown, the method provided in the embodiment of the present invention further includes:

[0092] Receiving the operating data of each of the motors; the operating data of each of the motors is collected in real time by a sensor corresponding to the motor;

[0093] Analyze the operation data of each motor to obtain the motion parameters of each motion axis of the robot;

[0094] In the method provided by the embodiment of the present invention, the simulation platform can receive the operation data of each motor collected in real time by each sensor in the robot through the established communication link. The operation data of each motor is analyzed to determine the motion parameters of the motion axis driven by the motor, thereby obtaining the motion parameters of each motion axis of the robot, and the motion parameters may include motion direction, motion angle, etc.

[0095] Based on the motion parameters of each of the motion axes and the pre-constructed trajectory planning equation, a motion trajectory corresponding to the robot is generated and the motion trajectory is displayed.

[0096] In the method provided by the embodiment of the present invention, a pre-built trajectory planning equation is deployed in the simulation platform, and the equation can be constructed based on the structure of the robot using the robot kinematics modeling method, for example, the trajectory planning equation is constructed based on the DH method. The trajectory planning equation is used to use the motion parameters of the robot's motion axis to solve the position and posture of each joint of the robot through kinematics forward solution.

[0097] The simulation platform uses the trajectory planning equation and the current motion parameters of each motion axis to solve the robot's kinematics, obtain the motion data of the robot's end effector, and draw the corresponding motion trajectory. At the same time, the simulation platform can display the motion trajectory in the front-end interface. The robot's end effector refers to a tool with certain functions connected to the edge of the robot, such as a robot gripper.

[0098] Based on the method provided in the embodiment of the present invention, the simulation platform can solve and display the motion trajectory of the robot in real time, which is beneficial for users to grasp the simulation situation in real time and improve the user experience.

[0099] On the basis of the method provided in the above embodiment, in the method provided in the embodiment of the present invention, the motion trajectory corresponding to the robot is generated based on the motion parameters of each of the motion axes and the pre-constructed trajectory planning equation, including:

[0100] Performing parameter verification on the motion parameters of each of the motion axes;

[0101] In the method provided by an embodiment of the present invention, the simulation platform may first perform parameter verification on the motion parameters of each motion axis during the trajectory planning process. For example, the input parameter types required for trajectory planning may be pre-set to check whether the motion parameters of each current motion axis already contain the parameters corresponding to all required input parameter types. If the motion parameters of the motion axis already contain the data corresponding to all required input parameter types, it is considered that the motion parameters of the motion axis have passed the parameter verification; if there are missing parameters, it is considered that the motion parameters of the motion axis have failed the parameter verification.

[0102] If the motion parameters of each of the motion axes pass the parameter verification, then based on the preset motion axis association relationship, the motion parameters of each of the motion axes are combined to obtain a kinematic parameter set corresponding to the robot;

[0103] In the method provided by the embodiment of the present invention, the motion axis association relationship can be pre-set according to the actual mechanical structure of the robot, and the association relationship represents the order in which the motion axes in the robot are applied in the kinematic solution. If the motion parameters of each motion axis have passed the parameter verification, the motion parameters of each motion axis are combined according to the pre-set motion axis association relationship, and the motion parameters of each motion axis arranged in a certain order are used as the kinematic parameter set corresponding to the robot. That is, according to the position definition of the robot motion axis in the coordinate system of the trajectory planning equation, the motion parameters of each current motion axis are arranged in a corresponding order.

[0104] Inputting the kinematic parameter set into the trajectory planning equation to solve the kinematics forward solution of the robot through the trajectory planning equation to obtain the position and posture data corresponding to the end effector of the robot;

[0105] In the method provided by the embodiment of the present invention, the simulation platform inputs the kinematic parameter set corresponding to the robot into the trajectory planning equation. The trajectory planning equation can solve the position and posture of each joint of the robot according to a predefined coordinate system, and output the position and posture data of the end effector.

[0106] Draw a trajectory corresponding to the posture data, and use the trajectory corresponding to the posture data as the motion trajectory.

[0107] In the method provided by the embodiment of the present invention, the simulation platform can draw a corresponding trajectory according to the position and posture changes presented by the posture data of the end effector, and use the trajectory as the corresponding motion trajectory of the robot.

[0108] On the basis of the method provided in the above embodiment, the method provided in the embodiment of the present invention further includes:

[0109] According to the motion parameters of each of the motion axes, a pre-constructed three-dimensional model of the robot is subjected to motion simulation to obtain a robot simulation animation; the three-dimensional model of the robot is a three-dimensional model constructed based on the structure of the robot;

[0110] The robot simulation animation is displayed.

[0111] In the method provided by the embodiment of the present invention, a three-dimensional robot model corresponding to the currently simulated robot is pre-built in the simulation platform, and the three-dimensional robot model can be built by three-dimensional simulation software. The simulation platform can use the motion parameters of each motion axis as input parameters for motion simulation, and perform motion simulation on the three-dimensional robot model through the three-dimensional simulation software, so as to obtain a robot simulation animation whose motion posture matches that of the actual robot. The robot simulation animation is displayed in the front-end interface of the simulation platform.

[0112] Based on the method provided in the embodiment of the present invention, the three-dimensional vision of the robot can be simulated in real time during the simulation process, so that the user can grasp the simulation status of the robot from the perspective of the three-dimensional vision, which can further improve the user experience.

[0113] and Figure 1 Corresponding to the robot motion control simulation method shown in FIG. 1 , the embodiment of the present invention further provides a robot motion control simulation device for Figure 1 The specific implementation of the method shown in is shown in the structural diagram Figure 2 As shown, including:

[0114] A first generating unit 201 is used to generate a simulation instruction for performing motion control simulation on a robot;

[0115] A second generating unit 202 is used to generate a robot control signal corresponding to the simulation instruction through a pre-deployed motion control model;

[0116] A third generating unit 203 is used to determine a plurality of motor control signals according to the robot control signal; the plurality of motor control signals correspond one to one with each motor of the robot;

[0117] The signal sending unit 204 is used to send each of the motor control signals to the driver of its corresponding motor, so as to drive the motor to perform motion control on the robot.

[0118] By using the device provided by the embodiment of the present invention, a control signal can be generated by a motion control model deployed in a simulation platform. When simulating different types of robots, only an adapted motion control model needs to be deployed without replacing hardware devices, which is conducive to improving the flexibility of the simulation. Secondly, in the device provided by the embodiment of the present invention, the motor control signal corresponding to each motor of the robot is further determined based on the robot control signal, and the drive control of multiple motors is realized through each motor control signal, so that the motion control simulation of the multi-axis robot can be realized.

[0119] exist Figure 2 Based on the device shown, the device provided by the embodiment of the present invention can be further expanded into multiple units. The function of each unit can be found in the description of each embodiment provided for the robot motion control simulation method above, and no further examples will be given here.

[0120] The embodiment of the present invention further provides a robot motion control simulation system, the schematic diagram of which can be shown as follows: Figure 3 As shown, the system includes:

[0121] A main control terminal 301, in which a host computer system is deployed;

[0122] A real-time simulation controller 302, in which a motion control model corresponding to the robot to be simulated is deployed; the real-time simulation controller 302 is in communication connection with the main control terminal 301; the host computer system is configured to generate a simulation instruction for simulating motion control of the robot, and send the simulation instruction to the real-time simulation controller 302;

[0123] A first programmable logic controller 303, wherein the first programmable logic controller 303 is in communication with the real-time simulation controller 302; the real-time simulation controller 302 is configured to generate a robot control signal corresponding to the simulation instruction through the motion control model upon receiving the simulation instruction, and send the robot control signal to the first programmable logic controller 303;

[0124] A plurality of second programmable logic controllers 304, wherein the plurality of second programmable logic controllers 304 correspond one to one with each motor of the robot; the first programmable logic controller 303 is respectively connected in communication with each of the second programmable logic controllers 304, and each of the second programmable logic controllers 304 is connected in communication with the driver of the corresponding motor;

[0125] The first programmable logic controller 303 is configured to determine a motor control signal corresponding to each of the motors according to the robot control signal, and send each of the motor control signals to the second programmable logic controller 304 corresponding to the corresponding motor;

[0126] Each of the second programmable logic controllers 304 is configured to send the motor control signal corresponding to its corresponding motor to the driver of the motor corresponding to the second programmable logic controller 304 when receiving the motor control signal corresponding to the motor, so as to drive the motor to control the motion of the robot.

[0127] The simulation system provided in the embodiment of the present invention includes a main control terminal, a real-time simulation controller, a first programmable logic controller and a plurality of second programmable logic controllers. It can be understood that the first programmable logic controller and the second programmable logic controller are both programmable logic controllers (PLC). In the embodiment of the present invention, the first programmable logic controller is referred to as the first PLC, and the second programmable logic controller is referred to as the second PLC.

[0128] The master control terminal in the embodiment of the present invention can be a personal computer (PC terminal) or other controllers with corresponding functions. The real-time simulation controller is also called a real-time simulation target machine, which is a type of existing control equipment. The first PLC is a PLC as a master station, and the second PLC is a PLC as a slave station. The master station PLC can control each slave station PLC.

[0129] In the embodiment of the present invention, a host computer system of the simulation system is deployed in the main control terminal, and the host computer system can be developed based on an existing host computer development environment, which allows users to input simulation parameters, responds to user operations, and issues simulation instructions. For example, the host computer system can be deployed based on the laboratory virtual instrument engineering platform (LabVIEW).

[0130] In an embodiment of the present invention, a communication connection is established between the main control end and the real-time simulation controller, a communication connection is established between the real-time simulation controller and the first PLC, a communication connection is established between the first PLC and each second PLC, and a communication connection is established between each second PLC and the driver of the motor corresponding to it. The communication connection of each object can be realized by existing connection methods such as Ethernet connection and bus connection. For example, a communication connection can be established between the main control end and the real-time simulation controller based on the User Datagram Protocol (UDP). Specifically, a UDP communication interface can be built in the host computer, and a communication connection between the main control end and the real-time simulation controller is established using the UDP communication interface. The real-time simulation controller and the first PLC can be connected to each other based on the Profinet protocol. The Profinet protocol is a communication protocol based on industrial Ethernet, which supports real-time data exchange and control. Specifically, Ethernet communication between the real-time simulation controller and the first PLC can be established based on the Profinet protocol to achieve communication connection. A communication interface based on the Profinet protocol can be deployed in the real-time simulation controller, and the communication path between the real-time simulation controller and the first PLC can be configured through the network configuration tool SYCON to establish Ethernet communication between the real-time simulation controller and the first PLC.

[0131] In the embodiment of the present invention, each second PLC corresponds to each motor of the robot, and each second PLC is used to control the corresponding motor. Each second PLC can be equipped with control logic matching the corresponding motor.

[0132] When the robot needs to be simulated for motion control, the user can input the simulation parameters of the current simulation through the host computer system in the main control end, triggering the host computer system to generate corresponding simulation instructions according to the simulation parameters to instruct the real-time simulation controller to start motion control. After the host computer system generates the simulation instruction, it can send the simulation instruction to the real-time simulation controller based on the communication connection between the main control end and the real-time simulation controller.

[0133] The real-time simulation controller responds to the simulation instruction, can extract the simulation input parameters from the instruction, and import the simulation input parameters into the pre-built motion control model. After being processed by the motion control model, the corresponding control signal can be output, and the control signal output by the motion control model is used as the robot control signal. The real-time simulation controller sends the robot control signal to the first PLC based on its communication connection with the first PLC. For the description of the motion control model, please refer to the previous embodiment, which will not be repeated here.

[0134] After receiving the robot control signal, the first PLC can determine the motor control signal corresponding to each motor based on the robot control signal, that is, the control signal used to control the corresponding motor. The first PLC can send the motor control signal of the motor corresponding to the second PLC to the second PLC based on its communication connection with each second PLC.

[0135] When the second PLC receives the motor control signal, it can send the motor control signal to the driver of the corresponding motor to drive the motor, and then drive the robot to achieve motion control simulation of the robot.

[0136] It can be understood that the robot motion control simulation system provided by the embodiment of the present invention can be regarded as implementing Figure 1 The simulation platform of the method shown, in the embodiment of the present invention, mainly describes the composition architecture of the simulation system, which is the processing logic configured for objects such as the main control end, the real-time simulation controller, the first PLC and the second PLC. For details, please refer to the description of the method embodiment in the previous text, which will not be repeated here.

[0137] The system provided by the embodiment of the present invention includes: a main control end, in which a host computer system is deployed; a real-time simulation controller, in which a motion control model corresponding to the robot is deployed; the real-time simulation controller is communicatively connected to the main control end; a first programmable logic controller, the first programmable logic controller is communicatively connected to the real-time simulation controller; a plurality of second programmable logic controllers, each of which corresponds to each motor of the robot one by one; the first programmable logic controller is communicatively connected to each second programmable logic controller, and each second programmable logic controller is communicatively connected to the driver of its corresponding motor; the host computer system is configured to generate simulation instructions for motion control simulation of the robot, and send them to the real-time simulation controller. The real controller sends a simulation instruction; the real-time simulation controller is configured to generate a robot control signal corresponding to the simulation instruction through the motion control model when receiving the simulation instruction, and send the robot control signal to the first programmable logic controller; the first programmable logic controller is configured to determine the motor control signal corresponding to each motor according to the robot control signal, and send each motor control signal to the second programmable logic controller corresponding to the corresponding motor; each second programmable logic controller is configured to send the motor control signal to the driver of the motor corresponding to the second programmable logic controller when receiving the motor control signal corresponding to its corresponding motor, so as to drive the motor to control the robot motion. The system provided by the embodiment of the present invention can generate a control signal through the motion control model in the real-time simulation controller. When simulating different types of robots, it is only necessary to deploy an adapted motion control model in the real-time simulation controller without replacing the hardware equipment, which is conducive to improving the flexibility of the simulation. Secondly, the system provided by the embodiment of the present invention transmits the corresponding motor control signal to multiple slave PLCs through a master PLC to realize the drive control of multiple motors, and can realize the motion control simulation of multi-axis robots.

[0138] exist Figure 3 On the basis of the simulation system shown, in the simulation system provided by the embodiment of the present invention, a sensor corresponding to each of the motors is deployed in the robot;

[0139] Each of the sensors is configured to collect operating data of the motor corresponding to the sensor in real time, and send the operating data to a second programmable logic controller corresponding to the motor;

[0140] Each of the second programmable logic controllers is further configured to send the operation data of the motor corresponding to the second programmable logic controller to the first programmable logic controller;

[0141] The first programmable logic controller is further configured to send the operation data of each of the motors to the real-time simulation controller;

[0142] The real-time simulation controller is further configured to determine the actual torque corresponding to each of the motors based on the operation data of each of the motors; determine the expected torque corresponding to each of the motors; for each of the motors, input the expected torque and actual torque corresponding to the motor into a pre-built torque model, and obtain the control parameters output by the torque model as the feedback control parameters corresponding to the motor; based on the feedback control parameters corresponding to each of the motors, generate a feedback control signal corresponding to each of the motors, send the feedback control signal corresponding to each of the motors to the first programmable logic controller, and send the operation data of each of the motors to the host computer system;

[0143] The first programmable logic controller is further configured to send the feedback control signal corresponding to each motor to the second programmable logic controller corresponding to the corresponding motor when receiving the feedback control signal corresponding to each motor;

[0144] Each of the second programmable logic controllers is also configured to, upon receiving a feedback control signal corresponding to the corresponding motor, send the feedback control signal to the driver of the motor corresponding to the second programmable logic controller, so as to perform torque closed-loop control on the motor.

[0145] In an embodiment of the present invention, a sensor corresponding to each motor is deployed in the currently simulated robot. During the operation of each motor, each sensor can collect the operation data of its corresponding motor in real time, such as the torque, speed, motion position and other data of the motor. Each sensor can send the motor operation data collected in real time to the second PLC corresponding to the corresponding motor. The second PLC can finally send the received operation data to the real-time simulation controller through the first PLC. The motion control model deployed in the real-time simulation controller can integrate the torque model, which can be used to achieve torque optimization.

[0146] The real-time simulation controller can obtain the feedback control parameters of each motor through a pre-constructed torque model, determine the feedback control signal corresponding to each motor based on this, and send each feedback control signal to the first PLC. The specific processing process of the real-time simulation controller regarding the torque feedback control can refer to the description of the corresponding method embodiment in the previous text, which will not be repeated here. After the real-time simulation controller receives the operating data of each motor, on the one hand, it can output feedback control signals based on the operating data of each motor using the model to achieve torque closed-loop control. On the other hand, the real-time simulation controller can further send the operating data of each motor to the host computer system of the main control end.

[0147] In the embodiment of the present invention, after receiving each feedback control signal, the first PLC sends each feedback control signal to the corresponding second PLC, and the feedback control signal is sent to the corresponding motor driver through the second PLC to perform torque closed-loop control on the motor.

[0148] Based on the simulation system provided by the embodiment of the present invention, the operation data of the motor can be collected in real time through high-precision sensors, and the collected motor operation data can be used to perform feedback control on the robot, which is beneficial to improving the accuracy of motion control.

[0149] On the basis of the simulation system provided in the above-mentioned embodiment, in the robot motion control simulation system provided in the embodiment of the present invention, the host computer system is further configured to parse the operating data of each of the motors, obtain the motion parameters of each motion axis of the robot, and generate the corresponding motion trajectory of the robot based on the motion parameters of each motion axis and the pre-constructed trajectory planning equation, and display the motion trajectory.

[0150] In an embodiment of the present invention, when the host computer system receives the operating data of each motor sent by the real-time simulation controller, the operating data of each motor can be parsed to determine the motion parameters of each operating axis of the robot. Based on the motion parameters of each motion axis, the pre-constructed trajectory planning equation is used to solve the kinematics of the robot, obtain the posture data of the end effector of the robot, and draw the corresponding motion trajectory of the robot based on the posture data of the end effector. At the same time, the host computer system can display the motion trajectory at the front end. For the specific processing process of trajectory planning, please refer to the previous description of the corresponding method embodiment, which will not be repeated here.

[0151] Based on the simulation system provided in the embodiment of the present invention, the motion trajectory of the robot's end effector can be solved and displayed in real time through the host computer system, which is beneficial for users to grasp the simulation situation in real time and improve the user's usage experience.

[0152] On the basis of the simulation system provided in the above embodiment, in the robot motion control simulation system provided in the embodiment of the present invention, a three-dimensional simulation system is further deployed in the main control end, and the host computer system and the three-dimensional simulation system are in a joint simulation mode;

[0153] The three-dimensional simulation system is configured to perform motion simulation on a pre-constructed three-dimensional robot model according to the motion parameters of each of the motion axes, obtain a robot simulation animation, and display the robot simulation animation; the robot three-dimensional model is a three-dimensional model constructed based on the structure of the robot.

[0154] In an embodiment of the present invention, a three-dimensional simulation system, such as SolidWorks, is deployed in the main control end. The three-dimensional model of the robot can be pre-built through the three-dimensional simulation system, and the host computer system and the three-dimensional simulation system can be configured to perform joint simulation. During the simulation process, based on the architecture of the joint simulation, after the host computer system parses and obtains the motion parameters of each motion axis, the three-dimensional simulation system can use the motion parameters of each motion axis to perform motion simulation on the three-dimensional model of the robot, that is, the three-dimensional model of the robot performs corresponding simulation motion according to the motion parameters of each motion axis, thereby obtaining a robot simulation animation, and displaying the robot simulation animation through the front end.

[0155] Based on the simulation system provided by the embodiment of the present invention, during the simulation process, the three-dimensional vision of the robot can be simulated through the three-dimensional simulation system, so that the user can grasp the simulation reality of the robot from the perspective of the three-dimensional vision, which can further improve the user experience.

[0156] Furthermore, based on the simulation system provided in the above embodiment, in the simulation system provided in the embodiment of the present invention, the host computer system is further configured to display the motion parameters of each motion axis. That is, the motion parameters of each motion axis of the robot can be displayed in real time at the front end through the host computer system, so that the user can intuitively grasp the actual motion situation in the data dimension, further improving the user experience.

[0157] In order to better illustrate the robot motion control simulation system provided by the embodiment of the present invention, based on the simulation systems provided by the above embodiments and in combination with actual application scenarios, the embodiment of the present invention provides another robot motion control simulation system. The simulation system provided by the embodiment of the present invention can be used to simulate the three-dimensional visual simulation of robot motion control.

[0158] The system provided by the embodiment of the present invention realizes motion control joint simulation based on PLC, SolidWorks, and LabVIEW software. The schematic diagram of the overall framework of the simulation system provided by the embodiment of the present invention can be shown as follows: Figure 4 As shown, it specifically includes: PC side, real-time simulation controller, SYCON system configuration module, PLC (master PLC, slave PLC), motor, sensor, frequency converter for driving motor and other objects.

[0159] The overall functional planning of the simulation system provided by the embodiment of the present invention specifically includes: building a host computer through Labview software on the PC side to implement the issuance of human-computer interaction instructions, and realizing the motion simulation and kinematic space trajectory planning of the robot three-dimensional model through the joint simulation of Labview and SolidWorks, and the joint simulation of Labview and real-time simulation controller. Build the motion control model of the robot in the real-time simulation controller, bind the real-time simulation controller with the SYCON configuration system, realize the communication between the real-time simulation controller and the master station PLC, and the PLC (master station PL) interconnected with the real-time simulation controller transmits control signals to each slave station PLC (which can be a PLC of different models), so that the real-time simulation controller can control multiple PLCs at the same time, and then realize multi-motor control. In addition, the motor data is collected by sensors, and the motor drive is optimized based on feedback.

[0160] During the simulation process, the data flow within the simulation system can be Figure 5 As shown, next combine Figure 5 The schematic diagram shown further introduces the simulation system provided by the embodiment of the present invention.

[0161] Figure 5 The functions of each module involved are mainly as follows:

[0162] SolidWorks: Used to display the three-dimensional simulation animation of robot movement and display the three-dimensional movement status of the robot on the front end.

[0163] Softmotion: The computational motion example module in SolidWorks, as a robot 3D motion simulation display interface, can build a joint simulation motion control system with Labview. As a motion trajectory transmission interface, it can transmit the robot motion trajectory to the Labview host computer.

[0164] Labview: A host computer tool for developing the human-machine interface of robot motion simulation. After the host computer is developed, it serves as the front-end interface for UDP communication transmission with Soloidwork, as the front-end interface for communication with the real-time simulation controller, as the front-end interface for robot motion trajectory analysis and display, and as the control port for controlling the robot motion trigger.

[0165] NI Softmotion: An independent motion control module that can be created in Labview software. It is an application that uses the driver interface in Labview to develop motion control. It can build a joint simulation motion control system with SolidWorks.

[0166] Real-time simulation controller (real-time simulation target machine): a model carrier of the motion control algorithm, carrying the simulink control algorithm model of each axis inverter of the robot (i.e., the motion control model mentioned in the previous embodiment), with a UDP interface and a Profinet interface. The UDP interface can be used to realize the communication between the real-time simulation controller and the host computer, and the real-time motion data of the motor can be transmitted to the host computer. The Profinet interface can be used to realize the communication between the real-time simulation controller and the PLC, and the control signal of the simulink can be transmitted to the PLC.

[0167] Simulink model: deploy the robot's motion control algorithm.

[0168] PLC: The communication interface between the real-time simulation controller and the inverter can communicate with multiple inverters at the same time and process the data of the data acquisition module.

[0169] Data acquisition module: interface for collecting high-precision sensor data.

[0170] Motor: A synonym for "motor" in SolidWorks, which is a physical motor used to implement motion simulation.

[0171] Frequency converter: As the driver of the motor, it is used to control the motor.

[0172] High-precision sensor: collects the torque, speed, and position of the motor. Collects negative feedback data for the motion control model in the real-time simulation controller. The sensor is a device for collecting the motion state of the robot. It can collect the motion state data of the motor in real time and convert these data into digital signals and analog signals and transmit them back to the host computer at the front end.

[0173] The construction process and simulation process of the simulation system provided by the embodiment of the present invention mainly include:

[0174] Start the simulink control algorithm model in the real-time simulation controller through the Labview host computer;

[0175] Specifically, Labview software is used as the host computer. UDP communication interface, robot multi-axis control interface, and motion trajectory display are built on the host computer. When the UDP acquisition button on the host computer software interface is executed, the robot 3D model is opened and in the softmotion simulation interface. The corresponding SoftMotion assembly 3D model path is selected in the host computer project to put the system architecture in joint simulation mode. The motion control model in the real-time simulation controller is started through UDP communication. The robot control signal is sent to the PLC master station through the profinet interface in the real-time simulation controller. The PLC master station distributes the corresponding control signal to the PLC slave station based on the robot control signal. The control signal is transmitted to the corresponding inverter through the PLC slave station, and the inverter controls the motor drive. High-precision sensors collect motor motion state data, and the PLC solves the sensor data and feeds the motor state data back to the real-time simulation controller through profinet communication.

[0176] Optimize the control algorithm model, build a motion control model to realize multi-axis motor motion in the real-time simulation controller, and configure the Profinet communication between the real-time simulation controller and the PLC master station in SYCON;

[0177] Specifically, the real-time simulation controller uses Simulink to configure the motion control model of each axis motor of the robot and the communication model of the host computer. The optimized control model can collect sensor feedback data and host computer expected data to achieve motor torque optimization. The output of the model in the real-time simulation controller can increase the speed limit to prevent the motor from running away, optimize the control signal, and drive multiple motors. Use the Real-Time Explorer control instruction to call the real-time simulation controller algorithm model instruction. Use the PLC electronic equipment database file (GSD file) to configure the communication path between the real-time simulation controller and the master PLC in SYCON. The master PLC and other slave PLCs communicate with each other to achieve one real-time simulation controller to control multiple PLCs. The slave PLC loads the control signal into the frequency converter and receives the motion speed, torque, angle and other data of each axis motor of the robot during operation, so as to achieve the communication model of the real-time simulation controller and the host computer.

[0178] Build a 3D model of the robot in SolidWorks in advance;

[0179] Specifically, the robot's 3D geometric parametric model is modeled in SolidWorks, and the joint parts of the robot arm are drawn based on the physical data and physical structure of the robot's mechanical arm; the joint parts of the mechanical arm are assembled in SolidWorks according to the robot's physical structure, and the assembled motor sequence is consistent with the robotic arm communication interface sequence in the host computer; according to the front-end simulation display requirements, the motor selection, gear data, mechanical arm material, damping ratio, etc. of the robotic arm are set in SoftMotion in sequence. Finally, the communication interface of the robot simulation state is set, including the transmission speed of the motion example, the resolution and accuracy of the 3D scene simulation motion, etc.

[0180] SolidWorks' softmotion module displays the robot's 3D simulation animation;

[0181] Specifically, use NI SoftMotion function modules or axis interface nodes to create motion control applications, and use the axis manager to associate the motion axis of Labview-NI SoftMotion with the SolidWorks simulation hardware. In Labview, UDP communication is used to parse the feedback signals of the servo axis encoder and sensor in the real-time simulation target machine, and the motion example simulation animation of the robot 3D model in SolidWorks is realized through the softmotion analysis module.

[0182] Labview displays the robot's motion trajectory, plans the robot's motion trajectory, and displays the motion parameters of each robot's motion axis;

[0183] Specifically, the Labview NI SoftMotion motion axis contains a trajectory generator, which combines the robot's motion axes according to the structural logic of SolidWorks by configuring the coordinate space. This coordinate system resource is used as the input of the NI SoftMotion function module. All motion control I / O and execution information are added to the global scan engine memory map. The terminals and variables of the trajectory planning equation function module are configured in Labview, and finally the robot motion trajectory is displayed in real time on the Labview interface.

[0184] Based on the system provided by the embodiment of the present invention, the real-time kinematic space trajectory planning and motion state display of the actual state of the robot model can be performed through Labview. The present invention deploys the motion control model in the real-time simulation controller, and the control algorithm can be optimized according to the robot motion requirements. The present invention also provides a technical route for SYCON to configure a real-time simulation controller to control multiple PLCs, optimizes the limitations of the control model in the PLC control technology, improves the accuracy of the control model, and reduces the possible dangerous situations in the traditional PLC control process. In addition, the problem of the single simulation structure in the field of robot motion control simulation is solved, and the three-dimensional visual animation of motion control simulation can be realized, which provides a more accurate control method for digital twins and is more conducive to virtual model simulation of physical objects.

[0185] Each embodiment in this specification is described in a progressive manner, and the same or similar parts between the embodiments can be referenced to each other, and each embodiment focuses on the differences from other embodiments. The system and system embodiments described above are merely schematic, wherein the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the scheme of this embodiment. A person of ordinary skill in the art may understand and implement it without creative work.

[0186] Professionals may further appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, computer software, or a combination of the two. In order to clearly illustrate the interchangeability of hardware and software, the composition and steps of each example have been generally described in the above description according to function. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professionals and technicians may use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.

[0187] The above description of the disclosed embodiments enables one skilled in the art to implement or use the present invention. Various modifications to these embodiments will be apparent to one skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features disclosed herein.

Claims

1. A robot motion control simulation method, It is characterized in that include: generating simulation instructions for simulating motion control of the robot; Generate a robot control signal corresponding to the simulation instruction through a pre-deployed motion control model; Determine a plurality of motor control signals according to the robot control signal; the plurality of motor control signals correspond one to one to each motor of the robot; Each motor control signal is sent to a driver of a corresponding motor to drive the motor to control the motion of the robot.

2. The robot motion control simulation method according to claim 1, It is characterized in that Also includes: Receiving the operating data of each of the motors; the operating data of each of the motors is collected in real time by a sensor corresponding to the motor; Determine the actual torque corresponding to each of the motors based on the operating data of each of the motors; Determining the desired torque corresponding to each of the motors; For each of the motors, the desired torque and the actual torque corresponding to the motor are input into a pre-built torque model, and the control parameters output by the torque model are obtained as feedback control parameters corresponding to the motor; Based on the feedback control parameters corresponding to each of the motors, generating a feedback control signal corresponding to each of the motors; Each feedback control signal is sent to a driver of a corresponding motor to perform torque closed-loop control on the motor.

3. The robot motion control simulation method according to claim 1, It is characterized in that Also includes: Receiving the operating data of each of the motors; the operating data of each of the motors is collected in real time by a sensor corresponding to the motor; Analyze the operation data of each motor to obtain the motion parameters of each motion axis of the robot; Based on the motion parameters of each of the motion axes and the pre-constructed trajectory planning equation, a motion trajectory corresponding to the robot is generated and the motion trajectory is displayed.

4. The robot motion control simulation method according to claim 3, It is characterized in that The step of generating a motion trajectory corresponding to the robot based on the motion parameters of each of the motion axes and a pre-constructed trajectory planning equation comprises: Performing parameter verification on the motion parameters of each of the motion axes; If the motion parameters of each of the motion axes pass the parameter verification, then based on the preset motion axis association relationship, the motion parameters of each of the motion axes are combined to obtain a kinematic parameter set corresponding to the robot; Inputting the kinematic parameter set into the trajectory planning equation to solve the kinematics forward solution of the robot through the trajectory planning equation to obtain the position and posture data corresponding to the end effector of the robot; Draw a trajectory corresponding to the posture data, and use the trajectory corresponding to the posture data as the motion trajectory.

5. The robot motion control method according to claim 3, It is characterized in that Also includes: According to the motion parameters of each of the motion axes, a motion simulation is performed on the pre-built three-dimensional model of the robot to obtain a robot simulation animation; The robot three-dimensional model is a three-dimensional model constructed based on the structure of the robot; The robot simulation animation is displayed.

6. A robot motion control simulation device, It is characterized in that include: A first generating unit, used to generate simulation instructions for performing motion control simulation on the robot; A second generating unit, configured to generate a robot control signal corresponding to the simulation instruction through a pre-deployed motion control model; A third generating unit is used to determine a plurality of motor control signals according to the robot control signal; the plurality of motor control signals correspond one to one with each motor of the robot; The signal sending unit is used to send each of the motor control signals to the driver of its corresponding motor, so as to drive the motor to control the motion of the robot.

7. A robot motion control simulation system, It is characterized in that include: A main control terminal, wherein a host computer system is deployed in the main control terminal; A real-time simulation controller, in which a motion control model corresponding to the robot to be simulated is deployed; the real-time simulation controller is in communication connection with the main control end; the host computer system is configured to generate a simulation instruction for simulating motion control of the robot, and send the simulation instruction to the real-time simulation controller; A first programmable logic controller, wherein the first programmable logic controller is communicatively connected with the real-time simulation controller; The real-time simulation controller is configured to generate a robot control signal corresponding to the simulation instruction through the motion control model when receiving the simulation instruction, and send the robot control signal to the first programmable logic controller; A plurality of second programmable logic controllers, each of which corresponds to each motor of the robot; the first programmable logic controller is respectively connected to each of the second programmable logic controllers in communication, and each of the second programmable logic controllers is connected to a driver of the corresponding motor; The first programmable logic controller is configured to determine a motor control signal corresponding to each of the motors according to the robot control signal, and send each of the motor control signals to a second programmable logic controller corresponding to the corresponding motor; Each of the second programmable logic controllers is configured to send the motor control signal corresponding to its corresponding motor to the driver of the motor corresponding to the second programmable logic controller when receiving the motor control signal corresponding to the motor, so as to drive the motor to control the motion of the robot.

8. The robot motion control simulation system according to claim 7, It is characterized in that A sensor corresponding to each of the motors is deployed in the robot; Each of the sensors is configured to collect operating data of the motor corresponding to the sensor in real time, and send the operating data to a second programmable logic controller corresponding to the motor; Each of the second programmable logic controllers is further configured to send the operation data of the motor corresponding to the second programmable logic controller to the first programmable logic controller; The first programmable logic controller is further configured to send the operation data of each of the motors to the real-time simulation controller; The real-time simulation controller is further configured to determine the actual torque corresponding to each of the motors based on the operation data of each of the motors; determine the expected torque corresponding to each of the motors; For each of the motors, the desired torque and the actual torque corresponding to the motor are input into a pre-built torque model, and the control parameters output by the torque model are obtained as feedback control parameters corresponding to the motor; Based on the feedback control parameters corresponding to each of the motors, a feedback control signal corresponding to each of the motors is generated, the feedback control signal corresponding to each of the motors is sent to the first programmable logic controller, and the operation data of each of the motors is sent to the host computer system; The first programmable logic controller is further configured to send the feedback control signal corresponding to each motor to the second programmable logic controller corresponding to the corresponding motor when receiving the feedback control signal corresponding to each motor; Each of the second programmable logic controllers is also configured to, upon receiving a feedback control signal corresponding to the corresponding motor, send the feedback control signal to the driver of the motor corresponding to the second programmable logic controller, so as to perform torque closed-loop control on the motor.

9. The robot motion control simulation system according to claim 8, It is characterized in that The host computer system is also configured to parse the operating data of each of the motors, obtain the motion parameters of each motion axis of the robot, and generate the corresponding motion trajectory of the robot based on the motion parameters of each motion axis and the pre-constructed trajectory planning equation, and display the motion trajectory.

10. The robot motion control simulation system according to claim 9, It is characterized in that The main control terminal is also equipped with a three-dimensional simulation system, and the host computer system and the three-dimensional simulation system are in a joint simulation mode; The three-dimensional simulation system is configured to perform motion simulation on a pre-constructed three-dimensional robot model according to the motion parameters of each of the motion axes, obtain a robot simulation animation, and display the robot simulation animation; the robot three-dimensional model is a three-dimensional model constructed based on the structure of the robot.