Robot arm compliant control method, storage medium and robot system
By analyzing the position difference value of the robot arm drive and planning the flexible motion parameters, the synchronous and flexible motion of the robot arm is achieved, and the problems of slow response, low accuracy and high cost in the existing technology are solved, and the motion coordination of the cooperative robot arm is improved. and real-time.
Patent Information
- Application Number
- CN202410030627.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-01-09
- Publication Date
- 2024-11-01
- Estimated Expiration
- 2044-01-09
AI Technical Summary
The existing robotic arm compliant control solutions have problems such as slow response, low accuracy, large computing resource utilization, high cost and poor real-time performance, making it difficult to achieve flexible motion and low-cost promotion and application of collaborative robotic arms in complex tasks.
By receiving information from multiple drivers, analyzing the target position and the current position difference, determining the master drive and the slave drive, planning the flexible motion parameters of the slave drive according to the motion parameters of the master drive, and applying instructions to achieve synchronous flexible motion.
It realizes synchronous and flexible movement of multiple drivers, improves the coordination and real-time movement of the robotic arm, reduces production costs, and enhances human-computer interaction experience and security.
Smart Images

Figure CN117798915B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of robot arm compliance control, and in particular, to a robot arm compliance control method, a storage medium and a robot system. Background Art
[0002] As robots are increasingly used, the environment they face is becoming increasingly complex. When robots perform specific tasks, they often need to consider the physical contact between the robot and the environment. As a bionic artificial intelligence, controlling the robot to smoothly and efficiently complete the predetermined actions will give users a good human-machine interaction experience, and on the other hand, it can also improve the safety of the equipment during operation.
[0003] The compliant control scheme of the robot arm can be divided into passive compliant control, active compliant control and position compliant control. Passive compliance is to use energy storage elements (springs, damping elements, cylinders, etc.) to achieve flexible contact between the robot arm and the target part to avoid impact problems during the contact process; the essence of active compliance is to adopt corresponding active control strategies for the signal feedback of the contact force to achieve force compliance during the movement of the robot arm; position compliance refers to the realization of compliant motion planning by adjusting the joint parameters of the robot arm (position, speed, acceleration, etc.).
[0004] However, the above-mentioned compliant control schemes have many drawbacks. The passive compliant control scheme has a slow response and execution to actions due to the introduction of energy storage elements, and its accuracy is not high. Although the active compliant control scheme has high control accuracy, it usually relies on complex algorithms or model training, which takes up a lot of computing resources, takes a long time, is difficult to implement, and has limited application due to high costs. Traditional position compliant control schemes are difficult to achieve real-time conversion between control signals and planned actions, and there are tracking errors and poor real-time performance of actions, which seriously affects the human-computer interaction experience of the robot arm (especially the collaborative robot arm) and even poses a safety risk.
[0005] How to make the movement of robotic arms (especially collaborative robotic arms) as planned and measured as that of humans, complete complex tasks in human-computer interaction scenarios (such as home scenarios) in real time and smoothly, and be able to promote and apply them at a lower production cost, is the challenge currently faced by the compliant control of robotic arms.
[0006] It should be understood that the contents described in this background technology section are only used to help understand the technical solutions disclosed in this application, and do not necessarily belong to the prior art before the filing date of this application. Summary of the invention
[0007] On the one hand, the present application provides a method for compliant control of a robotic arm, wherein the robotic arm includes multiple drivers, and the method includes: receiving information of the multiple drivers and storing the information in a cache queue; parsing the difference between the target position and the current position of each of the multiple drivers, wherein the driver corresponding to the maximum difference among all the differences is a master driver, and the remaining drivers other than the master driver are slave drivers; planning the compliant motion parameters of the slave drivers according to the motion parameters of the master driver; and applying instructions to each of the multiple drivers to enable the multiple drivers to achieve synchronous compliant motion.
[0008] In one embodiment, the control unit receives the information and stores the information in the cache queue, and the operation of the control unit and the operation of the driver are implemented based on the same set of algorithms.
[0009] In one embodiment, the instructions include parameter instructions and synchronous motion instructions, and the method of applying instructions to each of the multiple drivers includes: applying the parameter instructions to each of the multiple drivers in turn; and applying the synchronous motion instructions to the multiple drivers at the same time after applying the parameter instructions.
[0010] In one embodiment, the parameter instruction includes a first parameter sub-instruction and a second parameter sub-instruction, the first parameter sub-instruction corresponds to the motion parameter of the master drive, the second parameter sub-instruction corresponds to the compliant motion parameter of the slave drive, and applying the parameter instruction to each of the drives includes: applying the first parameter sub-instruction to the master drive, and applying the second parameter sub-instruction to the slave drive.
[0011] In one embodiment, the motion parameters of the master drive include at least one of the maximum difference, the maximum speed of the master drive, and the maximum acceleration of the master drive; and the compliant motion parameters of the slave drive include at least one of the maximum speed of the slave drive, the acceleration of the slave drive, and the deceleration of the slave drive.
[0012] In one embodiment, the method for planning the compliant motion parameters of the slave drive includes: obtaining the maximum difference, the maximum speed of the master drive and the maximum acceleration of the master drive; calculating the acceleration motion phase time, the uniform motion phase time and the deceleration motion phase time of the master drive; and calculating at least one of the maximum speed of the slave drive, the acceleration of the slave drive and the deceleration of the slave drive.
[0013] In one embodiment, the acceleration phase time, uniform motion phase time and deceleration phase time of the master drive are calculated according to the trapezoidal motion planning, wherein the acceleration phase time, uniform motion phase time and deceleration phase time of the master drive and the slave drive are the same.
[0014] In one embodiment, the movement of the driver includes multiple segments of movement, the driver enters the deceleration movement stage in the current segment of movement, and there are points to be executed in the cache queue, and the method also includes: determining whether the current position of each of the drivers is within a preset range; recalculating the maximum difference and determining a new master driver and a new slave driver based on the recalculated new maximum difference; reobtaining the motion parameters of the new master driver in the next segment of movement; and replanning the smooth motion parameters of the new slave driver in the next segment of movement.
[0015] In one embodiment, the information includes position information of the driver; or the information includes position information of the driver and at least one of angular velocity information of the driver and angular acceleration information of the driver.
[0016] On the other hand, the present application discloses a storage medium storing a program, wherein when the program is executed, the robot arm compliant control method as described in any of the above-mentioned embodiments is implemented.
[0017] On the other hand, the present application provides a robot system, characterized in that the system includes: a robot arm as in any of the above-mentioned embodiments; a processor; and a memory, which is communicatively connected to the processor and stores executable computer program instructions, wherein the computer program instructions are executed by the processor to implement the robot arm compliant control method as described in any of the above-mentioned embodiments.
[0018] In one embodiment, the system further includes: a control unit, which is communicatively connected to the robotic arm and is used to receive and analyze signals from the robotic arm.
[0019] The robot arm compliance control method provided in the present application may have at least one of the following beneficial effects:
[0020] According to the robot arm compliant control method in some embodiments of the present application, the compliant motion parameters of the slave drive are planned by analyzing the motion parameters of the master drive among multiple drives, which is conducive to establishing a planning relationship between the master drive and the slave drive, thereby facilitating the realization of synchronous compliant motion of multiple drives under the application of instructions.
[0021] According to the robot arm compliant control method in some embodiments of the present application, by comparing the difference between the target position and the current position of each driver, the maximum difference among all differences can be obtained, thereby performing master-slave classification of the drivers, which is conducive to the planning of the driver motion parameters.
[0022] Other features and advantages of the embodiments of the present invention will be described in the subsequent description, and partly become apparent from the description, or understood by practicing the present invention. The purposes and other advantages of the embodiments of the present invention can be achieved and obtained by the structures and / or functions specifically pointed out in the description, claims and drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0023] Other features, purposes and advantages of the present application will become more apparent through the following detailed description of non-limiting embodiments in conjunction with the accompanying drawings. In the accompanying drawings:
[0024] Figure 1 is a flowchart of a robot arm compliance control method 1000 according to an exemplary embodiment of the present application.
[0025] Figure 2 It is a functional schematic diagram of each module in the robot arm compliance control method according to an exemplary embodiment of the present application.
[0026] Figure 3 It is a schematic diagram of multiple position points in the robot arm compliance control method according to an exemplary embodiment of the present application.
[0027] Figure 4 It is a schematic diagram of single-segment trapezoidal motion planning in the compliant control method of a robot arm according to an exemplary embodiment of the present application.
[0028] Figure 5 It is a schematic diagram of multi-segment trapezoidal motion planning in a compliant control method of a robot arm according to an exemplary embodiment of the present application.
[0029] Figure 6 It is a schematic structural diagram of a robot system according to an exemplary embodiment of the present application.
[0030] Figure 7 It is a schematic diagram of the workflow of the robot system according to an exemplary embodiment of the present application. DETAILED DESCRIPTION
[0031] In order to better understand the present application, a more detailed description will be made of various aspects of the present application with reference to the accompanying drawings. It should be understood that these detailed descriptions are only descriptions of exemplary embodiments of the present application, and are not intended to limit the scope of the present application in any way. Throughout the specification, the same reference numerals refer to the same elements. The expression "and / or" includes any and all combinations of one or more of the associated listed items.
[0032] It should be noted that in this specification, expressions such as "first", "second", etc. are only used to distinguish one feature from another feature, and do not represent any limitation on the features, especially do not represent any order of precedence. Therefore, without departing from the teaching of this application, the first parameter sub-instruction discussed in this application may also be referred to as the second parameter sub-instruction, and vice versa.
[0033] In the specification, references to "one embodiment," "an embodiment," "an example embodiment," "some embodiments," etc. indicate that the described embodiment may include a particular feature, structure, or characteristic, but every embodiment may not necessarily include the particular feature, structure, or characteristic. Furthermore, these phrases do not necessarily refer to the same embodiment. Furthermore, when a particular feature, structure, or characteristic is described in conjunction with an embodiment, whether or not explicitly described, it will be within the knowledge of a person skilled in the relevant art to implement such feature, structure, or characteristic in conjunction with other embodiments.
[0034] In the drawings, the thickness, size and shape of the components have been slightly adjusted for ease of illustration. The drawings are for illustration only and are not strictly drawn to scale. For example, the dimensions of the robotic arms drawn in the drawings in this application are not in scale as in actual production. As used herein, "substantially," "approximately," and similar terms are used as terms of approximation, not as terms of degree, and are intended to illustrate the inherent deviations in measurements or calculations that will be recognized by those of ordinary skill in the art.
[0035] It should be understood that expressions such as "include", "including", "have", "contain" and / or "comprising" are open rather than closed expressions in this specification, which indicate the presence of the stated features, elements and / or components, but do not exclude the presence of one or more other features, elements, components and / or combinations thereof. In addition, when expressions such as "at least one of..." appear after a list of listed features, they modify the entire list of features rather than just the individual elements in the list. In addition, when describing embodiments of the present application, "may" is used to mean "one or more embodiments of the present application". And, the term "exemplary" is intended to refer to an example or illustration.
[0036] It should also be understood that the meanings of terms such as “on,” “above,” and “over” should be interpreted in the broadest manner, so that “on” means not only “directly on something,” but also includes “on something” with intervening features or layers therebetween, and “above” or “over” means not only “above” or “over” something, but also includes being “above” or “over” something without intervening features or layers therebetween (i.e., directly on something).
[0037] Unless otherwise defined, all words (including engineering terms and scientific and technological terms) used in this article have the same meaning as those commonly understood by ordinary technicians in the field to which this application belongs. It should also be understood that unless there is a clear explanation in this application, words defined in commonly used dictionaries should be interpreted as having the same meaning as their meaning in the context of the relevant technology, and should not be interpreted in an idealized or overly formal sense.
[0038] It should be noted that, in the absence of conflict, the embodiments and features in the embodiments in this application can be combined with each other. In addition, unless explicitly limited or contradictory to the context, the specific steps included in the method recorded in this application are not necessarily limited to the recorded order, but can be performed in any order or in parallel.
[0039] The features, principles and other aspects of the present application will be described in detail below in conjunction with the accompanying drawings.
[0040] Figure 1 FIG. 1 is a flow chart of a method 1000 for controlling compliance of a robot arm according to an exemplary embodiment of the present application. Figure 1 As shown, the present application provides a robot arm compliance control method 1000 including:
[0041] Step S1100, receiving information of multiple drivers and storing the information in a cache queue;
[0042] Step S1200, parsing the difference between the target position and the current position of each of the multiple drivers, wherein the driver corresponding to the maximum difference among all the differences is the master driver, and the remaining drivers other than the master driver are slave drivers;
[0043] Step S1300, planning the compliant motion parameters of the slave drive according to the motion parameters of the master drive; and
[0044] Step S1400: applying instructions to each of the multiple drivers to enable the multiple drivers to achieve synchronous and compliant motion.
[0045] It should be understood that the steps shown in method 1000 are not exclusive, and other steps may be performed before, after, or between any of the steps shown. In addition, some of the steps shown may be performed simultaneously or in different steps. Figure 1 The following is performed in the order shown. Figures 1 to 6 The above steps S1100 to S1400 are further described.
[0046] Step S1100, receiving information of multiple drivers, and storing the information in a cache queue.
[0047] Figure 2 is a functional schematic diagram of each module in the robot arm compliance control method according to an exemplary embodiment of the present application. Figure 2 As shown, the robot arm 100 includes a plurality of drivers 110, and can receive information of the plurality of drivers 110 and store the information in a cache queue. In some embodiments, a control unit 200 is used to receive information of the plurality of drivers 110, and the control unit 200 stores the information in a cache queue. The information of the driver 110 can be sent by the host computer 300.
[0048] In some embodiments, the information of the plurality of drivers 110 is information of each driver 110. The information of the driver 110 may include only position information. In other embodiments, the information of the driver 110 includes not only position information but also at least one of angular velocity information and angular acceleration information.
[0049] It should be noted that in the working state, the driver 110 performs a rotational motion. The "position" described in the context of this application may refer to the rotation angle of the driver 110 relative to the starting point during the rotation process; the "speed" described in the context of this application refers to the rotation speed, that is, the angular velocity; the "acceleration" and "deceleration" described refer to the rotation acceleration and rotation deceleration, that is, the angular acceleration and angular deceleration, respectively.
[0050] It should also be noted that the operation of the control unit 200 and the operation of the driver 100 are implemented based on the same set of algorithms. This setting allows the driver 100 to form a real-time system with the control unit 200, and can achieve millisecond-level signal / action real-time feedback, thereby eliminating following errors and facilitating the synchronous movement of multiple drivers 100.
[0051] Step S1200, parsing the difference between the target position and the current position of each of the multiple drivers, wherein the driver corresponding to the maximum difference among all the differences is the master driver, and the remaining drivers except the master driver are slave drivers.
[0052] The control unit 200 can analyze the current position of each driver 110 and compare it with the target position of each driver 110 to calculate the corresponding difference. For example, the driver with the largest difference compared to the target position among all the drivers 110 is the main driver 111 (refer to Figure 6 ), the maximum difference is recorded as S max , the remaining drivers other than the master driver 111 are slave drivers 112 (reference Figure 6 ). Further, the number of slave drivers 112 may be multiple.
[0053] Exemplarily, the motion of the driver 110 includes multiple motions consisting of multiple position points, and the current position of the driver 110 may be the first position point among the multiple position points, or may be a position between two position points. The target position may be a second position point adjacent to the current position and after the current position. For a single driver 110, the distances between its two position points may be the same or different, and a suitable distance may be planned according to actual work needs. For different drivers 110, the distances between their two corresponding position points may also be different.
[0054] Figure 3 Schematic diagram of multiple position points in the robot arm compliance control method according to an exemplary embodiment of the present application. Figure 3 As shown, the main driver 111 may include multiple positions P1 to P5 during its movement, and the slave driver 112 may include multiple positions P1' to P5' during its movement. Each position point in the main driver 111 corresponds to each position point in the slave driver 112 on the time axis T. The distance between the first position point P1 and the second position point P2 in the main driver 111 is s , the distance between the first position point P1' and the second position point P2' in the slave driver 112 is s ',but s Can not s 'same, and s Can be greater than s '; Similarly, when there are multiple slave drivers 112, for different slave drivers 112, the distances between two corresponding position points on the time axis T may be different.
[0055] Understandably, Figure 3 The positions shown are not the movement positions of the driver 110 (including the master driver 111 and the slave driver 112) during the actual rotation process, but the planned movement positions of the driver 110 by the host computer 300 when the robot 100 performs an action. The number of position points is set to 5 for exemplary purposes only, and those skilled in the art may also select any other number of position points, and this application does not make specific requirements for this.
[0056] Step S1300 , planning the compliant motion parameters of the slave driver according to the motion parameters of the master driver.
[0057] For example, the motion parameters of the main driver 111 may include a maximum difference S max , the maximum speed of the main drive 111 v -Mmax *k, maximum acceleration a -Mmax * at least one of k. k is the maximum speed ratio set by the host computer 300, and the value range of k is [0, 100%]. In actual work, the host computer 300 will set different maximum speed ratios k according to the operation plan. The k value will affect the motion parameters of the main driver 111 and the compliant motion parameters of the slave driver 112, so that the two can work together to achieve the compliant operation of the robot arm. The compliant motion parameters of the slave driver 112 include the maximum speed of the slave driver 112 v -Smax , the acceleration of the slave driver 112 a -S and the deceleration of the slave driver 112 d -S The compliant motion parameters of the slave driver 112 may be planned according to the motion parameters of the master driver 111.
[0058] Figure 4 Schematic diagram of single-segment trapezoidal motion planning in the compliant control method of a robot arm according to an exemplary embodiment of the present application. Figure 3 and Figure 4 As shown, Figure 4 The horizontal axis represents the time axis, and the vertical axis represents the speed axis. Figure 4 On the timeline T 1 and T 2 can correspond to Figure 3 On the timeline T 1 and T 2. The method for planning the compliant motion parameters of the slave drive 112 includes first obtaining the maximum difference S max , the maximum speed of the main drive 111 v -Mmax *k (corresponding to v 1) and maximum acceleration a -Mmax *k. Then calculate the acceleration phase time of the main drive 111 t 1, t 1 Satisfaction t 1=( v -Mmax *k) / ( a-Mmax *k), uniform motion phase time t 2 and deceleration phase time t 3. Combined with the total planning time of a section ( T 2 and T 1) can be obtained as Figure 4 Since the acceleration phase time, uniform motion phase time and deceleration phase time of the slave driver 112 correspond to the above phase time of the master driver 111 and have the same duration, t 1. t 2. t 3 also respectively represent the acceleration, uniform speed and deceleration movement phase times of the slave driver 111.
[0059] For example, the movement distance (ie, the rotation angle) of the slave driver 112 may correspond to v 2 or v 3 is the area of the trapezoid corresponding to . v 2. v 3 are located above and below the horizontal axis, respectively, which represent that the slave driver 112 rotates in opposite directions. t 1. t 2. t 3 to calculate the maximum speed of the slave drive 112 v -Smax , the acceleration of the slave driver 112 a -S and the deceleration of the slave driver 112 d -S At least one of .
[0060] Figure 5 Schematic diagram of multi-segment trapezoidal motion planning in the compliant control method of a robot arm according to an exemplary embodiment of the present application. Figure 3 and Figure 5 As shown, Figure 5 On the timeline T 1. T 2. T 3 can correspond to Figure 3 On the timeline T 1. T 2. T 3. In other words, during the multi-stage motion process of the driver 110, each stage of the motion will be subject to separate trapezoidal motion planning. Figure 5 The two graphs shown (including T 1- T 2 paragraphs and T 2- T 3) is only an example, and may also include Figure 3The corresponding other segment graphics.
[0061] In some embodiments, when the driver 110 enters the current segment (e.g. T 1- T 2) deceleration movement stage in the movement, at this time, there are still points to be executed in the cache queue (such as P3 position point). In this case, the compliant control method of the robot arm also includes: determining whether the current position of each of the multiple drivers 110 has entered the preset range; if the current position of each driver 110 is analyzed by the control unit 200 to be within the preset range, recalculating the new maximum difference between all drivers 110 and the target position at this time S’ max , and based on the new maximum difference S’ max Determine the new master drive 111' and the new slave drive 112'; then re-acquire the new master drive 111' in the next section ( T 2- T 3) Movement parameters in motion (the content of the movement parameters can be referred to T 1- T 2 segment motion parameter content); and re-planning the new slave driver 112' in the next segment ( T 2- T 3) Smooth motion parameters in motion (the smooth motion parameters can be found in T 1- T 2-stage smooth motion parameter content).
[0062] like Figure 5 As shown, in T 1- T 2nd segment v The driver 110 corresponding to 1 becomes the main driver 111 of the current segment because the difference between the driver 110 and the target position is the largest. S accu ( S accu The new maximum difference between all drivers 110 and the target position will be recalculated when the maximum difference between all drivers 110 and the target position is within the shaded range shown. S’ max .exist T 2- T 3 sections v 2'( T 1- T 2-segment v 2) The corresponding drive 110 becomes the new master drive 111', and T 1- T The 2-stage main driver 111 is transformed into T 2-T 3-stage slave driver 112'.
[0063] In some embodiments, the preset range S accu It can be a precision value, and the movement of each driver 110 enters the preset range S accu Refers to the difference between the current motion position of each driver 110 and the end position of the motion segment w ≤ S accu . For example, S accu 0.1° is acceptable
[0064] The above design is conducive to realizing coordinated planning in multi-segment motion, dividing a whole set of motion into multiple segments, and adjusting the speed of different drivers 110 in each segment respectively, and controlling the speed by switching the main driver 111 (the maximum difference from the target position) in different segments, so that multiple drivers 110 can form coordinated cooperation and smoothly complete a whole set of complex movements.
[0065] Step S1400: applying instructions to each of the multiple drivers to enable the multiple drivers to achieve synchronous and compliant motion.
[0066] Continue to refer Figure 2 As shown, instructions may be applied to each of the plurality of drivers 110 , and the instructions may include parameter instructions and synchronous motion instructions.
[0067] Exemplarily, the method of applying the above instructions includes applying parameter instructions to each driver 110 in turn, and then applying synchronous motion instructions to multiple drivers 110 at the same time, so that multiple drivers 110 can achieve synchronous motion according to the motion plan. In some embodiments, the synchronous motion includes synchronous start; in other embodiments, the synchronous motion includes both synchronous start and synchronous acceleration, synchronous uniform speed, synchronous deceleration and synchronous stop. The synchronous motion of multiple drivers 110 can make the movement of the robot arm 100 more coordinated, and the movement is more smooth like a human arm, avoiding the uncoordinated and sluggish movement of the robot arm 100 caused by the asynchronous (single movement) of the driver 110.
[0068] Exemplarily, the parameter instruction may include a first parameter sub-instruction and a second parameter sub-instruction, the first parameter sub-instruction corresponding to the motion parameter of the master driver 111, and the second parameter sub-instruction corresponding to the compliant motion parameter of the slave driver 112, and applying the parameter instruction to each driver 110 includes applying the first parameter sub-instruction to the master driver 111, and applying the second parameter sub-instruction to the slave driver 112.
[0069] In some embodiments, the control unit 200 may issue instructions to each driver 110 in sequence. The control unit 200 may issue different parameter instructions to the master driver 111 and the slave driver 112, for example, issuing a first parameter sub-instruction to the master driver 111 and issuing a second parameter sub-instruction to the slave driver 112. This design can realize the separate regulation of the master driver 111 and the slave driver 112, further realize different motion planning of different drivers 110, and make the robot 100 more flexible.
[0070] When the driver 110 enters the deceleration phase of the current segment motion, if there are still points to be executed in the cache queue at this time, the system will update the motion parameters of the driver and repeat the maximum difference in each of the subsequent multiple segments motion. S max The calculation and repeated confirmation of the new main drive 111, and the repeated planning of the motion parameters of the main drive 111 and the smooth motion parameters of the slave drive 112, until it is detected that there are no points to be executed in the cache queue, the robot 100 will decelerate and stop in the last motion segment.
[0071] Another aspect of the present application provides a storage medium, wherein a program is stored in the storage medium, and when the program is executed, the above-described compliant control method of the robot arm can be implemented.
[0072] Those skilled in the art will appreciate that all or part of the processes in the above-mentioned implementation methods can be implemented by instructing related hardware through a program stored in a storage medium. The readable storage medium can be a tangible medium, for example, including non-volatile and / or volatile memory. When the program stored therein is executed, it includes the processes of the implementation methods of the above-mentioned methods. Among them, any reference to memory, storage, database or other media used in the various implementation methods provided in this application may include at least one of non-volatile and volatile memory.
[0073] Exemplarily, non-volatile memory may include read-only memory (ROM), magnetic tape, floppy disk, flash memory or optical memory, etc. Volatile memory may include random access memory (RAM) or external cache memory. As an illustration and not limitation, RAM may be in various forms, such as static random access memory (SRAM), dynamic random access memory (DRAM), or any suitable combination of the above.
[0074] On the other hand, the present application provides a robot system. Figure 6is a schematic diagram of the structure of a robot system according to an exemplary embodiment of the present application. Figure 6 As shown, the robot system 900 may include a robot arm 100 , a processor (not shown), and a memory 400 . The robot arm 100 may include a plurality of actuators 110 .
[0075] In some embodiments, the robot system 900 further includes a control unit 200 , which is communicatively connected with the robot arm 100 and receives and analyzes signals from the robot arm 100 .
[0076] In some implementations, the host computer 300 may include a processor.
[0077] In some implementations, the readable storage medium may include memory 400 .
[0078] Exemplarily, the memory 400 is in communication with the processor 300 and stores executable computer program instructions. When the computer program instructions are executed by the processor 300, the compliant control method of the robot arm 110 in any of the above-described embodiments can be implemented.
[0079] Figure 7 Schematic diagram of the workflow of the robot system according to an exemplary embodiment of the present application. Figure 6 and Figure 7 As shown, the host computer 300 sends information of multiple drivers 110, and the control unit 200 receives the information of multiple drivers 110 and stores the information in the cache queue.
[0080] In some embodiments, the information of the plurality of drivers 110 is the information of each driver 110. The information of the driver 110 may include only the position information. In other embodiments, the information of the driver 110 includes not only the position information but also at least one of the angular velocity information and the angular acceleration information. The current position of each driver 110 can be analyzed by the control unit 200 and compared with the respective target position of each driver 110 to calculate the corresponding difference. The driver with the largest difference compared to the target position among all the drivers 110 is the master driver 111, and the remaining drivers other than the master driver 111 are slave drivers 112.
[0081] For example, the motion parameters of the main driver 111 may include a maximum difference S max , the maximum speed of the main drive 111 v -Mmax *k, maximum acceleration a -Mmax* at least one of k. k is the maximum speed ratio set by the host computer 300, and the value range of k is [0, 100%]. In actual work, the host computer 300 will set different maximum speed ratios k according to the operation plan. The k value will affect the motion parameters of the main driver 111 and the compliant motion parameters of the slave driver 112, so that the two can work together to achieve the compliant operation of the robot arm. The compliant motion parameters of the slave driver 112 include the maximum speed of the slave driver 112 v -Smax , the acceleration of the slave driver 112 a -S and the deceleration of the slave driver 112 d -S The time of each motion phase of the main driver 110 can be calculated according to the trapezoidal motion planning.
[0082] First get the maximum difference S max , the maximum speed of the main drive 111 v -Mmax *k (corresponding to v 1) and maximum acceleration a -Mmax *k. Then calculate the acceleration phase time of the main drive 111 t 1, t 1 Satisfaction t 1=( v -Mmax *k) / ( a -Mmax *k), uniform motion phase time t 2 and deceleration phase time t 3. Combined with the total planning time of a section ( T 2 and T 1) can be obtained as Figure 4 The acceleration phase time, uniform motion phase time and deceleration phase time of the slave driver 112 are the same as those of the master driver 111. Therefore, t 1. t 2. t 3 also respectively represent the acceleration, uniform speed and deceleration movement phase times of the slave driver 111.
[0083] According to the known t 1. t 2. t 3 to calculate the maximum speed of the slave drive 112 v -Smax , the acceleration of the slave driver 112 a -S and the deceleration of the slave driver 112 d-S At least one of them is used to update the motion parameters of the driver 110 and issue the corresponding parameter instructions to the multiple drivers 110. Then, synchronous motion instructions are applied to the multiple drivers 110, so that the multiple drivers 110 complete synchronous motion. In some embodiments, the synchronous motion includes synchronous start; in other embodiments, the synchronous motion includes both synchronous start and synchronous acceleration, synchronous uniform speed, synchronous deceleration and synchronous stop. The synchronous motion of multiple drivers 110 can make the movement of the robot arm 100 more coordinated and smoother like a human arm, avoiding the uncoordinated and sluggish movement of the robot arm 100 caused by the asynchronous (single motion) of the driver 110.
[0084] Exemplarily, the parameter instruction includes a first parameter sub-instruction and a second parameter sub-instruction, and the control unit 200 can issue instructions to each driver 110 in sequence. The control unit 200 can issue different parameter instructions to the master driver 111 and the slave driver 112, for example, issuing the first parameter sub-instruction to the master driver 111 and issuing the second parameter sub-instruction to the slave driver 112. This design can realize the separate regulation of the master driver 111 and the slave driver 112, and further realize different motion planning of different drivers 110, making the robot 100 more flexible.
[0085] During each movement of the driver 110, it will first be determined whether it has entered the deceleration movement stage. If the determination result is yes, it will continue to determine whether there are points to be executed in the cache queue. If it is determined to be no, the robot 100 will decelerate and eventually stop; if it is determined to be no, it means that there are still points waiting to be executed, and the movement parameters of the driver 110 will be updated to start the next movement planning of the robot 100. Then the control unit 200 will analyze that the current position of each driver 110 has entered the preset range. S accu ( S accu For example, when the value is 0.1°, the system will recalculate the new maximum difference between all drivers 110 and the target position. S’ max , and based on the new maximum difference S’ max A new master driver 111 ′ and a new slave driver 112 ′ are determined, and motion parameters of the new master driver 111 ′ in the next motion segment are re-obtained and compliant motion parameters of the new slave driver 112 ′ in the next motion segment are re-planned.
[0086] Repeat the synchronous motion instruction and the deceleration stage determination and the to-be-executed point determination process until it is detected that there is no to-be-executed point in the cache queue. At this time, the robot arm 100 will decelerate and stop in the last motion segment.
[0087] The above design is conducive to realizing coordinated planning in multi-segment motion, dividing a whole set of motion into multiple segments, and adjusting the speed of different drivers 110 in each segment respectively, and controlling the speed by switching the main driver 111 (the maximum difference from the target position) in different segments, so that multiple drivers 110 can form coordinated cooperation and smoothly complete a whole set of complex movements.
[0088] Exemplarily, the control unit 200 can be connected to each of the multiple drivers 110 in communication, and the control unit 200 includes an RCU (Robot Control Unit), which is a functional integration unit having functions such as information collection, information reporting, information analysis, information monitoring, and command sending. An end effector (not shown) can be connected to one end of the robot arm 100, and the end effector includes a magnetic gripper, a mechanical gripper, etc.; the driver 110 includes a joint motor, etc.
[0089] The robot system 900 can be applied to many scenarios such as home, industry, security, education, medical treatment, retail, etc. For example, the robot system 900 can be used for cooking and preparing food in a kitchen to realize automated food preparation.
[0090] The above description is only an implementation method of the present application and an explanation of the technical principles used. Those skilled in the art should understand that the scope of protection involved in the present application is not limited to the technical solution formed by a specific combination of the above technical features, but should also cover other technical solutions formed by any combination of the above technical features or their equivalent features without departing from the technical concept. For example, the above features are replaced with the technical features with similar functions disclosed in this application (but not limited to) by each other to form a technical solution.
Claims
1. A method for compliant control of a robotic arm, the robotic arm comprising a plurality of actuators, characterized in that: The motion of the driver includes multiple motions, and the method includes: S1100, receiving information of a plurality of the drivers, and storing the information in a cache queue; S1200, parsing the difference between the target position and the current position of each of the plurality of drivers, wherein the driver corresponding to the maximum difference among all the differences is the master driver, and the remaining drivers other than the master driver are slave drivers; S1300, planning the compliant motion parameters of the slave drive according to the motion parameters of the master drive; S1400, applying an instruction to each of the plurality of drivers; S1500, when the driver enters the deceleration stage in the current segment of motion, it is determined that there is a point to be executed in the cache queue, and it is determined that the current position of each of the drivers is within a preset range, wherein the current position of each of the drivers is within the preset range means that the difference w between the current motion position of each of the drivers and the end position of the segment of motion satisfies: w≤0.1°; S1600, recalculating the maximum difference and determining a new master drive and a new slave drive according to the recalculated new maximum difference; S1700, re-obtaining the motion parameters of the new main drive in the next motion segment; S1800, replanning the compliant motion parameters of the new slave driver in the next motion segment, and re-applying synchronous motion instructions to the multiple drivers; S1900, repeatedly executing S1500 to S1800 until it is detected that there is no point to be executed in the cache queue, so that the multiple drivers can achieve synchronous and smooth motion. The control unit receives the information and stores the information in the cache queue, and the operation of the control unit and the operation of the driver are implemented based on the same set of algorithms.
2. The method according to claim 1, characterized in that The instructions include parameter instructions and synchronous motion instructions, and the method of applying the instructions to each of the plurality of drivers includes: applying the parameter instruction to each of the plurality of the drivers in sequence; and After applying the parameter instruction, the synchronous motion instruction is applied to the plurality of drivers at the same time.
3. The method according to claim 2, characterized in that The parameter instruction includes a first parameter sub-instruction and a second parameter sub-instruction, wherein the first parameter sub-instruction corresponds to the motion parameter of the master driver, and the second parameter sub-instruction corresponds to the compliant motion parameter of the slave driver. Applying the parameter instruction to each of the drivers includes: applying the first parameter sub-command to the main driver, and Apply the second parameter sub-command to the slave driver.
4. The method according to claim 2, characterized in that: The motion parameter of the main drive includes at least one of the maximum difference, the maximum speed of the main drive, and the maximum acceleration of the main drive; and The compliant motion parameter of the slave drive includes at least one of a maximum speed of the slave drive, an acceleration of the slave drive, and a deceleration of the slave drive.
5. The method according to claim 4, characterized in that The method of planning the compliant motion parameters of the slave drive includes: obtaining the maximum difference, the maximum speed of the main drive, and the maximum acceleration of the main drive; Calculating the acceleration phase time, the uniform motion phase time and the deceleration phase time of the main drive; and At least one of a maximum speed of the slave drive, an acceleration of the slave drive, and a deceleration of the slave drive is calculated.
6. The method according to claim 5, characterized in that According to the trapezoidal motion planning, the acceleration motion phase time, the uniform motion phase time and the deceleration motion phase time of the main drive are calculated. The acceleration phase time, uniform motion phase time and deceleration phase time of the master driver and the slave driver are all the same.
7. The method according to claim 1, characterized in that The information includes location information of the drive; or The information includes position information of the driver and at least one of angular velocity information of the driver and angular acceleration information of the driver.
8. A storage medium storing a program, characterized in that: When the program is executed, the robot arm compliant control method as described in any one of claims 1 to 7 is implemented.
9. A robot system, characterized in that: The system comprises: A robotic arm as claimed in any one of claims 1 to 7; Processor; and a memory, communicatively connected to the processor and storing executable computer program instructions, Wherein, the computer program instructions are executed by the processor to implement the robot arm compliance control method as described in any one of claims 1-7.
10. The system according to claim 9, characterized in that The system further comprises: A control unit is communicatively connected with the robotic arm and is used for receiving and analyzing signals from the robotic arm.
