CN112060093B - Path planning method for overhead line maintenance mechanical arm - Google Patents

Path planning method for overhead line maintenance mechanical arm Download PDF

Info

Publication number
CN112060093B
CN112060093B CN202010944366.XA CN202010944366A CN112060093B CN 112060093 B CN112060093 B CN 112060093B CN 202010944366 A CN202010944366 A CN 202010944366A CN 112060093 B CN112060093 B CN 112060093B
Authority
CN
China
Prior art keywords
mechanical arm
tail end
path planning
points
position information
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.)
Active
Application number
CN202010944366.XA
Other languages
Chinese (zh)
Other versions
CN112060093A (en
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.)
Electric Power Research Institute of Yunnan Power Grid Co Ltd
Original Assignee
Electric Power Research Institute of Yunnan Power Grid Co Ltd
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 Electric Power Research Institute of Yunnan Power Grid Co Ltd filed Critical Electric Power Research Institute of Yunnan Power Grid Co Ltd
Priority to CN202010944366.XA priority Critical patent/CN112060093B/en
Publication of CN112060093A publication Critical patent/CN112060093A/en
Application granted granted Critical
Publication of CN112060093B publication Critical patent/CN112060093B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B25J9/1666Avoiding collision or forbidden zones

Abstract

The invention discloses a path planning method for an overhead line maintenance mechanical arm, which comprises the steps of firstly obtaining obstacle information, an operation degree threshold value, initial position information of the tail end of the mechanical arm and end point position information of the tail end of the mechanical arm, carrying out non-collision path planning aiming at the tail end position of the mechanical arm in a Cartesian space according to the obstacle information, the operation degree threshold value, the initial position information of the tail end of the mechanical arm and the end point position information of the tail end of the mechanical arm, giving a feasible path of the tail end of the mechanical arm, avoiding generating a large number of invalid sampling points, reducing calculated amount, then carrying out secondary path planning until the feasible paths are connected, and completing the whole path planning of the tail end of the mechanical arm.

Description

Path planning method for overhead line maintenance mechanical arm
Technical Field
The invention relates to the field of electric power, in particular to a path planning method for an overhead line maintenance mechanical arm.
Background
In order to ensure the safe operation of an electric power system, a plurality of overhead transmission line robots are present, and meanwhile, in order to improve the operation capacity of the robots and promote the unmanned development direction of defect detection and fault repair of the transmission lines, mechanical arms with overhaul capacity are generally required to be installed on the body structure of the overhead transmission line inspection robot, so that the development of the research on the aspect of path planning of the overhead line overhaul mechanical arms is of great significance for ensuring the risk-free operation of the overhead transmission lines.
Because the number of overhead transmission line robots with the overhauling mechanical arms is relatively small, and corresponding motion paths are preset according to specific overhead transmission line scenes in an off-line state, the overhead transmission line robots can easily collide with a transmission line, a shockproof hammer, a hydraulic wire clamp or other parts on a body structure in an operation space in the actual operation process.
At present, a path method for overhauling a mechanical arm of an overhead line mainly comprises a sampling-based method in a joint space and an inverse kinematics solution-based method in a Cartesian space, wherein a sampling planning method can well consider all joint states of the mechanical arm, but generates a large amount of useless bit shapes to increase the calculation cost, and the inverse kinematics solution-based method can quickly provide an ideal track of the tail end of the mechanical arm, but cannot ensure that all joints can meet corresponding constraints.
Therefore, how to design a path planning method for the overhead line maintenance mechanical arm, which has small calculation amount and can ensure that all joints of the mechanical arm meet corresponding constraints, becomes a problem to be solved urgently.
Disclosure of Invention
The invention provides a path planning method for an overhead line maintenance mechanical arm, which aims to solve the problems that the existing method is large in calculation amount and cannot ensure that all joints of the mechanical arm meet corresponding constraints.
The invention provides a path planning method for an overhead line maintenance mechanical arm, which comprises the following steps:
s1: acquiring obstacle information, an operation degree threshold value, initial position information of the tail end of the mechanical arm and terminal position information of the tail end of the mechanical arm;
s2: according to the obstacle information, the operation degree threshold value, the initial position information of the tail end of the mechanical arm and the terminal position information of the tail end of the mechanical arm, planning a non-collision path of the tail end of the mechanical arm in a Cartesian space;
s3: judging whether the non-collision path planning of the tail end position of the mechanical arm is successful, if so, finishing the path planning; otherwise, performing secondary path planning.
Optionally, the planning a non-collision path of the end position of the mechanical arm in the cartesian space according to the obstacle information, the threshold of the degree of operation, the initial position information of the end of the mechanical arm, and the end position information of the end of the mechanical arm includes:
s21: planning a non-collision path from the initial position of the tail end of the mechanical arm to the end position in a Cartesian space according to the initial position information of the tail end of the mechanical arm and the end position information of the tail end of the mechanical arm to obtain a position point in the non-collision path;
s22: and performing inverse kinematics solution on all the position points to obtain inverse solution values.
Optionally, judging whether the path planning is successful, if so, ending the path planning; otherwise, the performing the secondary path planning includes:
judging whether all the inverse solution values exist and are greater than an operation degree threshold value, and finishing path planning if all the inverse solution values exist and are greater than the operation degree threshold value; otherwise, performing secondary path planning.
Optionally, the secondary path planning includes:
s31: deleting the position points without inverse solution values, and storing the deleted position points as a plurality of feasible path segments;
s32: acquiring end points of all feasible path sections, sequencing all the end points according to the direction from the initial position to the end position of the tail end of the mechanical arm, and constructing a position point sequence;
s33: constructing a plurality of sphere spaces by taking points positioned at odd number positions and points at the right end adjacent to even number positions in the position point sequence as diameter end points;
s34: randomly sampling a collision-free mechanical arm shape, performing positive kinematic solution to obtain a positive solution, judging whether the positive solution is positioned in a sphere space, if so, keeping and performing the next step, otherwise, re-sampling;
s35: acquiring a preset radius, and connecting all positive solutions in the same sphere space by taking the preset radius as a connecting range;
s36: judging whether all the points at the odd number position in the position point sequence are connected with the points at the right end adjacent to the even number position, and finishing path planning if the connection is successful; otherwise, the process goes to S34.
Alternatively, in the connecting all the positive solutions located in the same sphere space, the two connected sampling collision-free arm-shaped positive solutions are located in the same sphere space.
Optionally, the euclidean distance between two of said positive solutions is less than a predetermined radius.
The invention provides a path planning method for an overhead line maintenance mechanical arm, which comprises the following steps: acquiring obstacle information, an operation degree threshold value, initial position information of the tail end of the mechanical arm and terminal position information of the tail end of the mechanical arm; according to the obstacle information, the operation degree threshold value, the initial position information of the tail end of the mechanical arm and the terminal position information of the tail end of the mechanical arm, planning a non-collision path of the tail end of the mechanical arm in a Cartesian space; judging whether the non-collision path planning of the tail end position of the mechanical arm is successful, if so, finishing the path planning; otherwise, performing secondary path planning. According to the method, the non-collision path planning is carried out aiming at the tail end position of the mechanical arm in the Cartesian space, a feasible path of the tail end of the mechanical arm is provided, a large number of invalid sampling points can be avoided, the calculated amount is reduced, then secondary path planning is carried out until the feasible paths are connected, and the whole path planning of the tail end of the mechanical arm is completed.
Drawings
In order to more clearly illustrate the technical solution of the present invention, the drawings needed to be used in the embodiments will be briefly described below, and it is obvious to those skilled in the art that other drawings can be obtained according to the drawings without any inventive exercise.
Fig. 1 is a flowchart of a path planning method for an overhead line maintenance robot according to the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention are clearly and completely described below with reference to the drawings in the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
In the following description, numerous specific details are set forth in order to provide a thorough understanding of the present invention, but the present invention may be practiced in other ways than those specifically described, and it will be appreciated by those skilled in the art that the present invention may be embodied without departing from the spirit and scope of the invention, and therefore the present invention is not limited to the specific embodiments disclosed below.
Referring to fig. 1, the present invention provides a path planning method for an overhead line service robot arm, the method comprising:
s1: acquiring obstacle information, an operation degree threshold value, initial position information of the tail end of the mechanical arm and terminal position information of the tail end of the mechanical arm;
the sensing system carried by the platform where the overhead line maintenance mechanical arm is located acquires obstacle information, an operation degree threshold value, initial position information of the tail end of the mechanical arm and end point position information of the tail end of the mechanical arm, and the sensing system is a sensing element or a camera or a video camera or a laser radar and the like, so long as space object geometric information can be provided.
S2: according to the obstacle information, the operation degree threshold value, the initial position information of the tail end of the mechanical arm and the terminal position information of the tail end of the mechanical arm, planning a non-collision path of the tail end of the mechanical arm in a Cartesian space;
s3: judging whether the non-collision path planning of the tail end position of the mechanical arm is successful, if so, finishing the path planning; otherwise, performing secondary path planning.
Optionally, the planning a non-collision path of the end position of the mechanical arm in the cartesian space according to the obstacle information, the threshold of the degree of operation, the initial position information of the end of the mechanical arm, and the end position information of the end of the mechanical arm includes:
s21: planning a non-collision path from the initial position of the tail end of the mechanical arm to the end position in a Cartesian space according to the initial position information of the tail end of the mechanical arm and the end position information of the tail end of the mechanical arm to obtain a position point in the non-collision path;
in a Cartesian space, the states of all joints of the mechanical arm do not need to be considered, and only a non-collision path from an initial position to a terminal position needs to be planned at the tail end of the mechanical arm.
S22: and performing inverse kinematics solution on all the position points to obtain inverse solution values.
Optionally, judging whether the path planning is successful, if so, ending the path planning; otherwise, the performing the secondary path planning includes:
judging whether all the inverse solution values exist and are greater than an operation degree threshold value, and finishing path planning if all the inverse solution values exist and are greater than the operation degree threshold value; otherwise, performing secondary path planning.
Optionally, the secondary path planning includes:
s31: deleting the position points without inverse solution values, and storing the deleted position points as a plurality of feasible path segments;
s32: acquiring end points of all feasible path sections, sequencing all the end points according to the direction from the initial position to the end position of the tail end of the mechanical arm, and constructing a position point sequence;
s33: constructing a plurality of sphere spaces by taking points positioned at odd number positions and points at the right end adjacent to even number positions in the position point sequence as diameter end points;
s34: randomly sampling a collision-free mechanical arm shape, performing positive kinematic solution to obtain a positive solution, judging whether the positive solution is positioned in a sphere space, if so, keeping and performing the next step, otherwise, re-sampling;
s35: acquiring a preset radius, and connecting all positive solutions in the same sphere space by taking the preset radius as a connecting range;
s36: judging whether all the points at the odd number position in the position point sequence are connected with the points at the right end adjacent to the even number position, and finishing path planning if the connection is successful; otherwise, the process goes to S34.
Aiming at the actual operation space or the simulation operation space of the overhead line maintenance mechanical arm, firstly providing obstacle information of the environment around the overhead line maintenance mechanical arm, an initial position and a terminal position of the mechanical arm end by a sensing system carried by a platform where the overhead line maintenance mechanical arm is located, and setting a preset radius; secondly, in a Cartesian space, the states of all joints of the mechanical arm are not considered, only a non-collision path from an initial position to a terminal position is planned at the tail end of the mechanical arm, and inverse kinematics solution is carried out on all position points in the path;
if the inverse solution exists and meets the requirements that the operability is not zero and the obstacle does not collide, the path planning process is completed, otherwise, the following second planning process is required:
firstly, deleting the position points without inverse solution values, and storing the deleted position points as a plurality of feasible path segments; secondly, numbering the feasible path segments (1,2, …, i, i +1, …), wherein the serial number of the feasible path segment close to the initial position is smaller than that of the feasible path segment close to the end position, and for convenience of description, the end point close to the initial position in the ith path segment is a near point of the ith feasible path segment, and the end point close to the end position is a far point of the ith feasible path segment; then, planning between a far point of the ith feasible path segment and a near point of the (i + 1) th feasible path segment, wherein due to the fact that an obstacle exists between the ith path segment and the (i + 1) th path segment, and the obstacle is caused by a mechanical arm joint instead of a tail end, planning needs to be carried out in a mechanical arm joint space, and the following steps are specifically carried out:
randomly sampling a collision-free mechanical arm configuration in a joint space, performing positive kinematics solution to obtain a corresponding mechanical arm tail end position, if the tail end position is in a sphere space between a far point of an ith feasible path section and a near point of an (i + 1) th feasible path section, reserving the mechanical arm configuration, and otherwise, sampling again; if the position of the sampled mechanical arm is reserved, connecting the sampled mechanical arm with the reserved sampling points, and in order to ensure the validity of connection, two points of requirements are required to be met, namely positive solutions of two connected sampling points are located in the same sphere space, and the Euclidean distance between the two positive solutions is smaller than a preset radius, otherwise, re-sampling and re-connection are required; according to the above process, the path planning process is completed until the end points of all the feasible path segments are connected.
Alternatively, in the connecting all the positive solutions located in the same sphere space, the two connected sampling collision-free arm-shaped positive solutions are located in the same sphere space.
Optionally, the euclidean distance between two of said positive solutions is less than a predetermined radius.
The method provided by the invention firstly plans in the operation space of the mechanical arm, can quickly provide a mechanical arm path, and can avoid generating a large number of invalid sampling points compared with the method that planning in the joint space is adopted at first; however, related constraints such as non-collision and high operability can be simply and intuitively considered in the planning in the joint space, and the problem of difficult inverse kinematics solution caused by the fact that too many constraints need to be considered in the planning in the operation space can be avoided; therefore, the method provided by the patent can reduce the calculation cost, improve the planning efficiency and ensure the real-time operation requirement of the path planning of the overhead line maintenance mechanical arm.
The invention provides a path planning method for an overhead line maintenance mechanical arm, which comprises the following steps: acquiring obstacle information, an operation degree threshold value, initial position information of the tail end of the mechanical arm and terminal position information of the tail end of the mechanical arm; according to the obstacle information, the operation degree threshold value, the initial position information of the tail end of the mechanical arm and the terminal position information of the tail end of the mechanical arm, planning a non-collision path of the tail end of the mechanical arm in a Cartesian space; judging whether the non-collision path planning of the tail end position of the mechanical arm is successful, if so, finishing the path planning; otherwise, performing secondary path planning. According to the method, the non-collision path planning is carried out aiming at the tail end position of the mechanical arm in the Cartesian space, a feasible path of the tail end of the mechanical arm is provided, a large number of invalid sampling points can be avoided, the calculated amount is reduced, then secondary path planning is carried out until the feasible paths are connected, and the whole path planning of the tail end of the mechanical arm is completed.
The foregoing is merely a detailed description of the invention, and it should be noted that modifications and adaptations by those skilled in the art may be made without departing from the principles of the invention, and should be considered as within the scope of the invention.

Claims (3)

1. A path planning method for an overhead line maintenance mechanical arm, the method comprising:
s1: acquiring obstacle information, an operation degree threshold value, initial position information of the tail end of the mechanical arm and terminal position information of the tail end of the mechanical arm;
s2: according to the obstacle information, the operation degree threshold value, the initial position information of the tail end of the mechanical arm and the terminal position information of the tail end of the mechanical arm, planning a non-collision path of the tail end of the mechanical arm in a Cartesian space;
the non-collision path planning of the tail end position of the mechanical arm in the Cartesian space according to the obstacle information, the operation degree threshold, the initial position information of the tail end of the mechanical arm and the end position information of the tail end of the mechanical arm comprises the following steps:
s21: planning a non-collision path from the initial position of the tail end of the mechanical arm to the end position in a Cartesian space according to the initial position information of the tail end of the mechanical arm and the end position information of the tail end of the mechanical arm to obtain a position point in the non-collision path;
s22: performing inverse kinematics solution on all the position points to obtain inverse solution values;
s3: judging whether the non-collision path planning of the tail end position of the mechanical arm is successful, if so, finishing the path planning; otherwise, performing secondary path planning;
judging whether the path planning is successful or not, if so, finishing the path planning; otherwise, the performing the secondary path planning includes:
judging whether all the inverse solution values exist and are greater than an operation degree threshold value, and finishing path planning if all the inverse solution values exist and are greater than the operation degree threshold value; otherwise, performing secondary path planning;
the secondary path planning comprises:
s31: deleting the position points without inverse solution values, and storing the deleted position points as a plurality of feasible path segments;
s32: acquiring end points of all feasible path sections, sequencing all the end points according to the direction from the initial position to the end position of the tail end of the mechanical arm, and constructing a position point sequence;
s33: constructing a plurality of sphere spaces by taking points positioned at odd number positions and points at the right end adjacent to even number positions in the position point sequence as diameter end points;
s34: randomly sampling a collision-free mechanical arm shape, performing positive kinematic solution to obtain a positive solution, judging whether the positive solution is positioned in a sphere space, if so, keeping and performing the next step, otherwise, re-sampling;
s35: acquiring a preset radius, and connecting all positive solutions in the same sphere space by taking the preset radius as a connecting range;
s36: judging whether all the points at the odd number position in the position point sequence are connected with the points at the right end adjacent to the even number position, and finishing path planning if the connection is successful; otherwise, the process goes to S34.
2. A path planning method for an overhead line service robot as claimed in claim 1, wherein in connecting all positive solutions located in the same sphere space, the positive solutions of the two sampled collision-free robot arms that are connected are located in the same sphere space.
3. A path planning method for an overhead line servicing robot as claimed in claim 1, wherein the euclidean distance between the two positive solutions is less than a preset radius.
CN202010944366.XA 2020-09-10 2020-09-10 Path planning method for overhead line maintenance mechanical arm Active CN112060093B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010944366.XA CN112060093B (en) 2020-09-10 2020-09-10 Path planning method for overhead line maintenance mechanical arm

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010944366.XA CN112060093B (en) 2020-09-10 2020-09-10 Path planning method for overhead line maintenance mechanical arm

Publications (2)

Publication Number Publication Date
CN112060093A CN112060093A (en) 2020-12-11
CN112060093B true CN112060093B (en) 2022-08-02

Family

ID=73663402

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010944366.XA Active CN112060093B (en) 2020-09-10 2020-09-10 Path planning method for overhead line maintenance mechanical arm

Country Status (1)

Country Link
CN (1) CN112060093B (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8972057B1 (en) * 2013-01-09 2015-03-03 The Boeing Company Systems and methods for generating a robotic path plan in a confined configuration space
CN106737671A (en) * 2016-12-21 2017-05-31 西安科技大学 The bilayer personification motion planning method of seven degrees of freedom copy man mechanical arm
CN109567942A (en) * 2018-10-31 2019-04-05 上海盼研机器人科技有限公司 Using the craniomaxillofacial surgery robot assisted system of artificial intelligence technology
CN109605369A (en) * 2018-12-07 2019-04-12 英华达(上海)科技有限公司 Mechanical arm singular point control method and system
CN110228069A (en) * 2019-07-17 2019-09-13 东北大学 A kind of online avoidance motion planning method of mechanical arm

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004067232A2 (en) * 2003-01-31 2004-08-12 Thermo Crs Ltd. Syntactic inferential motion planning method for robotic systems
US9981389B2 (en) * 2014-03-03 2018-05-29 California Institute Of Technology Robotics platforms incorporating manipulators having common joint designs
CN110253570B (en) * 2019-05-27 2020-10-27 浙江工业大学 Vision-based man-machine safety system of industrial mechanical arm
CN110653805B (en) * 2019-10-10 2022-11-04 西安科技大学 Task constraint path planning method for seven-degree-of-freedom redundant manipulator in Cartesian space
CN111251297B (en) * 2020-02-20 2023-02-07 西北工业大学 Double-arm space robot coordinated path planning method based on random sampling

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8972057B1 (en) * 2013-01-09 2015-03-03 The Boeing Company Systems and methods for generating a robotic path plan in a confined configuration space
CN106737671A (en) * 2016-12-21 2017-05-31 西安科技大学 The bilayer personification motion planning method of seven degrees of freedom copy man mechanical arm
CN109567942A (en) * 2018-10-31 2019-04-05 上海盼研机器人科技有限公司 Using the craniomaxillofacial surgery robot assisted system of artificial intelligence technology
CN109605369A (en) * 2018-12-07 2019-04-12 英华达(上海)科技有限公司 Mechanical arm singular point control method and system
CN110228069A (en) * 2019-07-17 2019-09-13 东北大学 A kind of online avoidance motion planning method of mechanical arm

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
冗余机械臂动态避障规划;谢龙;《中国优秀硕士论文全文 信息科技辑》;20180815;全文 *

Also Published As

Publication number Publication date
CN112060093A (en) 2020-12-11

Similar Documents

Publication Publication Date Title
CN111300425B (en) Super-redundant mechanical arm tail end track motion planning method
CN111923039B (en) Redundant mechanical arm path planning method based on reinforcement learning
CN112861361B (en) Working space simulation method based on drill jumbo
CN111761582B (en) Mobile mechanical arm obstacle avoidance planning method based on random sampling
CN105415372A (en) Multi-joint robot track planning method under constraint of safety space
CN113325799B (en) Spot welding robot operation space smooth path planning method for curved surface workpiece
CN111546378B (en) Rapid collision detection method for space manipulator
CN112060093B (en) Path planning method for overhead line maintenance mechanical arm
CN113211447B (en) Mechanical arm real-time perception planning method and system based on bidirectional RRT algorithm
CN113352289A (en) Mechanical arm track planning control system of overhead ground wire hanging and dismounting operation vehicle
CN114589701B (en) Damping least square-based multi-joint mechanical arm obstacle avoidance inverse kinematics method
CN113771035A (en) Redundant multi-degree-of-freedom mechanical arm obstacle avoidance path optimization method based on RRT (recursive least squares) algorithm
Tam et al. An improved genetic algorithm based robot path planning method without collision in confined workspace
CN112008729A (en) Collision detection method for overhead line maintenance mechanical arm
CN113752265B (en) Method, system and device for planning obstacle avoidance path of mechanical arm
CN116442211A (en) Mechanical arm control method and device and terminal equipment
CN114290332A (en) Serial mechanical arm path planning method and system applied to GIS pipeline detection
Jiang et al. Autonomous behavior intelligence control of self-evolution mobile robot for high-voltage transmission line in complex smart grid
Xue et al. Kinematics and control of a cable-driven snake-like manipulator for underwater application
CN117102725B (en) Welding method and system for steel-concrete combined structure connecting piece
Zhang et al. A RRT-A* Path Planning Algorithm for Cable-Driven Manipulators
CN115946118B (en) Method, medium and system for simultaneously cooperating multiple robots with one external tool
CN116021516A (en) Fault-tolerant control method for mechanical arm with multiple degrees of freedom
CN114770506B (en) Motion control method for hot-line work eight-degree-of-freedom mechanical arm
CN113276108B (en) Four-axis mechanical arm control method for capturing explosives

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant