A robot conveyor belt following method, device, system, storage medium and controller

Through multi-dimensional online trajectory generation and electronic cam technology, the problems of large following error and low efficiency in robot conveyor belt follow-up are solved, and high-precision and efficient conveyor belt follow-up are achieved, ensuring the safety of high-speed follow-up and the stability of the production line.

CN118514087BActive Publication Date: 2024-11-15CHANGGUANGXI INTELLIGENT MFG (WUXI) CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410988685.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-07-23
Publication Date
2024-11-15
Estimated Expiration
2044-07-23

AI Technical Summary

Technical Problem

In the existing robot conveyor belt follow technology, there are follow uncertainty caused by large following errors, low efficiency, inaccurate position caused by hardware data acquisition and software processing delays, follow uncertainty caused by belt speed fluctuations and insufficient encoder accuracy, and health at high speed follow-up. and property safety risks.

Method used

Using a multi-dimensional online trajectory generation method based on conveyor encoder latch and real-time counting, the robot tool end tracking trajectory is generated and executed, and the encoder count is converted into motion time through electronic cam technology to achieve accurate compensation and synchronization; in the exit stage, according to the pre-order Suppose the trajectory type and real-time motion parameters generate exit trajectory to ensure the smooth deceleration and optimal time exit process; in abnormal situations, implement a smooth deceleration stop mechanism.

Benefits of technology

It significantly improves the following accuracy and efficiency, reduces the delay of the conveyor belt following system, ensures safety and high accuracy of high-speed follow-up in low-speed mode, and avoids losses or interruptions caused by follow-up failure or abnormality in the production line.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118514087B_ABST
    Figure CN118514087B_ABST
Patent Text Reader

Abstract

A robot conveyor belt following method, device, system, storage medium and controller, the method includes: in the workpiece tracking stage, according to the latch and real-time counting of the conveyor belt encoder, the recorded target workpiece posture and teaching programming settings, based on the multi-dimensional online trajectory generation method, the robot tool end tracking trajectory is generated and executed, after the tracking trajectory is completed, the tool end and the target workpiece speed are consistent; in the exit stage, according to the exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and conveyor belt, the robot exit trajectory is generated and executed. Based on the encoder synchronous acquisition and processing scheme, the running trajectory of the tool end relative to the conveyor belt workpiece in the tracking stage is accurately compensated; the multi-dimensional online trajectory generation technology is used to effectively reduce the trajectory running time in the tracking and exit stages; if an abnormality occurs in any stage of the conveyor belt following, the robot can smoothly decelerate and stop; the high-speed conveyor belt following function debugging can be performed in low-speed mode.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot technology, and in particular to a robot conveyor belt following method, device, system, storage medium and controller. Background Art

[0002] At present, robots have been widely used in industrial automated production lines. In many automated assembly lines, conveyor belts transport the workpieces to be processed to each workstation, and the robots at the workstations perform processing operations such as loading and unloading the workpieces on the conveyor belts. The effective cooperation between the two can improve the production efficiency of the production line.

[0003] In the simplest form of cooperation, the conveyor stops when it delivers the workpiece to the specified location, the robot processes the stationary workpiece, and then the conveyor continues to move. This method has relatively simple requirements for the conveyor system and the robot control system. The frequent start and stop of the conveyor accelerates the loss of the transmission system and reduces the average rate of workpiece transportation; the robot needs to wait for the conveyor to stop before processing, so the work efficiency is low; in the case of multi-station processing, the above factors will further reduce production efficiency.

[0004] Robot conveyor belt following is a more efficient way of cooperation. The workpiece moves continuously with the conveyor belt. According to the target workpiece posture and conveyor belt encoder count at the time of detection, as well as the real-time count of the conveyor belt encoder, the robot can locate the position of the workpiece in real time, and then complete the processing of the moving workpiece.

[0005] In the existing robot conveyor belt following method, in the tracking stage, different following strategies are adopted according to the position relationship of the target workpiece relative to the robot to improve efficiency; in the exit stage, the robot tool end decelerates and stops along the direction of the conveyor belt movement; after the exit stage is completed, the robot tool end moves from the stop position to the preset target point. Common following strategies in the tracking process: when the workpiece is at the beginning of the working area, the robot first moves in the opposite direction and then follows forward to complete the tracking; when the workpiece is in the middle of the working area, the robot accelerates forward until it reaches the same speed as the conveyor belt to complete the tracking; when the workpiece is at the end of the working area, the robot first accelerates to a speed greater than the conveyor belt speed and then decelerates to the same speed as the conveyor belt to complete the tracking. After the conveyor belt following is completed, the preset target point is usually the placement position of the workpiece removed from the conveyor belt, the grasping position of the workpiece at the workstation, or the preparation position for the next conveyor belt following.

[0006] When there is a large delay in the hardware data acquisition and software processing process, the conveyor belt encoder count obtained by the robot lags behind the true value, and the robot cannot accurately locate the target workpiece position, thereby introducing a large following error, and the following error increases significantly with the increase of the conveyor belt movement speed; when the above delay is relatively random, the following error is also relatively uncertain; when the conveyor belt movement speed has a large fluctuation or the conveyor belt encoder has a low accuracy, the traditional tracking trajectory planning method will produce a following error due to inaccurate conveyor belt speed estimation, and the longer the tracking time, the greater the following error; the inventors of this application also found that in the existing conveyor belt following technology, the robot The end of the tool first moves to the straight trajectory of the target workpiece along the conveyor belt, and adjusts its posture to match the current target workpiece, and then executes the one-dimensional tracking trajectory, which is inefficient; there is also a large room for speeding up when exiting to the preset target point trajectory; when tracking fails or abnormalities occur during the robot conveyor belt following process, an unreasonable exit mechanism will interrupt the assembly line operation; when an active or abnormal exit from the conveyor belt following occurs at a random moment, the uneven deceleration trajectory or emergency stop will cause loss or damage to the robot; in addition, if the high-speed conveyor belt following application is very different from the low-speed mode following effect, there will be certain health and property safety risks during the debugging process. Summary of the invention

[0007] In view of the above problems, the present invention is proposed to provide a robot conveyor belt following method, device, system, storage medium and controller that overcome the above problems or at least partially solve the above problems.

[0008] The present invention provides a robot conveyor belt following method comprising:

[0009] During the workpiece tracking stage, the robot generates and executes the robot tool end tracking trajectory based on the multi-dimensional online trajectory generation method according to the latching and real-time counting of the conveyor encoder, the target workpiece posture at the detection time, and the robot's teaching programming settings. When the tracking trajectory is completed, the robot tool end is at the same speed as the target workpiece.

[0010] In the exit phase, the robot generates and executes the robot's exit trajectory based on the preset exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and conveyor belt.

[0011] In some optional embodiments, the robot generates and executes the robot tool end tracking trajectory based on a multi-dimensional online trajectory generation method according to the latching and real-time counting of the conveyor encoder, the target workpiece posture at the detection time, and the robot's teaching programming settings, including:

[0012] When the target workpiece is detected to enter the working area, the robot control system locks the conveyor encoder count and records the target workpiece posture at the detection time; the robot in the waiting state for the target workpiece calculates the target workpiece posture at the current moment based on the encoder count and the target workpiece posture at the detection time.

[0013] The straight-line tracking trajectory of the robot tool end posture relative to the target workpiece posture at the current moment is orthogonally decomposed to obtain an orthogonal trajectory; the orthogonal trajectory includes a fixed straight-line posture trajectory perpendicular to the direction of conveyor belt movement and a straight-line position trajectory parallel to the direction of conveyor belt movement and changing with the conveyor belt movement.

[0014] Based on the teaching programming setting and conveyor belt speed estimation, an online trajectory generation method is used to simultaneously plan orthogonal trajectories to generate time-synchronized position planning curves.

[0015] Based on the conversion relationship between the encoder count and the motion time designed by the electronic cam technology, the interpolation moment of the position planning curve corresponding to the current encoder count is determined, the current interpolation position of the orthogonal trajectory is obtained, and then the interpolation posture of the robot tool end is obtained by position vector synthesis.

[0016] The robot tool end tracking trajectory is synthesized and executed according to the interpolated posture at each moment.

[0017] In some optional embodiments, the conversion relationship between encoder count and time is designed based on electronic cam technology, including:

[0018] According to the expected conveyor belt movement speed, a linear or nonlinear one-to-one mapping curve between encoder count and movement time is designed, and the one-to-one mapping curve is functionally compounded with the position planning curve of the orthogonal trajectory to obtain the mapping curve of the conveyor belt encoder count and the position planning curve.

[0019] In some optional embodiments, when the target workpiece is detected to enter the working area, the robot control system locks the conveyor belt encoder count and records the target workpiece position at the detection time, including:

[0020] When the target workpiece is detected to enter the working area, the detection device generates a switch signal, which directly triggers the robot control system hardware to latch the conveyor encoder counting function, and uses the taught robot tool end posture as the target workpiece posture at the detection moment; or, when the target workpiece is detected to enter the working area, the detection device generates a switch signal, which indirectly triggers the robot control system hardware to latch the conveyor encoder counting function based on the detection result of the visual system, and uses the target workpiece posture detected by the visual system as the detected workpiece posture at the recording moment.

[0021] In some optional embodiments, the exit trajectory types include: decelerating and stopping along the moving direction of the conveyor belt and stopping after running to a preset target point.

[0022] The robot generates and executes the robot's exit trajectory according to the preset exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and the conveyor belt, including:

[0023] For the exit trajectory type of decelerating and stopping along the direction of conveyor belt movement, a one-dimensional deceleration curve is planned based on the real-time speed and acceleration of the robot tool end and the teaching programming settings. The robot tool end decelerates and stops along the direction of conveyor belt movement to a certain point above the conveyor belt.

[0024] For the exit trajectory type that stops after running to the preset target point, a multi-dimensional synchronous exit trajectory with optimal time is generated based on the online trajectory generation method according to the preset exit target point, teaching programming settings and the real-time motion status of the robot joints.

[0025] In some optional embodiments, the above method also includes: exception handling and exit mechanism during the conveyor belt following process.

[0026] At any stage of conveyor belt following, if an abnormal situation is detected, the type of abnormal situation is determined.

[0027] According to the type of abnormal situation, the abnormality handling method is determined as a handling method that does not require trajectory planning or a handling method that requires trajectory planning.

[0028] For processing methods that require trajectory planning, a smooth deceleration trajectory is planned based on the conveyor belt following phase, the robot's current motion state, and the teaching programming settings.

[0029] In some optional embodiments, the above method further includes:

[0030] If the target workpiece is detected to enter the working area, the target workpiece information is added to the queue; when the robot is in the state of waiting for the target workpiece or after the robot enters the state of waiting for the target workpiece, the first target workpiece in the queue is removed from the queue and used as the current target to be tracked.

[0031] If the robot is in the state of waiting for the target workpiece and detects that there is a target workpiece in the working area, the tracking module is instructed to start the tracking process; if it is determined that the current target workpiece can be tracked, the tracking module is instructed to execute the tracking trajectory, otherwise the robot is controlled to remain in the state of waiting for the target workpiece and wait for the next target workpiece.

[0032] An embodiment of the present invention provides a robot conveyor belt following device, which is used to implement the above-mentioned robot conveyor belt following method. The device includes: a tracking module and an exit module.

[0033] The tracking module is used to generate and execute the robot tool end tracking trajectory based on the latching and real-time counting of the conveyor encoder, the recorded target workpiece posture and the robot's teaching programming settings, based on the multi-dimensional online trajectory generation method. When the tracking trajectory is completed, the robot tool end is consistent with the target workpiece speed.

[0034] The exit module is used to generate and execute the robot's exit trajectory according to the preset exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and conveyor belt.

[0035] In some optional embodiments, the above device further includes:

[0036] The workpiece queue management module is used to add the target workpiece information to the queue if it is detected that the target workpiece enters the working area; when the robot is in the state of waiting for the target workpiece or after the robot enters the state of waiting for the target workpiece, the first target workpiece in the queue is removed from the queue and used as the current target to be tracked.

[0037] The tracking control module is used to instruct the tracking module to start the tracking process if the robot is in the state of waiting for the target workpiece and detects the presence of the target workpiece in the working area; if it is determined that the current target workpiece can be tracked, it instructs the tracking module to execute the tracking trajectory, otherwise the robot is controlled to remain in the state of waiting for the target workpiece and wait for the next target workpiece.

[0038] The present invention provides a robot conveyor belt following system, characterized by comprising: a robot and a conveyor belt system.

[0039] The robot comprises a robot body, a control system and an end tool. The control system comprises an encoder synchronization acquisition module and the above-mentioned robot conveyor belt following device. The robot operates the workpiece on the conveyor belt through the tool.

[0040] The encoder synchronization acquisition module is used to periodically read the conveyor belt encoder count and trigger the robot control system hardware latch encoder count function according to the switch signal generated by the detection device.

[0041] The conveyor belt system includes a conveyor belt and an encoder installed on the conveyor belt. The change in encoder count is proportional to the moving distance of the conveyor belt. The robot obtains the encoder count through an encoder synchronization acquisition module.

[0042] An embodiment of the present invention provides a computer storage medium, in which computer executable instructions are stored. When the computer executable instructions are executed by a processor, the above-mentioned robot conveyor belt following method is implemented.

[0043] The present invention provides a controller, comprising: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the above-mentioned robot conveyor belt following method when executing the program.

[0044] The beneficial effects of the above technical solution provided by the embodiment of the present invention include at least:

[0045] The method provided by the present invention is based on the encoder synchronous acquisition and processing scheme, which can accurately compensate the running trajectory of the robot tool end relative to the conveyor workpiece during the tracking and synchronization stages; the use of multi-dimensional online trajectory generation technology can effectively reduce the trajectory running time in the tracking and exit stages; when an abnormality occurs in any stage of conveyor belt following, the robot can smoothly decelerate and stop; the high-speed conveyor belt following function debugging can be carried out in low-speed mode.

[0046] The above method uses an encoder synchronous acquisition module to greatly reduce the delay of the entire conveyor following system, thereby significantly improving the following accuracy; the straight line tracking trajectory of the robot tool end posture relative to the target workpiece posture at the current moment is orthogonally decomposed into a fixed straight line posture trajectory perpendicular to the conveyor movement direction, and a straight line position trajectory parallel to the conveyor movement direction and changing with the conveyor movement. The planned synthetic trajectory can complete the tracking process at one time, which greatly improves the tracking efficiency compared with the independent motion control method; based on the multi-dimensional online trajectory generation method, the above-mentioned orthogonal trajectories are simultaneously planned to generate a multi-dimensional smooth position planning curve with optimal time, and automatically adapt the relative position relationship between the robot tool end and the workpiece; the position vector of the above-mentioned orthogonal decomposed position planning curve is synthesized, and after transformation using electronic cam technology, the absolute motion trajectory of the robot tool end with the conveyor encoder count replacing the time axis is obtained, which overcomes and reduces the influence of conveyor speed fluctuation and insufficient conveyor encoder accuracy, respectively, and ensures high precision of workpiece tracking and following consistency at different speeds.

[0047] Based on the online trajectory generation method, the time-optimal multi-dimensional synchronous trajectory for exiting to the preset target point is generated, which can significantly speed up the exit process; if active exit or abnormal exit occurs at any stage of the robot conveyor belt following, the robot can decelerate and stop smoothly.

[0048] Other features and advantages of the present invention will be described in the following description, and partly become apparent from the description, or understood by practicing the present invention. The purpose and other advantages of the present invention can be realized and obtained by the structures particularly pointed out in the written description, claims, and drawings.

[0049] The technical solution of the present invention is further described in detail below through the accompanying drawings and embodiments. BRIEF DESCRIPTION OF THE DRAWINGS

[0050] The accompanying drawings are used to provide a further understanding of the present invention and constitute a part of the specification. Together with the embodiments of the present invention, they are used to explain the present invention and do not constitute a limitation of the present invention. In the accompanying drawings:

[0051] Figure 1 This is a flow chart of the robot conveyor belt following method in Embodiment 1 of the present invention.

[0052] Figure 2 This is an example diagram of a system architecture for robot conveyor belt following in Embodiment 1 of the present invention.

[0053] Figure 3 This is another example diagram of the system architecture of the robot conveyor belt following in the first embodiment of the present invention.

[0054] Figure 4 This is an example diagram of the position curve of the robot tracking trajectory synchronous planning in the first case in the first embodiment of the present invention.

[0055] Figure 5 This is an example diagram of the speed curve of the robot tracking trajectory synchronous planning in the first case in the first embodiment of the present invention.

[0056] Figure 6 This is an example diagram of the synthetic trajectory of the robot tracking trajectory synchronous planning in the first case in the first embodiment of the present invention.

[0057] Figure 7 This is an example diagram of the position curve of the robot tracking trajectory synchronous planning in the second case in the first embodiment of the present invention.

[0058] Figure 8 This is an example diagram of the speed curve of the robot tracking trajectory synchronous planning in the second case in the first embodiment of the present invention.

[0059] Fig. 9 This is an example diagram of the position curve of the robot tracking trajectory synchronous planning in the second case in the first embodiment of the present invention.

[0060] Fig.10 This is a flow chart of the robot conveyor belt following method in Embodiment 2 of the present invention.

[0061] Fig.11 Schematic diagram of the structure of the robot conveyor belt following device in an embodiment of the present invention.

[0062] Fig.12 Schematic diagram of the structure of the robot conveyor belt following system in an embodiment of the present invention. DETAILED DESCRIPTION

[0063] The following will refer to the attached Figure 1-8Exemplary embodiments of the present disclosure are described in more detail. Although exemplary embodiments of the present disclosure are shown in the accompanying drawings, it should be understood that the present disclosure can be implemented in various forms and should not be limited by the embodiments set forth herein. On the contrary, these embodiments are provided to enable a more thorough understanding of the present disclosure and to fully convey the scope of the present disclosure to those skilled in the art.

[0064] In order to solve the problems of poor robot conveyor following accuracy and low execution efficiency existing in the prior art, an embodiment of the present invention provides a robot conveyor following method, which controls the robot tool end to accurately follow the target workpiece on the conveyor belt based on the hardware latching mechanism of the conveyor belt encoder counting. During the entire following process, the robot runs smoothly and efficiently.

[0065] The robot conveyor belt following method includes: for the target workpiece entering the working area, a hardware encoder synchronization acquisition device is used, and the robot controller accurately records the time-synchronized encoder latch count and the target workpiece posture; the robot in the state of waiting for the target workpiece generates a tracking trajectory and starts tracking the moving target workpiece according to the encoder latch and real-time count, the target workpiece posture at the detection time, and the teaching programming setting; in the tracking stage, the electronic cam technology is used to overcome and reduce the influence of the conveyor belt speed fluctuation and the insufficient precision of the conveyor belt encoder, so as to ensure the tracking accuracy of the target workpiece; the robot tool end tracking target workpiece posture trajectory is orthogonally decomposed into a fixed posture trajectory perpendicular to the conveyor belt movement direction, and a position trajectory parallel to the conveyor belt movement direction and changing with the conveyor belt movement, and the execution of the planned synthetic trajectory can complete the tracking process at one time, which greatly improves the tracking efficiency compared with the independent motion control method; based on online trajectory generation The method simultaneously plans the orthogonal decomposition trajectory to generate a multidimensional smooth planning curve with the optimal time, which can automatically adapt to the relative position relationship between the robot tool end and the target workpiece; after executing the tracking trajectory orthogonally synthesized by the multidimensional smooth planning curve, the speed of the robot tool end is consistent with the actual speed of the conveyor belt; when the robot enters the workpiece synchronization stage, the robot generates a synthetic trajectory of the robot tool end according to the teaching programming settings and the real-time counting of the conveyor belt encoder; when the robot enters the exit stage, according to the real-time motion parameter estimation of the conveyor belt, based on the online trajectory generation method, the robot tool end decelerates to the stop point or the preset target point along the direction of motion of the conveyor belt; the robot conveyor belt following method is based on the encoder synchronous acquisition and processing scheme, and can accurately compensate the robot's running trajectory relative to the conveyor belt during the tracking and synchronization stages; when an abnormality occurs in any stage of conveyor belt following, the robot can decelerate and stop smoothly; the high-speed conveyor belt following function debugging can be carried out in low-speed mode.

[0066] Embodiment 1

[0067] Embodiment 1 of the present invention provides a robot conveyor belt following method, comprising:

[0068] During the workpiece tracking stage, the robot generates and executes the robot tool end tracking trajectory based on the multi-dimensional online trajectory generation method according to the latching and real-time counting of the conveyor encoder, the target workpiece posture at the detection time, and the robot's teaching programming settings. When the tracking trajectory is completed, the robot tool end is at the same speed as the target workpiece.

[0069] In the exit phase, the robot generates and executes the robot's exit trajectory based on the preset exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and conveyor belt.

[0070] The above method may further include, between the artifact tracking phase and the exit phase:

[0071] During the workpiece synchronization phase, the robot synthesizes and executes the robot tool end operation trajectory according to the preset programming trajectory and the real-time count of the conveyor belt encoder. When the robot completes all the synchronization trajectories, it enters the exit phase.

[0072] The above robot conveyor belt following method has the following process: Figure 1 For an example of a robot conveyor belt following system architecture, see Figure 2 and Figure 3 As shown, the method comprises the following steps:

[0073] Step S101: When the target workpiece is detected to enter the working area, the robot control system locks the conveyor belt encoder count and records the target workpiece posture at the detection time.

[0074] There are two situations in which the target workpiece posture recorded at the detection time is:

[0075] Case 1: When the target workpiece is detected to enter the working area, the detection device generates a switch signal, which directly triggers the robot control system hardware latch conveyor encoder counting function, and uses the taught robot tool end position as the target workpiece position at the detection moment. Figure 2 As shown, after the detection switch detects that the target workpiece enters the working area, a synchronous acquisition module is provided in the control system in the robot control cabinet. The synchronous acquisition module triggers the hardware latch encoder count, and the control system controls the robot to start subsequent work.

[0076] Case 2: When the target workpiece is detected to enter the working area, the detection device generates a switch signal. After the visual system is exposed, it indirectly triggers the robot control system hardware to latch the conveyor belt encoder counting function, and uses the target workpiece posture detected by the visual system as the detected workpiece posture at the recording time. Figure 3As shown, after the detection switch detects that the target workpiece enters the working area, the visual system starts the photo detection, and the synchronous acquisition module of the control system in the robot control cabinet triggers the hardware latch encoder count based on the visual photo result.

[0077] Step S102: The robot generates and executes the robot tool end tracking trajectory based on the multi-dimensional online trajectory generation method according to the latching and real-time counting of the conveyor encoder, the target workpiece posture at the detection time and the robot's teaching programming settings. When the tracking trajectory is completed, the robot tool end is consistent with the target workpiece speed.

[0078] When the robot is in the state of waiting for the target workpiece or after the robot enters the state of waiting for the target workpiece, the robot tool end tracking trajectory is generated according to the latching and real-time counting of the conveyor encoder, the taught or detected target workpiece posture and the robot's teaching programming settings; if the tracking trajectory does not exceed the working area, the robot first executes the tracking trajectory and then enters the workpiece synchronization stage; otherwise, it continues to maintain the state of waiting for the target workpiece until the next workpiece enters the working window.

[0079] This step realizes the generation and execution of tracking tracks in the workpiece tracking phase. The process includes:

[0080] The robot in the state of waiting for the target workpiece calculates the target workpiece posture at the current moment according to the encoder count and the target workpiece posture at the detection moment.

[0081] The straight-line tracking trajectory of the robot tool end posture relative to the target workpiece posture at the current moment is orthogonally decomposed to obtain an orthogonal trajectory; the orthogonal trajectory includes a fixed straight-line posture trajectory perpendicular to the direction of conveyor belt movement and a straight-line position trajectory parallel to the direction of conveyor belt movement and changing with the conveyor belt movement.

[0082] Based on the teaching programming setting and conveyor belt speed estimation, an online trajectory generation method is used to simultaneously plan orthogonal trajectories to generate time-synchronized position planning curves.

[0083] Based on the conversion relationship between the encoder count and the motion time designed by the electronic cam technology, the interpolation moment of the position planning curve corresponding to the current encoder count is determined, the current interpolation position of the orthogonal trajectory is obtained, and then the interpolation posture of the robot tool end is obtained by position vector synthesis.

[0084] The robot tool end tracking trajectory is synthesized and executed according to the interpolated posture at each moment.

[0085] Among them, the conversion relationship between encoder count and time is designed based on electronic cam technology, including: designing a linear or nonlinear one-to-one mapping relationship curve between encoder count and movement time according to the expected conveyor belt movement speed, and performing functional compounding of the one-to-one mapping relationship curve with the position planning curve of the orthogonal trajectory to obtain a mapping curve of the conveyor belt encoder count and the position planning curve.

[0086] Step S103: The robot synthesizes and executes the robot tool end operation trajectory according to the preset programming trajectory and the real-time count of the conveyor belt encoder.

[0087] The robot generates the posture trajectory of the robot tool end relative to the target workpiece according to the teaching programming settings; according to the real-time counting of the conveyor belt encoder, the position vector change of the workpiece as the conveyor belt moves is compensated in real time in the posture trajectory of the robot tool end relative to the target workpiece, and the absolute motion trajectory of the robot tool end in the synchronization stage is obtained and executed.

[0088] Step S104: When the robot completes all synchronization trajectories, it enters the exit phase.

[0089] The remaining absolute motion trajectories of the robot tool end in the synchronization phase are executed sequentially until all preset operation instructions are completed, and the robot enters the exit phase of conveyor belt following.

[0090] Step S105: The robot generates and executes the robot's exit trajectory according to the preset exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and the conveyor belt to complete the exit operation.

[0091] In the above method, the robot conveyor belt following process is decomposed into the tracking phase, the synchronization phase and the exit phase according to the operation requirements.

[0092] Tracking phase: the process from when the robot starts to complete the tracking of the target workpiece on the conveyor belt. When the tracking is completed, the robot tool end is consistent with the conveyor belt speed, and then enters the synchronization phase; the above steps S101-S102 correspond to the tracking phase.

[0093] Synchronization stage: the movement of the target workpiece relative to the conveyor belt is superimposed on the synchronous movement of the conveyor belt; the above steps S103-S104 correspond to the synchronization stage. If there is no synchronous operation task in the actual application, steps S103-S104 are skipped directly, and the robot preset operation instructions are implemented in the teaching programming, such as exploration grasping, gluing and other operations.

[0094] Exit stage: After the robot completes the above operations, it exits from the synchronous motion state of the conveyor belt according to the teaching programming instructions. There are two types of preset exit trajectories, one is to slow down and stop along the direction of the conveyor belt movement, and the other is to stop after running to the preset target point. The above step S105 corresponds to the exit stage.

[0095] In the above step S101, the detection device commonly used in the automated production line is a photoelectric switch, the encoder can be pulse type or bus type, and the robot control system periodically reads the conveyor belt encoder count.

[0096] When the light is blocked by the target workpiece that has just entered the working area, the photoelectric switch generates a switch signal, which directly or indirectly triggers the robot control system to latch the conveyor belt encoder count. When the switch signal is directly connected to the robot control system, the robot uses the taught target workpiece posture for tracking control; when the switch signal is directly connected to the visual device, the robot uses the visually detected target workpiece posture for tracking control. At this time, the switch signal is used to trigger the photo, and the exposure completion signal of the visual device is connected to the robot control system. The visual device sends the target workpiece posture to the programming variables of the robot controller through the bus and control protocol. Of course, the method of obtaining the encoder count value in this application is not limited to the methods listed above, as long as the encoder count value synchronized with the target workpiece posture can be accurately obtained.

[0097] In the above step S102, after receiving the conveyor belt tracking instruction, the robot in the waiting state starts to track the target workpiece entering the working area.

[0098] The target workpiece position and real-time speed of the conveyor belt required for tracking trajectory planning need to be calculated. According to the difference between the real-time and latched counts of the conveyor belt encoder, and the proportional relationship between the calibrated encoder count and the conveyor belt movement displacement, the position offset of the target workpiece from the detection moment to the current moment with the movement of the conveyor belt is determined, and after compensating to the target workpiece position for teaching or detection, the target workpiece position at the current moment is obtained; according to the real-time count change of the conveyor belt encoder within a fixed time T , the encoder count change K corresponding to the unit distance of the conveyor belt movement, calculate the conveyor belt movement speed .

[0099] The position trajectory of the robot tool end relative to the target workpiece is decomposed into three parts: the component of the position trajectory perpendicular to the direction of the conveyor belt movement, the component of the position trajectory parallel to the direction of the conveyor belt movement, and the undecomposed posture trajectory. The first trajectory is a fixed posture trajectory containing the first and third parts, and its initial and final velocities are zero. The second trajectory is a pure position trajectory containing the second part and changing with the movement of the conveyor belt, and its initial and final velocities are zero and All the above curves are planned using the online trajectory generation method, and then the position planning curve is synthesized by position vector, and combined with the electronic cam technology, the absolute motion trajectory of the robot tool end is obtained with the conveyor encoder count replacing the time axis.

[0100] Based on the multi-dimensional online trajectory generation method, the relative position relationship between the robot tool end and the target workpiece can be automatically adapted to generate a smooth curve with optimal time. Figure 4-Figure 9 Shown is the generation of a multi-dimensional synchronized position planning curve and a synthesized robot tool end space trajectory based on an online trajectory generation method. Figure 4 , Figure 5 , Figure 6 The situation shown is that the position of the target workpiece relative to the robot tool end is opposite to the direction of conveyor movement. Figure 4 is the position curve of orthogonal decomposition, Figure 5 is the velocity curve of orthogonal decomposition, Figure 6 The generated tool end trajectory and workpiece trajectory are shown in Figure 2. In this case, the second trajectory (parallel to the conveyor belt direction) first moves in the reverse direction and then accelerates in the forward direction to One manifestation of the time optimality characteristic is that the acceleration is not zero when the velocity is zero. Figure 7 , Figure 8 , Fig. 9 For the case where the position of the target workpiece relative to the robot tool end is in the same direction as the conveyor movement: Figure 7 is the position curve of orthogonal decomposition, Figure 8 is the velocity curve of orthogonal decomposition, Fig. 9 The second trajectory (parallel to the conveyor belt direction) is accelerated and then decelerated along the conveyor belt direction. .

[0101] According to the designed mapping relationship between encoder counts and running time, the electronic cam technology is used to replace the tracking trajectory time with encoder counts. Therefore, the smooth robot tracking trajectory reflects the one-to-one correspondence between the robot tool end posture and the encoder count, regardless of how the actual conveyor belt speed changes. The estimation is not accurate enough, and the method in this embodiment can ensure the accuracy and consistency of the following precision. Further, the conveyor belt following can be debugged in the conveyor belt low speed operation mode, while ensuring the high safety of debugging and the consistency of high speed following precision.

[0102] The online trajectory generation method is one of the most complex robot trajectory planning techniques. Given any initial motion state, that is, no matter what the current motion state is, this method can always generate a time-optimal and smooth piecewise polynomial position curve. The type level determines the number of non-zero configuration parameters such as the degree of the polynomial curve and the target speed. Multidimensional trajectories can be planned independently or synchronously. Each dimensional curve in the synchronously planned multidimensional curve has a different shape and the same total planning time. The online trajectory generation method used in the present application can generate a piecewise cubic polynomial position planning curve, including a deceleration position curve without a target position. The one-dimensional S-shaped acceleration and deceleration curve widely used in industrial control is only a simple case of the method. The teaching programming setting refers to the maximum speed, maximum acceleration and maximum jerk in the motion instruction. The working area on the conveyor belt can be set as needed, and can be further decomposed into a detection area and a working area. The range of motion of the robot following the conveyor belt is usually within the robot's dexterous workspace.

[0103] When the tracking phase is complete, the robot end-of-tool matches the conveyor speed and then moves synchronously with the target workpiece along the conveyor.

[0104] In the above steps S103 and S104, after the robot enters the synchronization stage, the robot teaching programming trajectory type relative to the conveyor belt movement can be joint motion, straight line or circular arc trajectory, etc.

[0105] In the above step S105, there are two types of preset exit trajectories: one is to decelerate and stop along the moving direction of the conveyor belt; the other is to stop after running to a preset target point.

[0106] For the first type of trajectory that decelerates and stops along the direction of movement of the conveyor belt, a one-dimensional deceleration curve is planned based on the real-time speed and acceleration of the robot tool end and the teaching programming settings. The robot tool end decelerates and stops along the direction of movement of the conveyor belt to a point above the conveyor belt.

[0107] For the second trajectory type that stops after running to the preset target point, a multi-dimensional synchronous exit trajectory with optimal time is generated based on the multi-dimensional synchronous online trajectory generation method according to the preset exit target point, teaching programming settings and the real-time motion status of the robot joints.

[0108] Among them, the real-time velocity and acceleration of the robot joint can be obtained by mapping the position, velocity and acceleration of the tool end, or by differential calculation of the joint position sequence obtained after inverse kinematics calculation of the posture trajectory sequence of the robot tool end.

[0109] After the conveyor belt following is completed, the end of the robot tool usually runs to a preset target point, such as the placement position of the workpiece removed from the conveyor belt, the grasping position of the workpiece at the workstation, or the preparation position for the next conveyor belt following. The second exit trajectory proposed in the present invention application allows the robot to run to the preset target point in one step, and it is the time-optimal joint space motion trajectory, and there will be no problem of joint motion overspeed even if it passes through a singular space. If the first exit trajectory of decelerating and stopping along the direction of conveyor belt movement is used, the robot first decelerates and stops along the conveyor belt, and then runs from the stopping point to the target point. Even if the two trajectories are connected by trajectory blending technology to reduce the total running time, the efficiency is still lower than the second exit method of stopping after running to the preset target point.

[0110] Optionally, the above method further includes:

[0111] At any stage of conveyor belt following, if an abnormal situation is detected, the type of abnormal situation is determined; according to the type of abnormal situation, the exception handling method is determined as a processing method that does not require trajectory planning or a processing method that requires trajectory planning; for the processing method that requires trajectory planning, a smooth deceleration trajectory is planned according to the conveyor belt following stage, the current motion state of the robot and the teaching programming setting.

[0112] At any stage of tracking, synchronization and exiting, if the robot needs to exit the conveyor belt due to abnormality or manual operation, it can decelerate and stop smoothly.

[0113] All planning curves mentioned in this embodiment are piecewise cubic polynomial position curves, and the acceleration of each joint is kept continuous during the operation of the robot.

[0114] The above method in the embodiment of the present invention is described by taking the tracking process of a target workpiece by a robot as an example. The following process described in the above method can be executed for each target workpiece arriving on the conveyor belt.

[0115] Embodiment 2

[0116] Embodiment 2 of the present invention provides a specific implementation process of a robot conveyor belt following method, which performs following control on workpieces on the conveyor belt in a queue management manner, and the process is as follows: Fig.10 As shown, the following steps are included:

[0117] Step S201: If it is detected that a target workpiece enters a working area, the target workpiece information is added to a queue.

[0118] The detection device continuously detects the working area. When it detects that the target workpiece enters the working area, the robot control system adds the target workpiece information to the queue. The target workpiece queue is initially empty. After the robot completes the preparation work, it executes the conveyor belt following instruction and enters the waiting state for the target workpiece. The information added to the workpiece queue includes: the latched conveyor belt encoder count, and the corresponding teaching or detection target workpiece posture.

[0119] Step S202: Monitor the target workpiece queue and robot status, and prepare and start conveyor belt target workpiece tracking.

[0120] When the robot is in the state of waiting for the target workpiece or after the robot enters the state of waiting for the target workpiece, the first target workpiece in the queue is removed from the queue and used as the current target to be tracked; if the robot is in the state of waiting for the target workpiece and detects that there is a target workpiece in the working area, the tracking module is instructed to start the tracking process; if it is determined that the current target workpiece can be tracked, the tracking module is instructed to execute the tracking trajectory, otherwise the robot is controlled to remain in the state of waiting for the target workpiece and wait for the next target workpiece.

[0121] The first target workpiece in the queue is removed from the queue and used as the current target to be tracked, including: if the workpiece queue is detected to be non-empty, the first target workpiece in the non-empty workpiece queue is removed from the queue and used as the current target to be tracked. A tracking track can be generated for the tracking target; if the conditions for starting tracking are met, the robot executes the tracking track and then enters the synchronization phase. Otherwise, the robot remains in the waiting state for the target workpiece and continues to detect the workpiece queue. If the queue is not empty, the next workpiece is removed from the queue and used as the new tracking target, and the above operations are repeated.

[0122] When the target workpiece queue is empty, the robot does not perform any operation; when the target workpiece queue is not empty, if the robot is in the waiting state for the target workpiece or after the robot enters the waiting state for the target workpiece, the first target workpiece in the queue will be removed from the queue; if the robot determines that the target workpiece can be tracked, the robot executes the tracking trajectory; otherwise, the robot remains in the waiting state for the target workpiece and waits for the next target workpiece; the condition for starting tracking is that the tracking trajectory does not exceed the working area.

[0123] After starting the tracking, the tracking, synchronization and exit processes refer to the relevant description of the first embodiment, which will not be repeated here.

[0124] Step S203: After successfully executing all preset tracks in the synchronization phase and the exit track in the exit phase, execute step S202.

[0125] Due to the uneven distance between workpieces on the conveyor belt or the fluctuation of conveyor belt speed, the queue mechanism ensures that all workpiece information is recorded in time. In the case where workpieces arrive at the work area densely, the queue mechanism can reduce the time the robot waits for new target workpieces. In addition, the robot may not have time to grab some workpieces. If it cannot make a judgment in advance and starts following directly, it will compress the time to track subsequent workpieces, that is, the robot cannot track the workpiece that could have been tracked. If the robot determines that the current target workpiece cannot be tracked, the robot remains in the waiting state for the target workpiece and waits for the next target workpiece.

[0126] Abnormal situations include but are not limited to: the robot tool end trajectory exceeds the working area, or passes through the robot singularity point, the robot joint speed exceeds the limit, etc. In addition to the default abnormal handling method, if the robot predicts that the tracking fails or the trajectory exceeds the working area during the synchronization stage, the user can choose to exit or continue the next workpiece tracking through teaching programming.

[0127] In case of active or abnormal exit operation at any stage of conveyor belt following, smooth exit trajectory is planned in different ways. In the tracking stage, according to the chain derivation relationship of composite function, the current position, speed and acceleration of the two planning curves are converted into actual values ​​by using the real-time motion parameter estimation of the conveyor belt, and then the deceleration planning curve is generated by the online trajectory generation method, and then synthesized into the absolute running trajectory of the robot tool end. In the synchronization stage, during the execution of the preset trajectory, according to the real-time speed and acceleration of the conveyor belt, the online trajectory generation method is used to plan the preset trajectory deceleration curve and the deceleration curve of the synchronous motion of the conveyor belt, and then synthesized into the absolute running trajectory of the robot tool end; otherwise, the robot tool end is completely synchronized with the conveyor belt motion, and the deceleration planning method is the same as the first exit trajectory in the exit stage, that is, deceleration and stop along the direction of the conveyor belt motion. During the exit phase, if the first exit trajectory is in operation, there is no need to re-plan when the maximum acceleration and jerk in the teaching parameter settings remain unchanged. Otherwise, the one-dimensional deceleration trajectory is re-planned using new parameters in the same way as the first exit trajectory. If the second exit trajectory is in operation, the online trajectory generation method is used to generate a synchronized and time-optimal joint deceleration position curve based on the real-time position, velocity and acceleration of the robot joints. The planning of the deceleration position curve does not specify a target position, that is, based on the current motion state, the robot executes the most reasonable joint motion trajectory for a quick stop.

[0128] The above method of this embodiment performs follow-up control in the form of target workpiece queue management, which can adapt to more complex application scenarios, simplify user teaching programming, and improve conveyor belt following efficiency.

[0129] The current tracking control method is generally an offline trajectory with a known starting point and end point. The above method provided in this application is an online trajectory planning method. No matter where the robot is, it can start planning the trajectory at any time and inherit the original trajectory.

[0130] Based on the same inventive concept, the embodiment of the present invention further provides a robot conveyor belt following device, which can be arranged in a device or controller having a computing and processing function. The structure of the device is as follows: Fig.11 As shown, including:

[0131] The tracking module 111 is used to generate and execute the robot tool end tracking trajectory based on the latching and real-time counting of the conveyor encoder, the recorded target workpiece posture and the robot's teaching programming settings, based on a multi-dimensional online trajectory generation method. When the tracking trajectory is completed, the robot tool end is consistent with the target workpiece speed.

[0132] The exit module 113 is used to generate and execute the robot's exit trajectory according to the preset exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and the conveyor belt.

[0133] Optionally, the above device further includes at least one of the following modules:

[0134] The synchronization module 112 is used to synthesize and execute the robot tool end operation trajectory according to the preset programming trajectory and the real-time count of the conveyor belt encoder. When the robot completes all the synchronization trajectories, it enters the exit stage.

[0135] The workpiece queue management module 114 is used to add the target workpiece information to the queue if it is detected that the target workpiece enters the working area; when the robot is in the state of waiting for the target workpiece or after the robot enters the state of waiting for the target workpiece, the first target workpiece in the queue is removed from the queue and used as the current target to be tracked.

[0136] The tracking control module 115 is used to instruct the tracking module to start the tracking process if the robot is in the state of waiting for the target workpiece and detects the presence of the target workpiece in the working area; if it is determined that the current target workpiece can be tracked, it instructs the tracking module to execute the tracking trajectory, otherwise it controls the robot to remain in the state of waiting for the target workpiece and wait for the next target workpiece.

[0137] An embodiment of the present invention further provides a robot conveyor belt following system, comprising: a robot 1 and a conveyor belt system 2.

[0138] The robot 1 includes a robot body 11, a control system 12 and an end tool 13. The control system 12 includes an encoder synchronization acquisition module 121 and the above-mentioned robot conveyor belt following device 122. The robot operates the workpiece on the conveyor belt through the tool.

[0139] The encoder synchronization acquisition module 122 is used to periodically read the conveyor belt encoder count and trigger the robot control system hardware latch encoder count function according to the switch signal generated by the detection device.

[0140] The conveyor belt system 2 includes a conveyor belt 21 and an encoder 22 installed on the conveyor belt. The change in encoder count is proportional to the moving distance of the conveyor belt. The robot obtains the encoder count through the encoder synchronization acquisition module.

[0141] An embodiment of the present invention further provides a computer storage medium, in which computer executable instructions are stored. When the computer executable instructions are executed by a processor, the above-mentioned robot conveyor belt following method is implemented.

[0142] An embodiment of the present invention further provides a controller, comprising: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the above-mentioned robot conveyor belt following method when executing the program.

[0143] Regarding the device in the above embodiment, the specific manner in which each module performs operations has been described in detail in the embodiment of the method, and will not be elaborated here.

[0144] Unless otherwise specifically stated, terms such as processing, computing, calculating, determining, displaying, etc. may refer to the actions and / or processes of one or more processing or computing systems, or similar devices, which operate and convert data represented as physical (e.g., electronic) quantities within registers or memories of a processing system into other data similarly represented as physical quantities within memories, registers, or other such information storage, transmission, or display devices of the processing system. Information and signals may be represented using any of a variety of different techniques and methods. For example, data, instructions, commands, information, signals, bits, symbols, and chips mentioned throughout the above description may be represented by voltages, currents, electromagnetic waves, magnetic fields or particles, light fields or particles, or any combination thereof.

[0145] It should be understood that the specific order or hierarchy of steps in the disclosed process is an example of an exemplary method. Based on design preferences, it should be understood that the specific order or hierarchy of steps in the process can be rearranged without departing from the scope of protection of the present disclosure. The attached method claims present the elements of the various steps in an exemplary order and are not intended to be limited to the specific order or hierarchy described.

[0146] In the above detailed description, various features are grouped together in a single embodiment to simplify the disclosure. This method of disclosure should not be interpreted as reflecting an intention that the embodiments of the claimed subject matter require more features than are clearly stated in each claim. On the contrary, as reflected in the appended claims, the invention is in a state of having less than all the features of the disclosed individual embodiments. Therefore, the appended claims are hereby expressly incorporated into the detailed description, with each claim standing on its own as a separate preferred embodiment of the invention.

[0147] Those skilled in the art will also appreciate that the various illustrative logic blocks, modules, circuits, and algorithmic steps described in conjunction with the embodiments herein can all be implemented as electronic hardware, computer software, or a combination thereof. In order to clearly illustrate the interchangeability between hardware and software, various illustrative components, blocks, modules, circuits, and steps are generally described above around their functions. Whether such functions are implemented as hardware or software depends on specific applications and the design constraints imposed on the entire system. A skilled person can implement the described functions in an alternative manner for each specific application, but such implementation decisions should not be interpreted as departing from the scope of protection of the present disclosure.

[0148] The steps of the method or algorithm described in conjunction with the embodiments herein may be directly embodied as hardware, a software module executed by a processor, or a combination thereof. The software module may be located in a RAM memory, a flash memory, a ROM memory, an EPROM memory, an EEPROM memory, a register, a hard disk, a mobile disk, a CD-ROM, or any other form of storage medium well known in the art. An exemplary storage medium is connected to the processor so that the processor can read information from the storage medium and can write information to the storage medium. Of course, the storage medium may also be an integral part of the processor. The processor and the storage medium may be located in an ASIC. The ASIC may be located in a user terminal. Of course, the processor and the storage medium may also be present in a user terminal as discrete components.

[0149] For software implementation, the techniques described in this application can be implemented with modules (e.g., procedures, functions, etc.) that perform the functions described in this application. These software codes can be stored in a memory unit and executed by a processor. The memory unit can be implemented within the processor or outside the processor. In the latter case, it is coupled to the processor in a communication manner via various means, which are well known in the art.

[0150] The above description includes examples of one or more embodiments. Of course, it is impossible to describe all possible combinations of components or methods for the purpose of describing the above embodiments, but it should be recognized by those skilled in the art that the various embodiments may be further combined and arranged. Therefore, the embodiments described herein are intended to cover all such changes, modifications and variations that fall within the scope of protection of the appended claims. In addition, with respect to the term "comprising" used in the specification or claims, the word is covered in a manner similar to the term "including", just as "including," is explained as a transitional word in the claims. In addition, any term "or" used in the specification of the claims is intended to mean "non-exclusive or".

Claims

1. A robot conveyor belt following method, characterized in that: include: In the workpiece tracking stage, the robot generates and executes the robot tool end tracking trajectory based on the multi-dimensional online trajectory generation method according to the latching and real-time counting of the conveyor encoder, the target workpiece posture at the detection time, and the robot's teaching programming settings. When the tracking trajectory is completed, the robot tool end and the target workpiece have the same speed; In the exit phase, the robot generates and executes the robot's exit trajectory according to the preset exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and conveyor belt; among which: The robot generates and executes the robot tool end tracking trajectory based on the multi-dimensional online trajectory generation method according to the latching and real-time counting of the conveyor encoder, the target workpiece posture at the detection time, and the robot's teaching programming settings, including: When the target workpiece is detected to enter the working area, the robot control system locks the conveyor belt encoder count and records the target workpiece posture at the detection time; the robot in the state of waiting for the target workpiece calculates the target workpiece posture at the current moment based on the encoder count and the target workpiece posture at the detection time; Orthogonally decomposing the linear tracking trajectory of the robot tool end posture relative to the target workpiece posture at the current moment to obtain an orthogonal trajectory; the orthogonal trajectory includes a fixed linear posture trajectory perpendicular to the conveyor belt movement direction and a linear position trajectory parallel to the conveyor belt movement direction and changing with the conveyor belt movement; Based on the teaching programming setting and conveyor belt speed estimation, the online trajectory generation method is used to simultaneously plan the orthogonal trajectories to generate time-synchronized position planning curves; Based on the conversion relationship between encoder count and motion time designed by electronic cam technology, determine the interpolation moment of the position planning curve corresponding to the current encoder count, obtain the current interpolation position of the orthogonal trajectory, and then obtain the interpolation posture of the robot tool end through position vector synthesis; The robot tool end tracking trajectory is synthesized and executed according to the interpolated posture at each moment.

2. The method according to claim 1, characterized in that Design the conversion relationship between encoder count and motion time based on electronic cam technology, including: According to the expected conveyor belt movement speed, a linear or nonlinear one-to-one mapping curve between encoder count and movement time is designed, and the one-to-one mapping curve is functionally compounded with the position planning curve of the orthogonal trajectory to obtain the mapping curve of the conveyor belt encoder count and the position planning curve.

3. The method according to claim 1, characterized in that When the target workpiece is detected to enter the working area, the robot control system locks the conveyor belt encoder count and records the target workpiece position at the detection time, including: When the target workpiece is detected to enter the working area, the detection device generates a switch signal, directly triggering the robot control system hardware latch conveyor encoder counting function, and uses the taught robot tool end posture as the target workpiece posture at the detection time; or When the target workpiece is detected to enter the working area, the detection device generates a switch signal, which indirectly triggers the counting function of the robot control system hardware latch conveyor encoder based on the detection results of the visual system, and uses the target workpiece posture detected by the visual system as the detected workpiece posture at the recording time.

4. The method according to claim 1, characterized in that The exit trajectory types include: decelerating and stopping along the moving direction of the conveyor belt and stopping after running to a preset target point; The robot generates and executes the robot's exit trajectory according to the preset exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and the conveyor belt, including: For the exit trajectory type of decelerating and stopping along the direction of the conveyor belt, a one-dimensional deceleration curve is planned based on the real-time speed and acceleration of the robot tool end and the teaching programming settings. The robot tool end decelerates and stops along the direction of the conveyor belt to a certain point above the conveyor belt. For the exit trajectory type that stops after running to the preset target point, a multi-dimensional synchronous exit trajectory with optimal time is generated based on the online trajectory generation method according to the preset exit target point, teaching programming settings and the real-time motion status of the robot joints.

5. The method according to any one of claims 1 to 4, characterized in that: Also includes: Exception handling and exit mechanism during conveyor belt following process: At any stage of conveyor belt following, if an abnormal situation is detected, the type of abnormal situation is determined; According to the type of abnormal situation, determine the abnormality handling method as a method that does not require trajectory planning or a method that requires trajectory planning; For processing methods that require trajectory planning, a smooth deceleration trajectory is planned based on the conveyor belt following phase, the robot's current motion state, and the teaching programming settings.

6. The method according to any one of claims 1 to 4, characterized in that: Also includes: If the target workpiece is detected to enter the working area, the target workpiece information is added to the queue; When the robot is in the state of waiting for the target workpiece or after the robot enters the state of waiting for the target workpiece, the first target workpiece in the queue is removed from the queue and used as the current target to be tracked; If the robot is in the state of waiting for the target workpiece and detects that there is a target workpiece in the working area, it will instruct the tracking module to start the tracking process; If it is determined that the current target workpiece can be tracked, the tracking module is instructed to execute the tracking trajectory, otherwise the robot is controlled to remain in the waiting state for the target workpiece, waiting for the next target workpiece.

7. A robot conveyor belt following device, characterized in that: The device is used to implement the robot conveyor belt following method according to any one of claims 1 to 6, comprising: The tracking module is used to generate and execute the robot tool end tracking trajectory based on the latch and real-time counting of the conveyor encoder, the recorded target workpiece posture and the robot's teaching programming settings, based on the multi-dimensional online trajectory generation method. When the tracking trajectory is completed, the robot tool end and the target workpiece have the same speed; The exit module is used to generate and execute the robot's exit trajectory according to the preset exit trajectory type, teaching programming settings, and real-time motion parameter estimation of the robot and conveyor belt.

8. The device according to claim 7, characterized in that Also includes: A workpiece queue management module is used to add the target workpiece information to the queue if it is detected that the target workpiece enters the working area; When the robot is in the state of waiting for the target workpiece or after the robot enters the state of waiting for the target workpiece, the first target workpiece in the queue is removed from the queue and used as the current target to be tracked; The tracking control module is used to instruct the tracking module to start the tracking process if the robot is in a state of waiting for the target workpiece and detects that there is a target workpiece in the working area; If it is determined that the current target workpiece can be tracked, the tracking module is instructed to execute the tracking trajectory, otherwise the robot is controlled to remain in the waiting state for the target workpiece, waiting for the next target workpiece.

9. A robot conveyor belt following system, characterized in that: include: Robotics and conveyor systems; The robot comprises a robot body, a control system and an end tool, wherein the control system comprises an encoder synchronous acquisition module and a robot conveyor belt following device as claimed in any one of claims 7 to 8, and the robot operates the workpiece on the conveyor belt through the tool; The encoder synchronization acquisition module is used to periodically read the conveyor belt encoder count and trigger the robot control system hardware latch encoder count function according to the switch signal generated by the detection device; The conveyor belt system includes a conveyor belt and an encoder installed on the conveyor belt. The change in encoder count is proportional to the moving distance of the conveyor belt. The robot obtains the encoder count through an encoder synchronization acquisition module.

10. A computer storage medium, characterized in that: The computer storage medium stores computer executable instructions, and when the computer executable instructions are executed by the processor, the robot conveyor belt following method described in any one of claims 1-6 is implemented.

11. A controller, characterized in that: include: A memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the program, the robot conveyor belt following method described in any one of claims 1 to 6 is implemented.