Robot motion controller and robot system

By combining the main control unit and field programmable logic gate array, the safety logic in the robot operation is solved, and the robot motion controller is large in size and high in power consumption is achieved, which is smaller in size and more powerful functions, while ensuring The robot runs safely.

CN119036444APending Publication Date: 2024-11-29ANHUI PEITIAN ROBOT GRP CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411148354.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-20
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

Existing robot motion controllers are large in size and high in power consumption, which is too large for small robots, and require simplification of volume and maintaining functions.

Method used

The main control unit and field programmable logic gate array are combined to receive safety signals through the input and output interface, and the safety detection circuit is used to process the safety logic during the robot operation, reducing the error rate and simplifying the controller design.

Benefits of technology

The robot motion controller is reduced in size, while enhancing functions, ensuring the robot's safe operation and reducing the error rate.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119036444A_ABST
    Figure CN119036444A_ABST
Patent Text Reader

Abstract

The invention discloses a robot motion controller and a robot system.The robot motion controller comprises a main control unit and a field programmable logic gate array which are electrically connected, and the main control unit is used for controlling operation of the field programmable logic gate array; the field programmable logic gate array comprises an input and output interface and a safety detection circuit, the input and output interface is used for receiving an external safety signal, and the safety detection circuit is used for processing safety logic in the operation process of the robot according to the safety signal and sending a processing result to the main control unit. According to the design, the size of the robot motion controller can be simplified, and the function of the robot motion controller is ensured.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of robots, and in particular to a robot motion controller and a robot system. Background Art

[0002] With the development of science and technology, robots have been widely used in all walks of life, and the movement of robots is controlled by robot motion controllers. However, robot motion controllers currently have defects such as large size and high power consumption. Especially for small kilogram robots, robot motion controllers are too large relative to the robot body. Therefore, it is urgent to improve robot motion controllers. Summary of the invention

[0003] The present application provides a robot motion controller and a robot system, which can simplify the size of the robot motion controller and ensure the functions of the robot motion controller.

[0004] A first aspect of an embodiment of the present application provides a robot motion controller, comprising an electrically connected main control unit and a field programmable gate array, wherein the main control unit is used to control the operation of the field programmable gate array; the field programmable gate array comprises an input / output interface and a safety detection circuit, wherein the input / output interface is used to receive an external safety signal, and the safety detection circuit is used to process the safety logic during the operation of the robot according to the safety signal, and send the processing result to the main control unit.

[0005] A second aspect of an embodiment of the present application provides a robot system, comprising the robot motion controller in any one of the above embodiments.

[0006] The beneficial effect is that the present application utilizes the main control unit and the field programmable logic gate array to cooperate with each other to control the robot, which can reduce the volume of the robot motion controller and achieve more powerful functions. In particular, a safety detection circuit is set in the field programmable logic gate array to specifically handle safety logic issues during the operation of the robot, avoid confusion between the logic of handling safety issues and the logic of other non-safety issues, reduce the error rate, and ensure the safe operation of the robot. BRIEF DESCRIPTION OF THE DRAWINGS

[0007] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the description of the embodiments are briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For those of ordinary skill in the art, other drawings can be obtained based on these drawings without creative work, among which:

[0008] Figure 1It is a structural schematic diagram of an implementation method of the robot motion controller of the present application;

[0009] Figure 2 yes Figure 1 Schematic diagram of the specific structure of the power supply circuit;

[0010] Figure 3 yes Figure 1 A schematic diagram of the specific connection structure between the central control unit and the field programmable logic gate array;

[0011] Figure 4 yes Figure 1 SPI connection diagram between the main control unit and the field programmable logic gate array;

[0012] Figure 5 It is a structural schematic diagram of another embodiment of the robot motion controller of the present application;

[0013] Figure 6 It is a schematic diagram of the flow chart of the robot motion controller in one embodiment of the present application when it is working. DETAILED DESCRIPTION

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

[0015] It should be noted that the terms "first" and "second" in this application are only used for descriptive purposes and cannot be understood as indicating or implying relative importance or implicitly indicating the number of indicated technical features. Thus, the features defined as "first" and "second" can explicitly or implicitly include at least one of the features. In the description of this application, the meaning of "multiple" is at least two, such as two, three, etc., unless otherwise clearly and specifically defined. In addition, the terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device that includes a series of steps or units is not limited to the listed steps or units, but optionally also includes steps or units that are not listed, or optionally also includes other steps or units inherent to these processes, methods, products or devices.

[0016] See also Figure 1 , Figure 1 It is a schematic diagram of the structure of an embodiment of a robot motion controller of the present application. The robot motion controller 100 includes an electrically connected main control unit 110 and a field programmable logic gate array 120.

[0017] The main control unit 110 is a core unit in the robot motion controller 100 , and is a central processing unit in the robot motion controller 100 . The main control unit 110 is used to manage various units in the robot motion controller 100 , and also controls the operation of the field programmable logic gate array 120 .

[0018] The field programmable gate array 120 is also known as FPGA (Field Programmable Gate Array), which is a product further developed on the basis of programmable devices such as PAL (Programmable Array Logic) and GAL (General Array Logic). It appears as a semi-custom circuit in the field of application-specific integrated circuits (ASICs), which not only solves the shortcomings of custom circuits, but also overcomes the shortcomings of the limited number of gate circuits of the original programmable devices. In this embodiment, the field programmable gate array 120 includes an input and output interface 121 and a safety detection circuit 122. The input and output interface 121 is used to receive external safety signals, and the safety detection circuit 122 is used to process the safety logic during the operation of the robot according to the safety signals, and return the processing results to the main control unit 110.

[0019] Specifically, the input / output interface 121 is an IO interface, which is used to receive external signals and output signals that the field programmable logic gate array 120 needs to output. In this embodiment, the input / output interface 121 is mainly used to receive safety-related signals during the operation of the robot. In an application scenario, when the state of the input / output interface 121 changes, the external signal is received.

[0020] At the same time, the safety detection circuit 122 is specifically responsible for processing logical matters related to safety issues during the operation of the robot. It specifically processes the safety signal received by the input and output interface 121, and finally sends the processing result to the main control unit 110. The main control unit 110 controls the movement of the robot based on the processing result.

[0021] For example, a camera is usually installed on the robot to detect the robot's surrounding environment, so that the robot can avoid obstacles in time when encountering obstacles. After the camera captures the image, the image data is transmitted to the field programmable logic gate array 120 via the input and output interface 121, and then the safety detection circuit 122 in the field programmable logic gate array 120 analyzes and processes the image data to obtain recognition results and corresponding logical action results. For example, the recognition result is that there is an obstacle in front of the robot, and the corresponding logical action result is to control the robot to avoid the obstacle. Finally, the main control unit 110 sends the recognition result and the corresponding logical action result to the main control unit 110, and finally the main control unit 110 controls the robot to move to avoid the obstacle according to the result.

[0022] From the above content, it can be seen that the present application uses the main control unit 110 and the field programmable logic gate array 120 to cooperate with each other to control the robot, which can reduce the volume of the robot motion controller 100 and achieve more powerful functions. In particular, a safety detection circuit 122 is set in the field programmable logic gate array 120 to specifically handle safety logic issues during the operation of the robot, avoid confusion between the logic of handling safety issues and the logic of other non-safety issues, reduce the error rate, and ensure the safe operation of the robot.

[0023] In one embodiment, the main control unit 110 is an ARM processor. In one embodiment, the ARM processor is a ZYNQ chip of Xilinx. The ZYNQ chip is the industry's first scalable processing platform launched by Xilinx, which is designed to provide the required processing and computing performance level for high-end embedded applications such as video surveillance, automotive driver assistance, and factory automation. The chip is powerful and can ensure the performance of the robot motion controller 100 while reducing its size. Of course, in other embodiments, the main control unit 110 can also be other processors, such as a DSP processor.

[0024] Continue reading Figure 1 In one embodiment, the robot motion controller 100 further includes a power supply circuit 130 , which is electrically connected to the main control unit 110 and is used to supply power to the robot motion controller 100 and provide power for the robot motion controller 100 .

[0025] In one embodiment, in combination Figure 2 In order to meet the needs of the internal circuits, the power supply circuit 130 is used to convert the input voltage into a plurality of different output voltages, thereby supplying power to different internal circuits. Figure 2 In the embodiment, the power supply circuit 130 converts the external 24V power supply into a power supply voltage of 3.3V, 2.5V, 1.5V, 1.8V, etc. The power supply circuit 130 may also include a filter unit, an overcurrent protection unit, a voltage stabilization unit, and other specific structures. The present application does not limit the specific structure of the power supply circuit 130.

[0026] Continue reading Figure 1 The robot motion controller 100 further includes a clock circuit 140 , a memory circuit 150 and an Ethernet transceiver 160 .

[0027] The clock circuit 140 is electrically connected to the main control unit 110 and is used to provide a clock signal to the main control unit 110. In one embodiment, the clock circuit 140 inputs a clock of 33.33Mhz to the main control unit 110, and the main control unit 110 uses a passive crystal oscillator, and the internal frequency multiplier generates a clock of 677MHz for the robot motion controller 100.

[0028] The memory circuit 150 is electrically connected to the main control unit 110 and is used to store data. Figure 3 In one embodiment, the memory circuit 150 includes a NAND Flash ( Figure 3 151 in the code) and DDR3 chip ( Figure 3 It is labeled with number 152 in the figure) etc.

[0029] NAND Flash is used to store the operating system so that the operating system can be booted from NAND Flash. NAND Flash can use MT29F4G08ABADAWP device, which has 4GB space, a data bus width of 8 bits, and uses GPMC asynchronous 8-bit multiplexed data / address bus to access the device. The main control unit 110 accesses NAND Flash through the SMC interface.

[0030] At the same time, the main control unit 110 accesses the DDR3 chip through the DDR3 IF interface. In one embodiment, the model of the DDR3 chip is MT41J256M16.HA, the package is FBGA-96 package, and the size is 9mm×14mm. The number of DDR3 chips can be 2, and the 2 DDR3 chips are divided into two groups and connected in parallel to the DDR3 IF interface.

[0031] The Ethernet transceiver 160 is electrically connected to the main control unit 110 and is used to realize communication between the main control unit 110 and the outside world. Figure 3 The main control unit 110 can be electrically connected to the Ethernet transceiver 160 through the MII interface. The Ethernet transceiver 160 can use Realtek's RTL8201F. RTL8201F is a single-chip single-channel 10 / 100Mbps Ethernet transceiver that supports MII and RMII protocols, is compatible with 10 / 100BASE-T IEEE 802.3 protocol, has a QFN-32 package, and is powered by a 3.3V power supply.

[0032] At the same time, in one embodiment, the FSMC interface cannot be used between the main control unit 110 and the field programmable logic gate array 120, so the SPI interface is designed to communicate data between the two. The main control unit 110 is used as the SPI master station, and the field programmable logic gate array 120 is used as the SPI slave station. The standard SPI master-slave communication protocol is used, and the SCLK clock rate is 10MHz. The signals between the main control unit 110 and the field programmable logic gate array 120 also include RESET signal and CONFIG signal, which will not be described in detail here. The specific SPI connection between the main control unit 110 and the field programmable logic gate array 120 is as follows: Figure 4 As shown, specifically Figure 4 As shown in FIG. 1 , in the SPI connection between the master control unit 110 and the field programmable logic gate array 120, the transmission link A (DOUT-DI) actually represents three signal transmission channels, namely: the transmission channel in which the master control unit 110 as the SPI master sends a chip select signal to the field programmable logic gate array 120 as the SPI slave to select the SPI slave, the transmission channel in which the master control unit 110 as the SPI master sends data to the field programmable logic gate array 120 as the SPI slave, and the transmission channel in which the field programmable logic gate array 120 as the SPI slave sends data to the master control unit 110 as the SPI master. It is a transmission channel for the main control unit 110 of the SPI master station to send data. The transmission link B (CLK-CCLK) is used to transmit the clock signal. The transmission link C (IN1-INITN) is used to output a signal to the main control unit 110 when the field programmable logic gate array 120 is powered on and initialized, indicating that the field programmable logic gate array 120 is ready and can be configured with a program. The transmission link D (IN2-DONE) is used for the field programmable logic gate array 120 to output a signal to the main control unit 110 indicating that the field programmable logic gate array 120 has been configured.

[0033] Continue reading Figure 3 A parallel first link 1101 and a second link 1102 are arranged between the main control unit 110 and the field programmable logic gate array 120 .

[0034] After the main control unit 110 sends the program data to the field programmable logic gate array 120 through the first link 1101, the field programmable logic gate array 120 runs according to the program data; during the operation of the field programmable logic gate array 120, the main control unit 110 and the field programmable logic gate array 120 interact through the second link 1102.

[0035] Specifically, before running, the main control unit 110 sends program data through the first link 1101, and then the field programmable logic gate array 120 receives the program data and operates normally according to the program data, and then interacts with the main control unit 110 through the second link 1102. The specific interaction process may be: the field programmable logic gate array 120 receives the instruction sent by the main control unit 110 through the second link 1102, and after obtaining the corresponding result according to the instruction processing, the result is returned to the main control unit 110 through the second link 1102, and the safety logic result obtained by the field programmable logic gate array 120 is also sent to the main control unit 110 through the second link 1102.

[0036] Continue reading Figure 3A third link 1103 is also connected between the main control unit 110 and the field programmable logic gate array 120 , and the main control unit 110 resets the field programmable logic gate array 120 through the third link 1103 .

[0037] Among them, the first link 1101 is formed between the MIO interface of the main control unit 110 and the Config CCLK, DI interface of the field programmable logic gate array 120. The MIO interface is a multifunctional IO interface of the main control unit 110. The Config CCLK, DI interface of the field programmable logic gate array 120 is an input interface of the field programmable logic gate array 120, which is used to receive program data. The second link 1102 is formed between the SPI&CS interface of the main control unit 110 and the SPI0 interface of the field programmable logic gate array 120. The third link 1103 is formed between the IO interface of the main control unit 110 and the Reset interface of the field programmable logic gate array 120.

[0038] Continue reading Figure 3 In addition to the above interfaces, the main control unit 110 also includes the following interfaces:

[0039] The I2C interface is used to connect to the temperature sensor and obtain the data of the temperature sensor.

[0040] SDIO0 interface: It is the interface for accessing the external SD card. The SD card stores the system burning files. The system burning files are obtained through the SDIO0 interface to update the system.

[0041] SDIO1 interface: used to access the external solid-state flash memory card chip, equivalent to an external hard disk.

[0042] MIO interface: Multi-function IO interface, which can be used to control the status of LED lights and detect whether the 24V power supply is powered off.

[0043] UART1 interface: a serial port interface used to implement the external Modbus slave interface.

[0044] UART3 interface: is an external serial port, used to implement an external serial port interface.

[0045] See also Figure 5 In one implementation, the main control unit 110 includes an application layer, a platform layer, and an operating system layer.

[0046] The application layer is the level of robot control software, which is responsible for the operation of the control software.

[0047] The platform layer abstracts and encapsulates the operating system OS to ensure that the application layer can run on different hardware platforms. It defines a set of basic platform-related interface functions, which are called externally to interact with the operating system OS to implement related platform drivers and ensure the normal use of related hardware.

[0048] The operating system layer is used to run the operating system. In one embodiment, the operating system in the robot motion controller 100 is a Linux operating system. In this embodiment, the operating system layer specifically adopts the configuration of Linux+RTAI, which can add patches in real time to ensure the real-time performance of data transmission and improve the real-time performance of the operating system. Of course, in other embodiments, the operating system layer can also specifically adopt the configuration of Windows+RTX or the configuration of VxWorks.

[0049] Continue reading Figure 5 In terms of the corresponding calling relationship, the application layer includes basic class libraries, class library management, and control interaction units.

[0050] The basic class library is used to store the operation algorithm and communication protocol, which may include the algorithm class library, mechanical unit class library, communication class library, etc. These class libraries implement different functions respectively. The algorithm class library implements the kinematics and dynamics related algorithms of the robot. The self-learning algorithm mentioned below is also implemented in the algorithm class library. The mechanical unit class library implements different mechanical unit controls according to different control objects, including robots, conveyor belts, positioners, etc.; the communication class library implements communication with servo drives, IO interfaces, etc., to ensure that the robot motion controller 100 can implement functions such as EtherCAT and Modbus.

[0051] Class library management is the main control logic core of the main control unit 110, which is used to call the operating algorithm and the communication protocol in the basic class library to complete related functions. It includes basic data type library management, operator library management, function library management, instruction library management, peripheral management, mechanical unit management, communication management, etc., which is the basic control of the entire control software.

[0052] The control interaction unit is used for motion process control and interaction with users, including task executors, system status monitoring, and HMI user interaction.

[0053] In one embodiment, the robot motion controller 100 also runs a self-learning algorithm to improve the intelligence of the robot. Autonomy is a unique feature of the self-learning algorithm. It obtains control inputs that can produce the desired output trajectory by repeatedly applying information obtained from previous experiments to improve the control quality. Unlike traditional control methods, the self-learning algorithm can handle dynamic systems with relatively high uncertainty in a very simple way, and only requires less prior knowledge and calculation. It is highly adaptable and easy to implement. More importantly, it does not rely on the precise mathematical model of the dynamic system. It is an algorithm that generates optimized input signals iteratively to make the system output as close to the ideal value as possible.

[0054] See also Figure 6 In one embodiment, the specific process of the main control unit 110 controlling the robot movement according to the self-learning algorithm includes:

[0055] S101: Obtain the planned motion trajectory of the robot.

[0056] Among them, the planned motion trajectory is the ideal motion trajectory of the robot, and the ultimate goal of the autonomous learning algorithm is to make the actual motion trajectory of the robot very close to the planned motion trajectory.

[0057] The process of step S101 may specifically include: after the operator confirms the starting teaching point, the ending teaching point and several intermediate teaching points between the starting teaching point and the ending teaching point, speed planning is performed to obtain the planned motion trajectory of the robot.

[0058] S102: Taking the planned motion trajectory as the target motion trajectory.

[0059] S103: Control the robot movement according to the target motion trajectory.

[0060] Specifically, the robot is controlled to move along the target trajectory, but due to the flexibility of the reducer and other reasons, there is usually a trajectory error between the actual trajectory of the robot and the target trajectory, that is, there is a deviation between the actual trajectory of the robot and the ideal trajectory.

[0061] S104: Determine the actual motion trajectory of the robot during the motion process.

[0062] After the robot moves, the trajectory of the robot during the actual movement is determined.

[0063] In one embodiment, step S104 includes:

[0064] S1041: Obtain the axis position of each joint axis of the robot during the movement and the end acceleration of the robot.

[0065] The terminal acceleration of the robot specifically refers to the acceleration of the terminal of the robot, for example, the acceleration of the tool center point (TCP point) of the robot.

[0066] Among them, several sampling moments can be determined during the movement of the robot, and then at each sampling moment, the current axis position of each joint axis of the robot and the terminal acceleration of the robot are determined.

[0067] Alternatively, during the movement of the robot, the axis position of each joint axis of the robot and the terminal velocity of the robot may be continuously acquired.

[0068] In this embodiment, in order to accurately obtain the acceleration of the end of the robot, an acceleration sensor may be installed at the end of the robot to collect the acceleration of the end of the robot.

[0069] S1042: Determine the actual motion trajectory of the robot based on the axis position and the terminal acceleration.

[0070] Among them, the acquired axis position and terminal acceleration are fused and processed to accurately determine the actual motion trajectory of the robot.

[0071] S105: Determine a trajectory error of the actual motion trajectory relative to the planned motion trajectory.

[0072] Specifically, the trajectory error of the actual motion trajectory relative to the planned motion trajectory represents the degree of deviation between the actual motion trajectory and the planned motion trajectory.

[0073] S106: Determine whether the trajectory error is within a preset error range.

[0074] If the determination result is that the trajectory error is not within the preset error range, step S107 is executed; if the determination result is that the trajectory error is within the preset error range, step S109 is executed.

[0075] Specifically, if the trajectory error is within the preset error range, it means that the actual motion trajectory of the robot is very close to the ideal motion trajectory of the robot, that is, the planned motion trajectory. There is no need to compensate the robot's trajectory, and the robot's movement can be controlled directly according to the latest target motion trajectory.

[0076] However, if the trajectory error is not within the preset error range, it means that the actual motion trajectory of the robot is still far from the ideal motion trajectory of the robot (i.e., the planned motion trajectory), and the motion trajectory of the robot needs to be compensated.

[0077] S107: Compensating the target motion trajectory according to the trajectory error to obtain a compensated motion trajectory.

[0078] If P0 represents the planned motion trajectory and PL represents the actual motion trajectory, then the trajectory error of the actual motion trajectory relative to the planned motion trajectory is e=PL-P0. When compensating the target motion trajectory Q, the value of Qe is calculated, and then the result of Qe updates the target motion trajectory, that is, the target motion trajectory is replaced by Qe.

[0079] The interpolation points corresponding to each interpolation cycle of the target motion trajectory can be compensated according to the trajectory error, so as to realize compensation of the target trajectory and obtain a compensated motion trajectory. That is, the first interpolation point, the second interpolation point, etc. are compensated respectively, and then the compensated motion trajectory is determined according to the compensated interpolation points.

[0080] S108: Update the target motion trajectory using the compensation motion trajectory.

[0081] After executing step S108, return to execute step S103.

[0082] After the compensation motion trajectory is obtained, the target motion trajectory is replaced by the compensation motion trajectory, and then the process returns to step S103 to control the movement of the robot according to the new target motion trajectory.

[0083] S109: End the trajectory compensation process, and subsequently control the robot movement according to the target motion trajectory.

[0084] After the trajectory compensation process is completed, the robot movement is subsequently controlled according to the target motion trajectory, so that the actual motion trajectory of the robot can be close to the ideal motion trajectory of the robot (i.e., the planned motion trajectory).

[0085] From the above content, it can be seen that the use of self-learning algorithm to compensate the robot's target motion trajectory makes the robot's actual motion trajectory close to the ideal motion trajectory (i.e., the planned motion trajectory). It does not need to rely on precise mathematical models, only requires less prior knowledge and calculation, and is highly applicable and easy to implement.

[0086] In addition, the present application also includes a robot system, including a robot and a robot motion controller for controlling the robot. The robot motion controller has the same structure as the robot motion controller 100 in any of the above-mentioned embodiments. For details, please refer to the above-mentioned related content, which will not be repeated here.

[0087] The above description is only an embodiment of the present application and does not limit the patent scope of the present application. Any equivalent structure or equivalent process transformation made using the contents of the present application specification and drawings, or directly or indirectly used in other related technical fields, are also included in the patent protection scope of the present application.

Claims

1. A robot motion controller, It is characterized in that It comprises a main control unit and a field programmable logic gate array which are electrically connected, wherein the main control unit is used to control the operation of the field programmable logic gate array; The field programmable logic gate array includes an input and output interface and a safety detection circuit. The input and output interface is used to receive external safety signals. The safety detection circuit is used to process the safety logic during the operation of the robot according to the safety signals and send the processing results to the main control unit.

2. The robot motion controller according to claim 1, It is characterized in that The main control unit is an ARM processor.

3. The robot motion controller according to claim 2, It is characterized in that The ARM processor is a ZYNQ chip.

4. The robot motion controller according to claim 1, It is characterized in that The robot motion controller also includes a power supply circuit, which is electrically connected to the main control unit and is used to supply power to the robot motion controller. The power supply circuit is used to convert an input voltage into a plurality of different output voltages.

5. The robot motion controller according to claim 1, It is characterized in that Also includes: A clock circuit, electrically connected to the main control unit, and configured to provide a clock signal to the main control unit; and / or, a memory circuit, electrically connected to the main control unit, for storing data; And / or, an Ethernet transceiver, electrically connected to the main control unit, for realizing communication between the main control unit and the outside world.

6. The robot motion controller according to claim 1, It is characterized in that A first link, a second link and a third link are arranged in parallel between the main control unit and the field programmable logic gate array, and the first link, the second link and the third link are all electrically connected to the main control unit and the field programmable logic gate array; After the main control unit sends the program data to the field programmable logic gate array through the first link, the field programmable logic gate array operates according to the program data; During the operation of the field programmable logic gate array, the main control unit interacts with the field programmable logic gate array through the second link; The main control unit resets the field programmable logic gate array through the third link.

7. The robot motion controller according to claim 1, It is characterized in that The main control unit includes an application layer, a platform layer and an operating system layer; The application layer load controls the operation of software, the platform layer abstracts and encapsulates the operating system, and the operating system layer is used to run the operating system.

8. The robot motion controller according to claim 7, It is characterized in that The application layer includes a basic class library, a class library management and a control interaction unit; The basic class library is used to store operation algorithms and communication protocols; The class library management is used to call the operation algorithm and the communication protocol in the basic class library; The control interaction unit is used for performing motion flow control and interacting with the user.

9. The robot motion controller according to claim 1, It is characterized in that The main control unit is specifically used to perform the following steps: Get the robot's planned motion trajectory; Using the planned motion trajectory as the target motion trajectory; Controlling the movement of the robot according to the target motion trajectory; Determining the actual motion trajectory of the robot during the motion process; Determining a trajectory error of the actual motion trajectory relative to the planned motion trajectory; Determining whether the trajectory error is within a preset error range; If the trajectory error is not within the preset error range, compensating the target motion trajectory according to the trajectory error to obtain a compensated motion trajectory; The target motion trajectory is updated with the compensated motion trajectory, and the step of controlling the movement of the robot according to the target motion trajectory is returned to be executed until the trajectory error is within the preset error range.

10. A robot system, It is characterized in that The invention comprises a robot and a robot motion controller according to any one of claims 1 to 9 which controls the robot.