Method, device and computer-readable storage medium for designing a serial robot arm

The method optimizes link and motor parameters in a serial robot arm design by calculating the dynamic maneuverability ellipsoid, addressing the trade-off between torque output and compactness, ensuring payload capacity and obstacle avoidance, and enhancing design efficiency.

CN115605327BActive Publication Date: 2024-12-06UBTECH ROBOTICS CORP LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202280003655.7
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Priority Date
2021-05-20
Filing Date
2022-03-31
Publication Date
2024-12-06
Estimated Expiration
2042-03-31

AI Technical Summary

Technical Problem

Conventional serial robot manipulators face challenges in achieving a compact design with high torque output due to the trade-off between payload capacity and motor weight, and they often overlook non-downward payloads, leading to inefficiencies in torque output and mechanism design.

Method used

A computer-implemented method for designing a serial robot arm that optimizes the length of links and motor type by calculating the dynamic maneuverability ellipsoid at the end effector, considering velocity, acceleration, and force/torque, allowing the end effector to execute a desired motion curve under predetermined constraints.

Benefits of technology

The method enables the design of a serial robot arm that balances high torque output with a compact footprint by optimizing link and motor parameters, ensuring the end effector can withstand payloads and avoid obstacles, thus simplifying the design process and reducing development costs.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115605327B_ABST
    Figure CN115605327B_ABST
Patent Text Reader

Abstract

The present application provides a method, apparatus and computer-readable storage medium for designing a serial robot arm, the robot arm including an end effector, a plurality of connecting rods and a plurality of motors, the method comprising: obtaining a desired motion curve of the end effector (S41); discretizing the desired motion curve into a plurality of points, wherein each point carries information of the velocity, acceleration and force / torque of the end effector at the point (S42); determining the degrees of freedom of the serial robot arm (S43), initializing the length of each connecting rod and the motor type of each motor (S44); and at each point, optimizing the initialization length of the connecting rod and the initialization motor type of the motor by calculating a dynamically operable ellipsoid at the end effector to obtain the desired length of the connecting rod and the desired motor type of the motor (S45), thereby allowing the end effector to execute the desired motion curve under predetermined constraints. The method is conducive to simplifying the design process of the serial robot arm.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to a mobile robot arm, and more particularly to a method, an apparatus and a computer-readable storage medium for designing a serial robot arm. Background Art

[0002] Conventional serial robot manipulators are usually equipped with large and powerful motors to achieve high payload capacity. Due to the limitation of power-to-mass ratio, motors with large torque output usually have heavy deadweight within the budget, which increases the burden to be overcome. In some application environments, a compact manipulator with a small footprint is required. The trade-off between high torque output and compact design leads to the need for a better design process.

[0003] In addition, for many industrial robot manipulators, only downward payloads are considered in the reachable workspace of the manipulator. In other words, in certain configurations with non-downward payloads, the end effector could have saved torque output capacity by reducing the motor rating used or modifying the mechanism design.

[0004] Therefore, it is necessary to provide a serial robot arm design method to overcome the above problems. Summary of the invention

[0005] Therefore, the present invention provides a serial robot arm design to overcome the above problems.

[0006] In order to achieve the above-mentioned objectives, the present invention provides a computer-implemented serial robot arm design method, which includes an end effector, multiple links and multiple motors, and the method includes: obtaining a desired motion curve of the end effector; discretizing the desired motion curve into multiple points, wherein each of the points carries information about the velocity, acceleration and force / torque of the end effector at the point; determining the degrees of freedom of the serial robot arm, initializing the length of each of the links and the motor type of each of the motors; and at each of the points, optimizing the initialization length of the links and the initialization motor type of the motors by calculating the dynamic maneuverability ellipsoid at the end effector to obtain the desired length of the links and the desired motor type of the motors, thereby allowing the end effector to execute the desired motion curve under predetermined constraints.

[0007] Optionally, the constraints include: the desired motion curve has a preset smoothness; the serial robot arm needs to avoid obstacles; and the positions of the end effector at each of the points in the dynamic maneuverability ellipsoid can be connected to each other to form the desired motion curve.

[0008] Optionally, optimizing the initialization length of the link and the initialization motor type of the motor by calculating the dynamic maneuverability ellipsoid at the end effector to obtain the desired length of the link and the desired motor type of the motor so as to allow the end effector to execute the desired motion curve under predetermined constraints includes: (a) determining an algorithm for calculating the dynamic maneuverability ellipsoid at the end effector based on whether the serial robot arm is redundant in degrees of freedom, and calculating the dynamic maneuverability ellipsoid at the end effector based on information about the velocity, acceleration and force / torque of the end effector at the current point; (b) visualizing the dynamic maneuverability ellipsoid; (c) determining whether the end effector is outside the dynamic maneuverability ellipsoid; (d) in response to the end effector being inside the dynamic maneuverability ellipsoid, saving configuration information of the current length of the link and the motor type of the motor; (e) in response to the end effector being outside the dynamic maneuverability ellipsoid, modifying the current length of the link and the motor type of the motor, and returning to (a).

[0009] Optionally, the algorithm for calculating the dynamic maneuverability ellipsoid at the end effector is determined based on whether the serial robot is redundant in degrees of freedom, including: determining whether the degrees of freedom of the serial robot in a joint space are redundant relative to the degrees of freedom in a task space; in response to the degrees of freedom of the serial robot in the joint space being redundant relative to the degrees of freedom in the task space, setting the velocity and acceleration at the current point to 0, and calculating the dynamic maneuverability at the end effector using the Jacobian pseudo-inverse matrix based on the force / torque, link length and motor type at the current point. ellipsoid; in response to the degrees of freedom of the serial robot in the joint space being not redundant with respect to the degrees of freedom in the task space, determining whether a target point is reachable in the task space; in response to the target point being not reachable in the task space, modifying the current length of the link and the motor type of the motor; in response to the target point being reachable in the task space, setting the velocity and acceleration at the current point to 0, and calculating the dynamic maneuverability ellipsoid at the end effector based on the force / torque at the current point, the length of the link and the motor type of the motor using an inverse Jacobian matrix.

[0010] Optionally, the method further includes: after saving the current length of the connecting rod and the configuration information of the motor type of the motor, obtaining the speed, acceleration, and force / torque information of the end effector at the next point according to the current connecting rod length and the configuration information of the motor type, and returning to (a).

[0011] Optionally, discretizing the expected motion curve into a plurality of points includes: equally dividing the expected motion curve into a plurality of points, or discretizing the expected motion curve into a plurality of points by a multi-order polynomial approximation method.

[0012] Optionally, the number of degrees of freedom is between 5 and 7.

[0013] The present invention also provides a device for designing a serial robot arm, which includes an end effector, multiple links and multiple motors. The device includes: one or more processors; a memory; and one or more programs, wherein the one or more programs are stored in the memory and configured to be executed by the one or more processors, and the one or more programs include instructions for executing a serial robot arm design method, which method includes: obtaining a desired motion curve of the end effector; discretizing the desired motion curve into multiple points, wherein each of the points carries information on the velocity, acceleration and force / torque of the end effector at the point; determining the degrees of freedom of the serial robot arm, initializing the length of each of the links and the motor type of each of the motors; and at each of the points, optimizing the initialized length of the links and the initialized motor type of the motors by calculating the dynamic maneuverability ellipsoid at the end effector to obtain the desired length of the links and the desired motor type of the motors, thereby allowing the end effector to execute the desired motion curve under predetermined constraints.

[0014] Optionally, optimizing the initialization length of the link and the initialization motor type of the motor by calculating the dynamic maneuverability ellipsoid at the end effector to obtain the desired length of the link and the desired motor type of the motor so as to allow the end effector to execute the desired motion curve under predetermined constraints includes: (a) determining an algorithm for calculating the dynamic maneuverability ellipsoid at the end effector based on whether the serial robot arm is redundant in degrees of freedom, and calculating the dynamic maneuverability ellipsoid at the end effector based on information about the velocity, acceleration and force / torque of the end effector at the current point; (b) visualizing the dynamic maneuverability ellipsoid; (c) determining whether the end effector is outside the dynamic maneuverability ellipsoid; (d) in response to the end effector being inside the dynamic maneuverability ellipsoid, saving configuration information of the current length of the link and the motor type of the motor; (e) in response to the end effector being outside the dynamic maneuverability ellipsoid, modifying the current length of the link and the motor type of the motor, and returning to (a).

[0015] The present invention also provides a non-temporary computer-readable storage medium storing one or more programs, which will be executed by a device for designing a serial robotic arm including an end effector, multiple links and multiple motors. When the one or more programs are executed by the one or more processors, the device performs processing, including: obtaining the desired motion curve of the end effector; discretizing the desired motion curve into multiple points, wherein each of the points carries information on the velocity, acceleration and force / torque of the end effector at the point; determining the degrees of freedom of the serial robotic arm, initializing the length of each link and the motor type of each motor; and at each of the points, optimizing the initialized length of the link and the initialized motor type of the motor by calculating the dynamic maneuverability ellipsoid at the end effector to obtain the desired length of the link and the desired motor type of the motor, thereby allowing the end effector to execute the desired motion curve under predetermined constraints.

[0016] The technical solution of the present invention has the following advantages: the length of the connecting rod and the type of motor of the manipulator are taken into consideration. The length of the connecting rod of the serial manipulator determines the weight of the connecting rod, and the motor type of the motor determines the weight of the motor. The motion curve that the designer hopes the serial manipulator will perform is discretized into a plurality of points. The dynamic maneuverability ellipsoid of the end effector of the serial manipulator at each point is calculated, and the dynamic maneuverability ellipsoid is visualized so that the designer can directly check whether the end effector is located in the dynamic maneuverability ellipsoid. If the end effector is located in the dynamic maneuverability ellipsoid, it means that the current design of the manipulator can withstand the current payload, and the current length of the connecting rod and the type of motor are valid design parameters. If the end effector is not located in the dynamic maneuverability ellipsoid, it means that the current design of the manipulator cannot withstand the current payload, and the current length of the connecting rod and the type of motor need to be modified. The designer can enter a new value on the input interface of the computer. By visually viewing the dynamic maneuverability ellipsoid on the display interface of the computer and visually checking whether the end effector is located in the dynamic maneuverability ellipsoid, the design process is simplified. BRIEF DESCRIPTION OF THE DRAWINGS

[0017] The accompanying drawings, which are incorporated herein and form a part of the specification, illustrate embodiments of the present disclosure and, together with the description, are further used to explain the principles of the present disclosure and enable those skilled in the relevant art to make and use the present disclosure. In order to more clearly illustrate the specific embodiments of the present invention or the technical solutions in the prior art, the following will briefly introduce the drawings required for use in the specific embodiments or the description of the prior art. Obviously, for those of ordinary skill in the art, other drawings can be obtained based on these drawings without creative work.

[0018] Figure 1is a schematic diagram of an application scenario according to an embodiment of the present invention.

[0019] Figure 2 is a schematic block diagram of a computing device according to an embodiment of the present invention.

[0020] Figure 3 is a schematic block diagram of a serial robot arm design device according to an embodiment of the present invention.

[0021] Figure 4 is a schematic flow chart of a serial robot arm design method according to an embodiment of the present invention.

[0022] Figure 5 is a schematic flow chart of a method for optimizing the link length and motor type of a serial robot arm according to an embodiment of the present invention.

[0023] Figure 6 is a schematic flow chart of a method for determining an algorithm for calculating a dynamic maneuverability ellipsoid at an end effector according to one embodiment of the present invention.

[0024] Figure 7 Schematic diagram of the dynamically manipulable ellipsoid of the present invention.

[0025] Figure 8 It is used to calculate Figure 7 Schematic diagram of the Jacobian inverse matrix and Jacobian pseudo-inverse matrix of the dynamic manipulator ellipsoid.

[0026] Fig. 9 Schematic diagram of a complete flow chart of a computer-implemented serial robotic arm design method according to an embodiment of the present invention. DETAILED DESCRIPTION

[0027] The technical solution of the present invention will be described clearly and completely below in conjunction with the accompanying drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0028] The present disclosure is illustrated in the accompanying drawings by way of example and not limitation, in which like reference numerals represent like elements. It should be noted that reference to "one" embodiment in the present invention is not necessarily a reference to the same embodiment, and such reference may represent "at least one" embodiment.

[0029] Although specific configurations and arrangements are discussed, it should be understood that this is done for illustrative purposes only. Those skilled in the relevant art will recognize that other configurations and arrangements may be used without departing from the spirit and scope of the present disclosure. It is apparent to those skilled in the relevant art that the present disclosure may also be used in various other applications.

[0030] It should be noted that references in the specification to "one embodiment", "example embodiment", "some embodiments", "certain embodiments", etc. indicate that the described embodiments may include specific features, structures or characteristics, but each embodiment may not necessarily include the specific features, structures or characteristics. In addition, these phrases do not necessarily refer to the same embodiment. In addition, when a specific feature, structure or characteristic is described in conjunction with an embodiment, it is within the knowledge of a technician in the relevant field to implement such feature, structure or characteristic in connection with other embodiments, whether or not explicitly described.

[0031] In general, terms can be understood, at least in part, from their use in context. For example, depending, at least in part, on the context, as used herein, the term "one or more" can be used to describe any feature, structure, or characteristic in a singular sense, or can be used to describe a combination of features, structures, or characteristics in a plural sense. Similarly, depending, at least in part, on the context, terms such as "one" or "the" can also be understood to convey singular usage or to convey plural usage. In addition, the term "based on" can be understood to not necessarily be intended to convey an exclusive set of factors, and can instead allow for the presence of additional factors that are not necessarily explicitly described, again depending, at least in part, on the context.

[0032] Although features and elements of the present disclosure are described as embodiments in particular combinations, each feature or element may be used alone or in various other combinations within the principles of the present disclosure, the use of which is to the greatest extent indicated by the broad, ordinary meaning of the terms expressing the appended claims.

[0033] In addition, the technical features involved in the different embodiments of the present invention described below can be combined with each other as long as they do not conflict with each other.

[0034] Figure 1 is a schematic diagram of an application scenario according to an embodiment. Figure 1 As shown, the computing device 10 is connected to the robot 20 by wire or wirelessly. The computing device 10 can be used to design the robot 20 and control the robot 20 to test the designed robot 20. Figure 2In one embodiment, the computing device 10 may include a display 11, an input device 12, a memory 13, and a processor 14. The memory 13 includes a non-transitory computer-readable storage medium and stores a computer program (e.g., a design module 15) executable by the processor 14. The processor 14 is electrically coupled to the memory 13, and the computer-implemented design method of the serial robot arm provided in the embodiment of the present invention is implemented by calling the computer program stored in the memory 13. The computing device 10 may be a device with computing and control functions, such as a desktop computer, a tablet computer, or a laptop computer.

[0035] The display 11 displays the motion profile of the robot 20. The input device 12 receives the design data input by the user, which may include the length of the connecting rod of the robot 20 and the motor type of the motor. The robot 20 may include multiple joints, such as a shoulder joint, an elbow joint, and a wrist joint. Each joint is equipped with a motor, and the movement of each joint is driven by the motor. In this embodiment, the wrist joint is the end effector of the robot 20.

[0036] Reference Figure 3 In one embodiment, the serial robot design device 30 may include a processor 31, a memory 32, and one or more computer programs 33 stored in the memory 32 and executable by the processor 31. When the processor 31 executes the computer program 33, the steps in the robot design method embodiment, such as Figure 4 Steps S41 to S45 in Figure 5 Steps S451 to S456 in Figure 6 Steps S4511 to S4514 and Fig. 9 The steps in are implemented.

[0037] The processor 31 may be a central processing unit (CPU), a general purpose processor, a digital signal processor (DSP), an application specific integrated circuit (ASIC), a field programmable gate array (FPGA), a programmable logic device, a discrete gate, a transistor logic device or a discrete hardware component. The general purpose processor may be a microprocessor or any conventional processor, etc.

[0038] The memory 32 may be an internal storage unit of the device 30, such as a hard disk or a memory. The memory 32 may also be an external storage device of the device 30, such as a plug-in hard disk, a smart memory card (SMC) and a secure digital (SD) card, or any suitable flash memory card. In addition, the memory 32 may also include an internal storage unit and an external storage device. The memory 32 is used to store computer programs, other programs, and data required by the device 30. The memory 32 may also be used to temporarily store data that has been output or is about to be output.

[0039] Exemplarily, one or more computer programs 33 may be divided into one or more modules / units, and one or more modules / units are stored in the memory 32 and can be executed by the processor 31. One or more modules / units / units may be a series of computer program instruction segments capable of performing specific functions, and the instruction segments are used to describe the execution process of one or more computer programs 33. One or more computer programs 33 include computer executable instructions for performing one or more functions described below and methods described in the present disclosure (e.g., computer-implemented serial robotic arm design methods and other methods described herein). These instruction sets do not need to be implemented as separate software programs, processes, or modules, so various subsets of these modules can be combined or otherwise rearranged in various embodiments. The device 30 may include a different number of components than shown, or include some other different components. For example, the device 30 may also include input and output devices, network access devices, buses, etc.

[0040] Figure 4 A flowchart of a method for designing a robot arm according to one embodiment is shown. The method may be executed by one or more processors of computing device 10 or one or more processors of device 30. In one embodiment, the method may include steps S41 to S44.

[0041] Step S41 : obtaining a desired motion curve of the end effector of the serial robot arm 20 .

[0042] One or more processors receive the desired motion curve input by the user. The desired motion curve is the basis for designing a serial robot arm, and the designed serial robot arm needs to execute the desired motion curve. The motion curve contains force / torque information. Here, force refers to the payload capacity of the robot arm, and torque refers to the output torque of each joint of the robot arm. The magnitude of force and torque is determined by the motor of each joint used as a drive device and the length of the connecting rod between the joints. In this embodiment, the end effector is the wrist joint of the robot arm 20.

[0043] Step S42: discretize the desired motion curve into a plurality of points, wherein each point carries information of the velocity, acceleration and force / torque of the end effector at that point.

[0044] In one embodiment, the distance between two adjacent points can be set to 3 mm. The desired motion curve can be equally divided into a plurality of points, or can be discretized into a plurality of points by a multi-order polynomial approximation method, which can make the curve formed by the discrete points smoother.

[0045] Step S43: Determine the number of degrees of freedom of the serial robot arm 20.

[0046] The number of degrees of freedom of the serial robot 20 is equal to the number of motors that control the rotation of the joints on the serial robot 20. In one embodiment, the number of degrees of freedom of the serial robot 20 is in the range of 5 to 7.

[0047] Step S44: Initialize the length of each connecting rod and the motor type of each motor.

[0048] One or more processors receive the initialization values ​​of the length of each connecting rod and the motor type of each motor input by the user. The length of the connecting rod determines the weight of the connecting rod of the robot arm 20. The motor type determines the weight of the motor. The length of the connecting rod and the motor type of the motor determine the weight of the serial robot arm 20.

[0049] Step S45: Optimizing the initialization length of the link and the motor type of the motor to obtain a desired link length and a desired motor type of the motor, which allows the end effector to execute a desired motion curve under predetermined constraints.

[0050] In one embodiment, during the optimization process, in the calculations that need to reduce the computational dimension, a gradient-based descent algorithm can be used to reduce the dimension. In another embodiment, the optimization can be performed by a cyclic exhaustion algorithm or a random algorithm. Specifically, at each discrete point, the initialization length of the connecting rod and the initialization motor type of the motor are optimized by calculating the dynamic manipulability ellipsoid (DME) of the end effector to obtain the desired connecting rod length and the desired motor type of the motor, which allows the end effector to execute the desired motion curve under predetermined constraints.

[0051] The constraints include requirements for the smoothness of the desired motion curve of the serial robot, the requirement to avoid obstacles during the motion process, and the feasibility of moving from one point of the motion curve to the next point. Specifically, the constraints may include: (a) the desired motion curve has a preset smoothness; (b) the serial robot needs to avoid obstacles; (c) the position of each point of the end effector in the dynamically maneuverable ellipsoid can be interconnected to form the desired motion curve. Constraint (a) means that the error between the actual motion curve and the desired motion curve is less than a preset error value. For example, the distance between the two motion curves is less than a preset distance. The obstacles in constraint (b) are obstacles that need to be avoided in order to execute the motion curve. Constraint (c) means that the designed serial robot must be able to move from one discrete point to the next adjacent point. The designed serial robot must meet the above constraints.

[0052] In one embodiment, the constraints may further include the weight of the links and the weight of the motors of the serial robot. One goal of the robot design method is to design a serial robot that satisfies these constraints and can execute the desired motion profile.

[0053] refer to Figure 5 In one embodiment, step S45 may include the following steps.

[0054] Step S451: Determine an algorithm for calculating a dynamic maneuverability ellipsoid at an end effector according to whether the serial robot arm is redundant in terms of degrees of freedom.

[0055] Step S452: Calculate the dynamic maneuverability ellipsoid at the end effector according to the velocity, acceleration and force / torque information of the end effector at the current point.

[0056] Step S453: Visualize the dynamic operability ellipsoid.

[0057] In this embodiment, a visualized dynamic manipulability ellipsoid is displayed on the display.

[0058] Step S454: Determine whether the end effector is outside the dynamic maneuverability ellipsoid.

[0059] The user can directly see on the display screen whether the end effector is outside the dynamic maneuverability ellipsoid. If the end effector is outside the dynamic maneuverability ellipsoid, the process goes to step S455. If the end effector is inside the dynamic maneuverability ellipsoid, the process goes to step S455.

[0060] Step S455: Modify the current length of the connecting rod and the motor type of the motor.

[0061] After modification, the process returns to step S451.

[0062] Step S456: Save the configuration information of the current length of the connecting rod and the motor type.

[0063] In this embodiment, the configuration information of the current length of the connecting rod and the motor type of the motor is saved as the configuration information of the serial robot arm in the solution pool.

[0064] After step S456, the velocity, acceleration, and force / torque information of the end effector at the next point are obtained, and the length between the serial robot joints and the motor type of the motor at the next point are optimized. These steps are repeated until the length between the serial robot joints and the motor type of all discrete points on the desired motion curve are optimized.

[0065] It should be noted that when optimizing the length between the serial robot joints and the motor type for a point other than the first point, the link length and the motor type are selected from the optimization results corresponding to the previous point.

[0066] refer to Figure 6 In one embodiment, step S451 may include the following steps.

[0067] Step S4511: Determine whether the degrees of freedom of the serial robot in the joint space are redundant with respect to the degrees of freedom in the task space.

[0068] If the degrees of freedom of the serial robot in the joint space are redundant with respect to the degrees of freedom in the task space, the process proceeds to step S4514. If the degrees of freedom of the serial robot in the joint space are not redundant with respect to the degrees of freedom in the task space, the process proceeds to step S4512.

[0069] For example, if the serial robot has 6 degrees of freedom in the task space, then when the serial robot has more than 6 degrees of freedom in the joint space, it is determined that the serial robot has redundant degrees of freedom in the joint space relative to the degrees of freedom in the task space. When the serial robot has 6 degrees of freedom in the joint space or less, it is determined that the serial robot has non-redundant degrees of freedom in the joint space relative to the degrees of freedom in the task space.

[0070] Step S4512: Determine whether the target point is reachable in the task space of the serial robot.

[0071] This step is used to determine whether the robot arm can reach the target point in the task space in the case of non-redundant joints, that is, to determine whether the desired motion curve can be executed.

[0072] If the target point is not accessible in the task space of the serial robot, the current length of the connecting rod and the motor type of the motor will be modified. If the target point is accessible in the task space of the serial robot, the process goes to step S4513.

[0073] Step S4513: Calculate the dynamic maneuverability ellipsoid at the end effector using the Jacobian inverse matrix.

[0074] Specifically, if the target point is reachable in the task space of the serial manipulator, the velocity and acceleration of the end effector at the current point are set to 0, and the dynamic maneuverability ellipsoid of the end effector is calculated using the inverse Jacobian matrix based on the force / torque at the current point, the length of the link, and the motor type of the motor.

[0075] Step S4514: Calculate the dynamic maneuverability ellipsoid at the end effector using the Jacobian pseudo-inverse matrix.

[0076] Specifically, if the serial manipulator’s degrees of freedom in joint space are redundant with respect to those in task space, the velocity and acceleration of the end effector at the current point are set to 0, and the dynamic maneuverability ellipsoid of the end effector is calculated based on the forces / torques, link lengths, and motor types at the current point using the Jacobian pseudo-inverse matrix.

[0077] It should be noted that the weight of the links and motors is taken into account when calculating the dynamic maneuverability ellipsoid. The arm is most likely to apply forces along the long axis of the ellipsoid, while the arm is least likely to apply forces along the short axis of the dynamic maneuverability ellipsoid. The relative position of the end effector center within the ellipsoid actually quantifies this process. If the end effector center is very close to the upper surface of the ellipsoid, it means that the state is almost on the edge of collapse, which is unsafe. If the arm receives more load, it will fall and the end effector center will move out of the ellipsoid.

[0078] like Figure 7 As shown, the coordinate system xyz is a three-dimensional coordinate system established with the base of the robot arm (i.e., the shoulder joint) as the origin. The three-dimensional coordinate system is established with one end of the end effector of the robot arm (i.e. the wrist joint) as the origin. DME -y DME -z DME It is a three-dimensional coordinate system established with the center of the dynamically operable ellipsoid as its origin.

[0079] like Figure 8 As shown, m represents the degrees of freedom in task space and n represents the degrees of freedom in joint space. If m is equal to n, then the inverse of the Jacobian matrix usually exists and the solution is straightforward. In this case, the manipulator is non-redundant and the inverse Jacobian matrix is ​​a square matrix. If n is greater than m, then the pseudo-inverse of the Jacobian matrix is ​​required to build a dynamically manipulatable ellipsoid.

[0080] The calculation process is as follows: The conventional maneuverability metric (MM) and its visualization (maneuverability ellipsoid (ME)) have been modified and extended to versions such as "dynamic maneuverability ellipsoid (DME)", "maneuverability force ellipsoid (MFE)" and "maneuverability velocity ellipsoid (MVE)". Considering the influence of load and the relatively low movement speed of the robotic arm in upper limb rehabilitation training after stroke, the improved DME model is adopted, which is derived as follows.

[0081] First, the dynamics of a serial (actuator on each joint) robot arm can be described as:

[0082]

[0083] The torque vector and g(q) n×1 are inertial, Coriolis / centrifugal and gravity related terms, J T (q) n×m is the force vector of the end effector connected m×1 and the joint torque vector τ n×1 The transpose of the Jacobian matrix of . J(q) m×n It also relates the joint space (n-DOF) velocity to the task space (m-DOF) velocity: Among them, J(q) m×n represents the connecting rod length, represents the angular velocity. Non-redundant, unconstrained stationary assumption The time derivatives of (1) to (3), and (2) to (4) are simplified.

[0084]

[0085]

[0086] in, It represents the translation of the ellipsoid center away from the original end effector position. This translation has never been quantitatively analyzed or applied in previous related research, although it can help determine whether the arm wrist has exceeded the dynamically maneuverable ellipsoid and whether gravity compensation is needed. In the past, for simplicity, it was assumed that the torque capacity of the robot arm can be calculated using T=diag(τ 1,max , ..., τ n,max ) is normalized as a scaling matrix and represented by a unit sphere (Euclidean norm) in joint space (5), and the twisted / rotated ellipsoid can then be calculated and visualized in task space (6), which indicates feasible acceleration directions and magnitudes.

[0087]

[0088]

[0089] Where Q = MT -2 M (7)

[0090] Due to redundancy, the dynamic maneuverability ellipsoid (8) uses the weighted pseudo-inverse Q of the Jacobian -1 J T (JQ -1 J T ) -1 :

[0091]

[0092] This represents the modified dynamic maneuverability ellipsoid for a redundant two-link 4DOF human arm in its 3DOF task space. Any vector starting at the wrist and ending inside the ellipsoid visualizes the acceleration (with magnitude and direction) that the arm can achieve. When the ellipsoid center is in the load condition When moving downward, once a sufficiently large load is applied to the arm, the ellipsoid no longer surrounds the wrist. In this case, the wrist loses its ability to move in at least half of the directions, and the arm structure is theoretically no longer stable.

[0093] Fig. 9 It is a schematic diagram of a complete flow chart of a computer-implemented serial robot arm design method provided by an embodiment of the present invention.

[0094] In the method according to the above embodiment, the connecting rod length and motor type of the manipulator are taken into consideration. The length of the connecting rod of the serial manipulator determines the weight of the connecting rod, and the motor type of the motor determines the weight of the motor. The motion curve that the designer hopes the serial manipulator performs is discretized into a plurality of points. The dynamic maneuverability ellipsoid of the end effector of the serial manipulator at each point is calculated, and the dynamic maneuverability ellipsoid is visualized so that the designer can directly check whether the end effector is located in the dynamic maneuverability ellipsoid. If the end effector is located in the dynamic maneuverability ellipsoid, it means that the current design of the manipulator can withstand the current payload, and the current length of the connecting rod and the motor type are valid design parameters. If the end effector is not located in the dynamic maneuverability ellipsoid, it means that the current design of the manipulator cannot withstand the current payload, and the current length of the connecting rod and the motor type need to be modified. The designer can enter a new value on the input interface of the computer. The design process is simplified by visually viewing the dynamic maneuverability ellipsoid on the display interface of the computer and visually checking whether the end effector is located in the dynamic maneuverability ellipsoid.

[0095] In an embodiment of the present invention, when designing a serial robotic arm, it includes a process for handling external loads in different directions, rather than the traditional downward payload. When calculating the accessible task space of the serial robotic arm, the weight of the robotic arm links and motors is used as a calculation parameter, and most kinematic and dynamic factors are systematically considered. Taking safety factors into account, the method can predict and avoid bottlenecks. The method has the potential to eliminate maintenance costs and visualize the motion curve of the end effector in the task space, making it more intuitive and convenient for designers to modify design parameters. The compromise design between high torque output and compact shape in the design process of the serial robotic arm is optimized, reducing development costs, shortening development time, and improving design efficiency.

[0096] In one embodiment, the present disclosure further provides a non-transitory computer-readable storage medium, which can be configured in the above-mentioned computing device or robot arm design device. The non-transitory computer-readable storage medium can be a storage unit configured in the main control chip and the data acquisition chip in the aforementioned embodiment. One or more computer programs are stored on the non-transitory computer-readable storage medium, and when the computer program is executed by one or more processors, the robot arm design method described in the above-mentioned embodiment is implemented.

[0097] The technicians in the relevant field can clearly understand that for the convenience and simplicity of description, only the division of the above-mentioned functional units and modules is used as an example for illustration. In practical applications, the above-mentioned function allocation can be completed by different functional units and modules as needed, that is, the internal structure of the device can be divided into different functional units or modules to complete all or part of the functions described above. The functional units and modules in the embodiment can be integrated in a processing unit, or each unit can exist physically separately, or two or more units can be integrated in one unit. The above-mentioned integrated unit can be implemented in the form of hardware or in the form of software functional units. In addition, the specific names of the functional units and modules are only for the convenience of distinguishing each other, and are not used to limit the scope of protection of this application. The specific working process of the units and modules in the above-mentioned system can refer to the corresponding process in the aforementioned method embodiment, which will not be repeated here.

[0098] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described or recorded in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.

[0099] Those skilled in the art will appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.

[0100] In the embodiments provided by the present invention, it should be understood that the disclosed devices / terminal equipment and methods can be implemented in other ways. For example, the device / terminal equipment embodiments described above are only schematic. For example, the division of the modules or units is only a logical function division. There may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms.

[0101] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.

[0102] In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware or in the form of software functional units.

[0103] If the integrated module is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the present invention implements all or part of the processes in the above-mentioned embodiment method, and can also be completed by instructing the relevant hardware through a computer program. The computer program can be stored in a computer-readable storage medium, and the computer program can implement the steps of the above-mentioned various method embodiments when executed by the processor. Among them, the computer program includes computer program code, and the computer program code can be in source code form, object code form, executable file or some intermediate form. The computer-readable medium may include: any entity or device capable of carrying the computer program code, recording medium, U disk, mobile hard disk, disk, optical disk, computer memory, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), electric carrier signal, telecommunication signal and software distribution medium. It should be noted that the content contained in the computer-readable medium can be appropriately increased or decreased according to the requirements of legislation and patent practice in the jurisdiction. For example, in some jurisdictions, according to legislation and patent practice, computer-readable media do not include electric carrier signals and telecommunication signals.

[0104] It is obvious to those skilled in the art that various modifications and variations can be made to the disclosed systems and related methods. Other embodiments will be obvious to those skilled in the art from consideration of the detailed description and practice of the disclosed systems and related methods.

[0105] It is intended that the specification and examples be considered as exemplary only, with a true scope being indicated by the following claims and their equivalents.

[0106] For the purpose of explanation, the above description has been described with reference to specific embodiments. However, the above illustrative discussion is not intended to be exhaustive or to limit the disclosure to the precise form disclosed. In view of the above teachings, many modifications and variations are possible. The embodiments are selected and described in order to best explain the principles of the disclosure and its practical application, thereby enabling others skilled in the art to best utilize the disclosure and various embodiments with various modifications suitable for the intended specific use.

Claims

1. A computer-implemented method for designing a serial robotic arm, the robotic arm comprising an end effector, a plurality of connecting rods and a plurality of motors, the method comprising: Obtaining a desired motion curve of the end effector; Discretize the desired motion curve into a plurality of points, wherein each point carries information of velocity, acceleration and force / torque of the end effector at the point; Determine the degrees of freedom of the serial robot arm, initialize the length of each of the connecting rods and the motor type of each of the motors; and At each of the points, optimizing the initialization length of the link and the initialization motor type of the motor by calculating a dynamic maneuverability ellipsoid at the end effector to obtain a desired length of the link and a desired motor type of the motor, thereby allowing the end effector to execute the desired motion curve under predetermined constraints; The constraints include: the desired motion curve has a preset smoothness; the serial robot arm needs to avoid obstacles; and the positions of the end effector at each of the points in the dynamic maneuverability ellipsoid can be connected to each other to form the desired motion curve; Wherein, optimizing the initialization length of the connecting rod and the initialization motor type of the motor by calculating the dynamic maneuverability ellipsoid at the end effector to obtain the desired length of the connecting rod and the desired motor type of the motor so as to allow the end effector to execute the desired motion curve under predetermined constraints comprises: (a) determining an algorithm for calculating a dynamic maneuverability ellipsoid at the end effector according to whether the serial robot arm is redundant in degrees of freedom, and calculating the dynamic maneuverability ellipsoid at the end effector according to information of velocity, acceleration and force / torque of the end effector at a current point; (b) Visualization of the dynamic operability ellipsoid; (c) determining whether the end effector is outside the dynamic maneuverability ellipsoid; (d) in response to the end effector being within the dynamic maneuverability ellipsoid, saving configuration information of a current length of the link and a motor type of the motor; (e) in response to the end effector being outside the dynamic maneuverability ellipsoid, modifying a current length of the link and a motor type of the motor, and returning to (a); Wherein, the algorithm for calculating the dynamic maneuverability ellipsoid at the end effector is determined according to whether the serial manipulator is redundant in degrees of freedom, including: Determining whether the serial robot has degrees of freedom in a joint space that are redundant with respect to degrees of freedom in a task space; In response to the serial robot having degrees of freedom in the joint space being redundant with respect to degrees of freedom in the task space, setting the velocity and acceleration at the current point to zero, and calculating a dynamic maneuverability ellipsoid at the end effector based on the force / torque, link length, and motor type at the current point using a Jacobian pseudo-inverse matrix; In response to the serial robot having degrees of freedom in the joint space being non-redundant with respect to degrees of freedom in the task space, determining whether a target point is reachable in the task space; In response to the target point being unreachable in the task space, modifying a current length of the link and a motor type of the motor; In response to the target point being reachable in the task space, the velocity and acceleration at the current point are set to 0, and the dynamic maneuverability ellipsoid at the end effector is calculated using an inverse Jacobian matrix based on the force / torque at the current point, the link length, and the motor type of the motor.

2. The method according to claim 1, wherein: The method also includes: after saving the current length of the connecting rod and the configuration information of the motor type of the motor, obtaining the speed, acceleration, and force / torque information of the end effector at the next point according to the current connecting rod length and the configuration information of the motor type, and returning to (a).

3. The method according to claim 2, wherein: Discretizing the expected motion curve into a plurality of points includes: equally dividing the expected motion curve into a plurality of points, or discretizing the expected motion curve into a plurality of points by a multi-order polynomial approximation method.

4. The method according to claim 3, wherein: The number of degrees of freedom is between 5 and 7.

5. A device for designing a serial robot arm, the robot arm comprising an end effector, a plurality of connecting rods and a plurality of motors, the device comprising: one or more processors; Memory; and One or more programs, the one or more programs are stored in the memory and configured to be executed by the one or more processors, the one or more programs including instructions for executing a serial robot arm design method, the method comprising: Obtaining a desired motion curve of the end effector; Discretize the desired motion curve into a plurality of points, wherein each point carries information of velocity, acceleration and force / torque of the end effector at the point; Determine the degrees of freedom of the serial robot arm, initialize the length of each of the connecting rods and the motor type of each of the motors; and At each of the points, optimizing the initialization length of the link and the initialization motor type of the motor by calculating a dynamic maneuverability ellipsoid at the end effector to obtain a desired length of the link and a desired motor type of the motor, thereby allowing the end effector to execute the desired motion curve under predetermined constraints; The constraints include: the desired motion curve has a preset smoothness; the serial robot arm needs to avoid obstacles; and the positions of the end effector at each of the points in the dynamic maneuverability ellipsoid can be connected to each other to form the desired motion curve; Wherein, optimizing the initialization length of the connecting rod and the initialization motor type of the motor by calculating the dynamic maneuverability ellipsoid at the end effector to obtain the desired length of the connecting rod and the desired motor type of the motor so as to allow the end effector to execute the desired motion curve under predetermined constraints comprises: (a) determining an algorithm for calculating a dynamic maneuverability ellipsoid at the end effector according to whether the serial robot arm is redundant in degrees of freedom, and calculating the dynamic maneuverability ellipsoid at the end effector according to information of velocity, acceleration and force / torque of the end effector at a current point; (b) Visualization of the dynamic operability ellipsoid; (c) determining whether the end effector is outside the dynamic maneuverability ellipsoid; (d) in response to the end effector being within the dynamic maneuverability ellipsoid, saving configuration information of a current length of the link and a motor type of the motor; (e) in response to the end effector being outside the dynamic maneuverability ellipsoid, modifying a current length of the link and a motor type of the motor, and returning to (a); Wherein, the algorithm for calculating the dynamic maneuverability ellipsoid at the end effector is determined according to whether the serial manipulator is redundant in degrees of freedom, including: Determining whether the serial robot has degrees of freedom in a joint space that are redundant with respect to degrees of freedom in a task space; In response to the serial robot having degrees of freedom in the joint space being redundant with respect to degrees of freedom in the task space, setting the velocity and acceleration at the current point to zero, and calculating a dynamic maneuverability ellipsoid at the end effector based on the force / torque, link length, and motor type at the current point using a Jacobian pseudo-inverse matrix; In response to the serial robot having degrees of freedom in the joint space being non-redundant with respect to degrees of freedom in the task space, determining whether a target point is reachable in the task space; In response to the target point being unreachable in the task space, modifying a current length of the link and a motor type of the motor; In response to the target point being reachable in the task space, the velocity and acceleration at the current point are set to 0, and the dynamic maneuverability ellipsoid at the end effector is calculated using an inverse Jacobian matrix based on the force / torque at the current point, the link length, and the motor type of the motor.

6. A non-transitory computer-readable storage medium storing one or more programs to be executed by an apparatus for designing a serial robot arm including an end effector, a plurality of links, and a plurality of motors, the one or more programs, when executed by the one or more processors, causing the apparatus to perform a process comprising: Obtaining a desired motion curve of the end effector; Discretize the desired motion curve into a plurality of points, wherein each point carries information of velocity, acceleration and force / torque of the end effector at the point; Determine the degrees of freedom of the serial robot arm, initialize the length of each of the connecting rods and the motor type of each of the motors; and At each of the points, optimizing the initialization length of the link and the initialization motor type of the motor by calculating a dynamic maneuverability ellipsoid at the end effector to obtain a desired length of the link and a desired motor type of the motor, thereby allowing the end effector to execute the desired motion curve under predetermined constraints; The constraints include: the desired motion curve has a preset smoothness; the serial robot arm needs to avoid obstacles; and the positions of the end effector at each of the points in the dynamic maneuverability ellipsoid can be connected to each other to form the desired motion curve; Wherein, optimizing the initialization length of the connecting rod and the initialization motor type of the motor by calculating the dynamic maneuverability ellipsoid at the end effector to obtain the desired length of the connecting rod and the desired motor type of the motor so as to allow the end effector to execute the desired motion curve under predetermined constraints comprises: (a) determining an algorithm for calculating a dynamic maneuverability ellipsoid at the end effector according to whether the serial robot arm is redundant in degrees of freedom, and calculating the dynamic maneuverability ellipsoid at the end effector according to information of velocity, acceleration and force / torque of the end effector at a current point; (b) Visualization of the dynamic operability ellipsoid; (c) determining whether the end effector is outside the dynamic maneuverability ellipsoid; (d) in response to the end effector being within the dynamic maneuverability ellipsoid, saving configuration information of a current length of the link and a motor type of the motor; (e) in response to the end effector being outside the dynamic maneuverability ellipsoid, modifying a current length of the link and a motor type of the motor, and returning to (a); Wherein, the algorithm for calculating the dynamic maneuverability ellipsoid at the end effector is determined according to whether the serial manipulator is redundant in degrees of freedom, including: Determining whether the serial robot has degrees of freedom in a joint space that are redundant with respect to degrees of freedom in a task space; In response to the serial robot having degrees of freedom in the joint space being redundant with respect to degrees of freedom in the task space, setting the velocity and acceleration at the current point to zero, and calculating a dynamic maneuverability ellipsoid at the end effector based on the force / torque, link length, and motor type at the current point using a Jacobian pseudo-inverse matrix; In response to the serial robot having degrees of freedom in the joint space being non-redundant with respect to degrees of freedom in the task space, determining whether a target point is reachable in the task space; In response to the target point being unreachable in the task space, modifying a current length of the link and a motor type of the motor; In response to the target point being reachable in the task space, the velocity and acceleration at the current point are set to 0, and the dynamic maneuverability ellipsoid at the end effector is calculated using an inverse Jacobian matrix based on the force / torque at the current point, the link length, and the motor type of the motor.