[go: up one dir, main page]

WO2023024278A1 - Procédé d'optimisation de pose d'articulation de robot, procédé de commande de robot et robot - Google Patents

Procédé d'optimisation de pose d'articulation de robot, procédé de commande de robot et robot Download PDF

Info

Publication number
WO2023024278A1
WO2023024278A1 PCT/CN2021/131673 CN2021131673W WO2023024278A1 WO 2023024278 A1 WO2023024278 A1 WO 2023024278A1 CN 2021131673 W CN2021131673 W CN 2021131673W WO 2023024278 A1 WO2023024278 A1 WO 2023024278A1
Authority
WO
WIPO (PCT)
Prior art keywords
joint
robot
angular velocity
optimization
optimization function
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
PCT/CN2021/131673
Other languages
English (en)
Chinese (zh)
Inventor
刘益彰
熊友军
罗璇
张志豪
陈春玉
葛利刚
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ubtech Robotics Corp
Original Assignee
Ubtech Robotics Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Ubtech Robotics Corp filed Critical Ubtech Robotics Corp
Publication of WO2023024278A1 publication Critical patent/WO2023024278A1/fr
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/161Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/1607Calculation of inertia, jacobian matrixes and inverses
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/163Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1651Programme controls characterised by the control loop acceleration, rate control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1661Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages

Definitions

  • the present application relates to the technical field of robot control, in particular to a robot joint pose optimization method, a robot control method and a robot.
  • Robots generally have multiple degrees of freedom, and through the coordination of multiple degrees of freedom to complete various tasks, in order to increase the range of motion and flexibility of the robot, many robots have added redundant joints, but the processing of redundant joints generally requires Very complex logic processing and classification calculations, which bring many challenges to the control of the robot.
  • some methods such as Newton's method are used to calculate the kinematic inverse solution in motion planning, which not only takes a long time to calculate, but also is difficult to calculate. , which leads to a longer total time for motion planning and lower planning efficiency.
  • the embodiment of the present application provides a robot joint pose optimization method, a robot control method, and a robot.
  • the optimization method uses the idea of double-layer optimization to deal with joint redundancy, and can obtain better joint angles to ensure that the robot can be completed first.
  • the speed task of the joints in the Cartesian space also makes each joint angle have a large range of motion.
  • Embodiments of the present application provide a method for optimizing robot joint poses, including:
  • the first optimization function includes the inequality constraint and the equality constraint including the slack variable that the joint angular velocity satisfies;
  • the second optimization function includes the constraint condition that the joint angular velocity satisfies and contains the same slack variable
  • An optimal joint angle of the robot is obtained according to the optimal joint angular velocity, and a pose of the robot joint is optimized according to the optimal joint angle of the robot.
  • the inequality constraint satisfied by the joint angular velocity is obtained through the following steps, including:
  • a synthetic constraint to obtain the joint angular velocity is constructed as the inequality constraint.
  • the first constraint condition is:
  • i-th joint angle in, and are the upper and lower limits of the i-th joint angle, respectively; is the i-th joint angle at time t; is the joint angular velocity of the i-th joint; T is the control command cycle of the robot.
  • the second constraint is:
  • the first optimization function takes the square of the slack variable as the optimization index
  • w is the slack variable
  • J is the speed Jacobian matrix of the robot
  • J is the joint angular velocity vector of all joints of the robot
  • the second optimization function uses the Euclidean distance between the joint angle and the joint limit as the optimization index
  • q is described Euclidean distance; and are the upper and lower limits of the i-th joint angle, respectively; is the i-th joint angle at time t.
  • the constraints containing the same slack variable of the second optimization function are the same as the equality constraints of the first optimization function, and the second optimization function further includes that the joint angular velocity satisfies The inequality constraints of ;
  • i-th joint angle at time t-1 is the i-th joint angle at time t-1; T is the control instruction period of the robot; w is the relaxation variable, J is the speed Jacobian matrix of the robot, is the joint angular velocity vector of all joints of the robot; is the terminal velocity vector of the robot; and are the upper and lower limits of the i-th joint angle, respectively; and are the upper and lower limits of the i-th joint angular velocity, respectively; and are the upper limit and lower limit of the i-th joint angular acceleration, respectively; and are the i-th joint angular velocity at time t-1 and time t, respectively.
  • Embodiments of the present application also provide a robot control method, including:
  • the robot is controlled to perform corresponding operations according to the optimized joint poses.
  • An embodiment of the present application also provides a robot, the robot includes a processor and a memory, the memory stores a computer program, and the processor is used to execute the computer program to implement the above-mentioned robot joint pose optimization method or robot Control Method.
  • Embodiments of the present application also provide a readable storage medium, which stores a computer program, and when the computer program is executed by a processor, implements the above-mentioned robot joint pose optimization method or robot control method.
  • the robot joint pose optimization method of the embodiment of the present application adopts the idea of double-layer optimization to deal with joint redundancy, by constructing the first optimization function with the joint angular velocity as the optimization variable, the robot terminal speed as the control target, and the joint angle away from the joint
  • the limit is the second optimization function of the control target.
  • the same slack variable is introduced into the two optimization functions and corresponding constraints are added, and the joint angle is optimally solved by combining the two optimization functions, which can ensure that the obtained solution can Prioritize the completion of the Cartesian space task, and on this basis, leave enough margin for each joint angle, so as to stay away from the joint limit.
  • the joint pose optimization method is not only suitable for joint angle optimization of rotational joint robots, but also suitable for joint position optimization of translational joints and translation-rotation hybrid robots, and has strong universality.
  • FIG. 1 is a schematic diagram of the first flow chart of the robot joint pose optimization method of the embodiment of the present application
  • FIG. 2 is a schematic diagram of the second flow chart of the robot joint pose optimization method of the embodiment of the present application
  • FIG. 3 is a schematic flow diagram of a robot control method in an embodiment of the present application.
  • FIG. 4 is a schematic structural diagram of a robot joint pose optimization device according to an embodiment of the present application.
  • the quadratic programming problem is mainly the process of selecting the optimal solution from multiple solutions under the constraints of equality and inequality.
  • the main form of the quadratic programming problem is as follows:
  • H is a Hessian matrix
  • x is an n-dimensional optimization variable
  • f is a row vector
  • a eq is an mxn (m ⁇ n) dimensional matrix
  • b eq is m Row and column vector
  • Ax ⁇ b is an inequality constraint
  • A is a matrix with n columns
  • b is a column vector.
  • the range of motion and flexibility of the robot are often increased by adding redundant joints.
  • the existing processing of redundant joints is generally very complicated and takes a long time to calculate, and there are certain limitations in practical use.
  • considering the characteristics of the robot's own structure it often has various constraints such as joint angles, joint angular velocities, and joint torques in different application scenarios.
  • Optimal kinematics inverse solution the embodiment of the present application will use the quadratic programming problem to optimize the solution, specifically, the joint angle is optimized and solved by constructing a double-layer optimization index (ie, a double-layer quadratic optimization problem).
  • the robot joint pose optimization method of the embodiment of the present application constructs the first optimization function with the joint angular velocity as the optimization variable and the robot end speed as the control target, and the joint angular velocity as the optimization variable and the joint angle away from the joint limit as the control target
  • the second optimization function and introduce the same slack variable to these two optimization functions and add corresponding constraints.
  • FIG. 1 is a schematic diagram of a first flowchart of a method for optimizing a joint pose of a robot according to an embodiment of the present application.
  • the robot joint pose optimization method includes:
  • Step S110 constructing a first optimization function with the joint angular velocity as the optimization variable and the robot terminal velocity as the control objective, the first optimization function includes the inequality constraints that the joint angular velocity satisfies and the equality constraints including slack variables.
  • a quadratic programming problem is constructed here with the joint angular velocity as the control variable and the end velocity as the control target, which is the above-mentioned first optimization function. It can be understood that the "first" in the first optimization function is mainly used to distinguish it from other optimization functions mentioned later.
  • the first optimization function will introduce a slack variable, and obtain the index to be optimized based on the slack variable.
  • the optimization index may be the square of the slack variable, etc., of course, may also take other forms related to the slack variable, which are not limited here.
  • the first optimization function will also be added with corresponding constraints, which mainly include equality constraints with slack variables that the joint angular velocity satisfies, and inequality constraints that are directly or indirectly related to the joint angular velocity, so as to ensure that the obtained joint angular velocity
  • constraints which mainly include equality constraints with slack variables that the joint angular velocity satisfies, and inequality constraints that are directly or indirectly related to the joint angular velocity, so as to ensure that the obtained joint angular velocity
  • the optimal solution can achieve the speed index of the terminal under the constraints of each joint.
  • the velocity Jacobian matrix of the robot can reflect the relationship between the angular velocity of each joint and the terminal velocity, in the case of introducing the slack variable, the equality constraint equation satisfied by the joint angular velocity, the slack variable and the terminal velocity will be constructed here.
  • the inequality constraints of the first optimization function may include, but are not limited to, joint angle constraints, physical constraints on joint angular velocity itself, and joint angular acceleration constraints, for example.
  • the inequality constraints satisfied by the joint angular velocity can be obtained through the following steps, including:
  • Step S210 constructing joint angle constraints that each joint of the robot satisfies in a corresponding control period, and converting the joint angle constraints into a first constraint condition with joint angular velocity as a variable.
  • joint limit constraints satisfied by each joint angle of the robot are first constructed, and then converted to obtain the corresponding joint angular velocity constraints.
  • the above-mentioned joint limit mainly refers to the limit of the joint position; and for robots with rotary joints, the above-mentioned joint limit mainly refers to Limits on joint angles.
  • Step S220 construct the joint angular acceleration constraints that each joint satisfies in the corresponding control period, and convert the joint angular acceleration constraints into a second constraint condition with the joint angular velocity as a variable.
  • this embodiment will first construct the constraints that the angular acceleration of each joint of the robot satisfies, and then convert to obtain the corresponding joint angular velocity constraint.
  • Step S230 based on the first constraint condition, the second constraint condition and the self-constraint of the joint angular velocity, construct a composite constraint to obtain the joint angular velocity as the above-mentioned inequality constraint.
  • the robot also has joint angular velocity constraints, assuming that the upper limit of the i-th joint angular velocity is The lower limit is Then, the self-constraint of joint angular velocity can be expressed as:
  • joint angle (or joint position) constraint joint angular velocity constraint and joint angular acceleration constraint to obtain the composite inequality constraint of joint angular velocity is only an example of adding inequality, and in actual application, you can also add more There are many constraints, which are not limited here.
  • the first optimization function if the square of the slack variable is used as the optimization index, and the corresponding equality constraint equation and inequality constraint are constructed, the first optimization function can be written as follows:
  • Step S120 constructing a second optimization function with the joint angular velocity as the optimization variable and the robot's joint angle away from the joint limit as the control objective, the second optimization function includes the constraint conditions with the same slack variable that the joint angular velocity satisfies.
  • another quadratic programming problem that is, the above-mentioned second optimization function
  • the second optimization function uses the Euclidean distance between the joint angle and the joint limit as the optimization index.
  • Euclidean distance In addition to the Euclidean distance, other calculation formulas that can reflect the joint angle and the joint limit can also be used , is not limited here.
  • q is the Euclidean distance; and are the upper and lower limits of the i-th joint angle, respectively; is the i-th joint angle at time t.
  • a double-layer quadratic programming problem is used to comprehensively solve an optimal joint angular velocity.
  • the joint angular velocity of the second optimization function in order to make the joint angular velocity finally solved under the premise of ensuring the end velocity of the Cartesian space control, further make each joint If the angle gradually approaches the optimal solution, the joint angular velocity of the second optimization function also needs to add corresponding constraints.
  • the joint angular velocity of the second optimization function may add an equality constraint including the same slack variable and an inequality constraint related to the joint angular velocity.
  • the second optimization function if the optimization index of each joint angle is farthest from the joint limit as an example, and the same equality constraint equation and inequality constraint as the first optimization function are added, the second optimization function can be written as In the following form:
  • step S130 the solution of the slack variable is obtained by solving according to the first optimization function, and the optimal joint angular velocity is obtained according to the solution of the slack variable and the second optimization function.
  • an open-source solver can be used to optimally solve the first optimization function to obtain the joint angular velocity and the solution of the slack variable; then, use the solved slack variable
  • the solution of the second optimization function is optimally solved, and the optimal joint angular velocity can be obtained at this time, which is the required joint angular velocity.
  • step S140 the optimal joint angle of the robot is obtained according to the optimal joint angular velocity, and the pose of the robot joint is optimized according to the optimal joint angle of the robot.
  • the optimal joint angle can be obtained through an integral operation. Furthermore, the posture (such as angle or position) of the robot joints can be adjusted according to the optimal joint angles, so as to ensure that the robot can perform corresponding task operations.
  • the joint pose optimization method of the robot in this embodiment uses the idea of double-layer optimization to deal with the problem of joint redundancy, by constructing the first optimization function that takes the joint angular velocity as the optimization variable, the robot end speed as the control target and introduces the slack variable, and The second optimization function that takes the joint angle away from the joint limit as the control target and introduces the same slack variable, and adds synthetic constraints such as the angle, angular velocity, and angular acceleration of each joint to these two optimization functions, where the second optimization
  • the function is further solved for joint angular velocity within the range of joint angle constraints satisfied by the first optimization function, so it can be realized that under various joint constraint conditions, the velocity task in Cartesian space can be completed first, and on this basis, each joint angle can be given Sufficient margin is left, that is, it has a large activity margin.
  • the method is versatile and can be used to automatically optimize the joint positions or joint angles of various types of robots such as rotational joints, translational joints, and translational-rotation
  • this embodiment proposes a robot control method.
  • -Robots and the like in mixed motion are not limited here.
  • the rotating joint type robot means that the robot drives the robot joints connected to the steering gear through the steering gear outputting the rotation angle to realize the movement corresponding to the rotation angle.
  • the robot of the translational joint type means that the robot drives the robot joints connected to the steering gear through the steering gear outputting the linear displacement to realize the movement corresponding to the translation angle.
  • the robot has redundant joints, and various tasks can be completed by coordinating these redundant joints.
  • the robot control method includes:
  • Step S310 acquiring state parameters related to joint angular velocity of the robot in the current control command cycle.
  • Step S320 using the robot joint pose optimization method to optimize the joint pose of the next control command cycle according to the state parameters.
  • state parameters need to be obtained can be determined according to the constructed first optimization function and the second optimization function. These state parameters can be directly collected by sensors, etc., or can be obtained through calculation and processing of collected data. What is obtained later is not limited here.
  • the joint angle corresponding to the control command cycle, the expected terminal velocity, and the Jacobian matrix can be obtained, and then the known quantities are substituted into the optimization function to be used to calculate the joint angular velocity.
  • the optimization variable and the slack variable are solved, and the second optimization function is the same.
  • Step S330 controlling the robot to perform corresponding operations according to the optimized joint poses.
  • these joint angles or joint positions required for the next control command cycle of the robot are obtained, these joint angles or joint positions are sent as commands to the corresponding joint motors, so that the robot performs corresponding operations, for example, can It is robot obstacle avoidance task, human-computer interaction task, etc.
  • the robot control method of this embodiment uses the robot joint pose optimization method to automatically optimize the joint pose, so that the robot joint position can always have the largest activity margin under the premise of ensuring the Cartesian space pose. .
  • the robot joint pose optimization device 100 includes:
  • the construction module 110 is used to construct a first optimization function with the joint angular velocity as the optimization variable and the robot terminal velocity as the control target, the first optimization function includes the inequality constraint and the equality constraint including the slack variable that the joint angular velocity satisfies.
  • the construction module 110 is also used to construct a second optimization function with the joint angular velocity as the optimization variable and the joint angle of the robot away from the joint limit as the control target, the second optimization function includes the same slack that the joint angular velocity satisfies Variable constraints.
  • the solving module 120 is configured to solve according to the first optimization function to obtain the solution of the slack variable, and obtain the optimal joint angular velocity according to the solution of the slack variable and the second optimization function.
  • the solving module 120 is also used to obtain the optimal joint angle of the robot according to the optimal joint angular velocity.
  • An optimization module 130 configured to optimize the poses of the robot joints according to the optimal joint angles of the robot.
  • the device in this embodiment corresponds to the method in the above-mentioned embodiment 1, and the optional items in the above-mentioned embodiment 1 are also applicable to this embodiment, so the description will not be repeated here.
  • the present application also provides a robot.
  • the robot includes a processor and a memory, wherein the memory stores a computer program, and the processor executes the computer program so that the robot performs the above-mentioned robot joint pose optimization method Or the functions of each module in the above-mentioned robot joint pose optimization device.
  • the present application also provides a readable storage medium for storing the computer program used in the above robot.
  • each block in a flowchart or block diagram may represent a module, program segment, or part of code that includes one or more Executable instructions.
  • the functions noted in the block may occur out of the order noted in the figures. For example, two blocks in succession may, in fact, be executed substantially concurrently, or they may sometimes be executed in the reverse order, depending upon the functionality involved.
  • each block of the block diagrams and/or flow diagrams, and combinations of blocks in the block diagrams and/or flow diagrams can be implemented by a dedicated hardware-based system that performs the specified function or action. may be implemented, or may be implemented by a combination of special purpose hardware and computer instructions.
  • each functional module or unit in each embodiment of the present application may be integrated to form an independent part, each module may exist independently, or two or more modules may be integrated to form an independent part.
  • the functions are implemented in the form of software function modules and sold or used as independent products, they can be stored in a computer-readable storage medium.
  • the technical solution of the present application is essentially or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including Several instructions are used to make a computer device (which may be a smart phone, a personal computer, a server, or a network device, etc.) execute all or part of the steps of the methods described in the various embodiments of the present application.
  • the aforementioned storage media include: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), magnetic disk or optical disc, etc., which can store program codes. .

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Software Systems (AREA)
  • Manipulator (AREA)

Abstract

Un procédé d'optimisation de pose d'articulation de robot, un procédé de commande de robot et un robot sont divulgués. Le procédé consiste à : élaborer une première fonction d'optimisation à l'aide d'une vitesse angulaire d'articulation utilisée en tant que variable d'optimisation et d'une vitesse de terminal de robot utilisée en tant que cible de commande, la première fonction d'optimisation comprenant une contrainte d'inégalité satisfaite par la vitesse angulaire d'articulation et une contrainte d'égalité comprenant une variable d'écart ; élaborer une seconde fonction d'optimisation à l'aide de la vitesse angulaire d'articulation utilisée en tant que variable d'optimisation et d'un angle d'articulation à l'opposé d'une limite d'articulation utilisée en tant que cible de commande, la seconde fonction d'optimisation comprenant des conditions de contrainte comprenant la même variable d'écart satisfaites par la vitesse angulaire d'articulation ; et résoudre la première fonction d'optimisation pour obtenir une solution pour la variable d'écart, et utiliser la solution de la variable d'écart dans la seconde fonction d'optimisation pour obtenir une vitesse angulaire d'articulation optimale, ce qui permet une résolution pour obtenir un angle d'articulation optimal pour optimiser la pose d'articulation du robot. Le présent procédé peut obtenir une solution optimale pour une pose d'articulation, amenant chaque angle d'articulation à présenter de manière cohérente une marge d'activité plus grande tout en garantissant la priorité de la vitesse d'achèvement de tâche.
PCT/CN2021/131673 2021-08-24 2021-11-19 Procédé d'optimisation de pose d'articulation de robot, procédé de commande de robot et robot Ceased WO2023024278A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202110976981.3 2021-08-24
CN202110976981.3A CN113618741B (zh) 2021-08-24 2021-08-24 机器人关节位姿优化方法、机器人控制方法和机器人

Publications (1)

Publication Number Publication Date
WO2023024278A1 true WO2023024278A1 (fr) 2023-03-02

Family

ID=78387594

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/131673 Ceased WO2023024278A1 (fr) 2021-08-24 2021-11-19 Procédé d'optimisation de pose d'articulation de robot, procédé de commande de robot et robot

Country Status (2)

Country Link
CN (1) CN113618741B (fr)
WO (1) WO2023024278A1 (fr)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118636129A (zh) * 2024-05-31 2024-09-13 上海智元新创技术有限公司 串联型机器人及其逆运动学求解方法、相关介质和设备

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113618741B (zh) * 2021-08-24 2022-07-29 深圳市优必选科技股份有限公司 机器人关节位姿优化方法、机器人控制方法和机器人
CN114227687B (zh) * 2021-12-28 2023-08-15 深圳市优必选科技股份有限公司 一种机器人控制方法、装置、终端设备及存储介质
CN114193457B (zh) * 2022-01-07 2025-01-28 珞石(山东)机器人集团有限公司 一种基于局部搜索算法的机械臂自主避障路径生成方法
CN116570461B (zh) * 2023-04-14 2025-09-16 深圳华鹊景医疗科技有限公司 九自由度上肢康复机器人

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040254679A1 (en) * 2003-04-10 2004-12-16 Kenichiro Nagasaka Robot movement control system
US20070185618A1 (en) * 2006-01-16 2007-08-09 Kenichiro Nagasaka Control system, control method, and computer program
JP2011183527A (ja) * 2010-03-10 2011-09-22 Toyota Motor Corp 冗長ロボットの関節目標値決定方法及び冗長ロボットの制御装置
CN106584461A (zh) * 2016-12-21 2017-04-26 西安科技大学 多约束条件下七自由度仿人机械臂的逆运动学拟人臂构型优化方法
CN106625666A (zh) * 2016-12-16 2017-05-10 广州视源电子科技股份有限公司 冗余机械臂的控制方法及装置
CN107234617A (zh) * 2017-07-10 2017-10-10 北京邮电大学 一种避障任务无关人工势场引导的避障路径规划方法
JP2019063912A (ja) * 2017-09-29 2019-04-25 キヤノン株式会社 ロボット制御データ処理方法、ロボット制御データ処理装置、およびロボットシステム
CN110561441A (zh) * 2019-10-23 2019-12-13 中山大学 一种冗余度机械臂位姿控制的单94lvi迭代算法
CN111538949A (zh) * 2020-07-10 2020-08-14 深圳市优必选科技股份有限公司 冗余机器人逆运动学求解方法、装置和冗余机器人
CN112873208A (zh) * 2021-01-29 2021-06-01 佛山树客智能机器人科技有限公司 一种抗噪与动力学约束的机器人实时运动规划方法及装置
CN113618741A (zh) * 2021-08-24 2021-11-09 深圳市优必选科技股份有限公司 机器人关节位姿优化方法、机器人控制方法和机器人

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110103225B (zh) * 2019-06-04 2023-04-11 兰州大学 一种数据驱动的机械臂重复运动控制方法与装置
CN110861088A (zh) * 2019-11-29 2020-03-06 沈阳通用机器人技术股份有限公司 一种冗余自由度机器人的运动优化方法
CN113084791B (zh) * 2019-12-23 2022-09-23 深圳市优必选科技股份有限公司 机械臂控制方法、机械臂控制装置及终端设备
CN111037560B (zh) * 2019-12-25 2021-06-25 广东省智能制造研究所 一种协作机器人柔顺力控制方法及系统
CN111300414B (zh) * 2020-03-06 2022-07-15 陕西理工大学 一种双准则的冗余机械臂自运动规划方法
CN111975768B (zh) * 2020-07-08 2022-03-25 华南理工大学 一种基于固参神经网络的机械臂运动规划方法
CN113070881B (zh) * 2021-04-02 2022-11-11 深圳市优必选科技股份有限公司 机器人运动控制方法、装置和机器人

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040254679A1 (en) * 2003-04-10 2004-12-16 Kenichiro Nagasaka Robot movement control system
US20070185618A1 (en) * 2006-01-16 2007-08-09 Kenichiro Nagasaka Control system, control method, and computer program
JP2011183527A (ja) * 2010-03-10 2011-09-22 Toyota Motor Corp 冗長ロボットの関節目標値決定方法及び冗長ロボットの制御装置
CN106625666A (zh) * 2016-12-16 2017-05-10 广州视源电子科技股份有限公司 冗余机械臂的控制方法及装置
WO2018107851A1 (fr) * 2016-12-16 2018-06-21 广州视源电子科技股份有限公司 Procédé et dispositif de commande de bras de robot redondant
CN106584461A (zh) * 2016-12-21 2017-04-26 西安科技大学 多约束条件下七自由度仿人机械臂的逆运动学拟人臂构型优化方法
CN107234617A (zh) * 2017-07-10 2017-10-10 北京邮电大学 一种避障任务无关人工势场引导的避障路径规划方法
JP2019063912A (ja) * 2017-09-29 2019-04-25 キヤノン株式会社 ロボット制御データ処理方法、ロボット制御データ処理装置、およびロボットシステム
CN110561441A (zh) * 2019-10-23 2019-12-13 中山大学 一种冗余度机械臂位姿控制的单94lvi迭代算法
CN111538949A (zh) * 2020-07-10 2020-08-14 深圳市优必选科技股份有限公司 冗余机器人逆运动学求解方法、装置和冗余机器人
CN112873208A (zh) * 2021-01-29 2021-06-01 佛山树客智能机器人科技有限公司 一种抗噪与动力学约束的机器人实时运动规划方法及装置
CN113618741A (zh) * 2021-08-24 2021-11-09 深圳市优必选科技股份有限公司 机器人关节位姿优化方法、机器人控制方法和机器人

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118636129A (zh) * 2024-05-31 2024-09-13 上海智元新创技术有限公司 串联型机器人及其逆运动学求解方法、相关介质和设备

Also Published As

Publication number Publication date
CN113618741A (zh) 2021-11-09
CN113618741B (zh) 2022-07-29

Similar Documents

Publication Publication Date Title
WO2023024278A1 (fr) Procédé d'optimisation de pose d'articulation de robot, procédé de commande de robot et robot
CN104834309B (zh) 基于目标跟踪控制策略的单移动机器人最优巡回控制方法
WO2023024279A1 (fr) Procédé et appareil d'évitement dynamique d'obstacles pour robot, et robot
CN106475999B (zh) 刚性条件下基于阻抗模型的双臂协调的加速度控制方法
CN114347020B (zh) 一种运动控制方法、运动控制装置及机器人
WO2023024317A1 (fr) Procédé et appareil d'évitement d'obstacle de robot, et robot
WO2020151406A1 (fr) Procédé, appareil et système de commande de mouvement et support de stockage
CN105856231B (zh) 一种特定构型六轴工业机器人的运动控制方法
CN112222703B (zh) 一种焊接机器人能耗最优轨迹规划方法
CN116512247B (zh) 一种冗余度机械臂运动规划方法、装置及存储介质
WO2020093253A1 (fr) Procédé de commande de mouvement de robot, système de commande et dispositif de stockage
CN117245640A (zh) 机器人的控制方法、装置、设备及存储介质
CN117001655A (zh) 机器人运动控制方法、装置、机器人和存储介质
CN105892412A (zh) 基于自定义总线的多轴运动控制系统硬件架构
CN116276966A (zh) 基于二次规划的移动操作机器人全身反应规划控制方法
CN117182932A (zh) 机械臂避障动作规划方法、装置和计算机设备
CN113954077A (zh) 带有能量优化的水下游动机械臂轨迹跟踪控制方法及装置
CN115922684A (zh) 用于六轴机器人的奇异点处理方法、装置、设备及介质
US11007639B2 (en) Joint control method for serial robot and serial robot using the same
CN115922704A (zh) 机器人和外部轴的联动协同控制方法、设备及存储介质
US20250289125A1 (en) Robot force control method, and computer-readable storage medium and robot using the same
CN112276952B (zh) 一种多机器人系统的鲁棒同时镇定方法及系统
CN114211492A (zh) 一种基于模型的多自由度机械臂的最优轨迹规划方法
CN112356032A (zh) 一种姿态平滑过渡方法及系统
CN116276958A (zh) 一种基于模糊adrc的连续体机械臂多环控制方法

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21954797

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21954797

Country of ref document: EP

Kind code of ref document: A1