CN113282077B - Concentric tube robot motion planning method based on normal distribution and Jacobian matrix - Google Patents
Concentric tube robot motion planning method based on normal distribution and Jacobian matrix Download PDFInfo
- Publication number
- CN113282077B CN113282077B CN202110374981.6A CN202110374981A CN113282077B CN 113282077 B CN113282077 B CN 113282077B CN 202110374981 A CN202110374981 A CN 202110374981A CN 113282077 B CN113282077 B CN 113282077B
- Authority
- CN
- China
- Prior art keywords
- concentric tube
- path
- robot
- point
- new
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 239000011159 matrix material Substances 0.000 title claims abstract description 14
- 210000003484 anatomy Anatomy 0.000 claims abstract description 6
- 238000001514 detection method Methods 0.000 claims description 16
- 238000012502 risk assessment Methods 0.000 claims description 8
- 230000004888 barrier function Effects 0.000 claims description 5
- 238000011161 development Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 229910001000 nickel titanium Inorganic materials 0.000 description 1
- 239000002994 raw material Substances 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000001356 surgical procedure Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
A concentric tube robot motion planning method based on normal distribution RRT and Jacobian matrix calculates and draws a working space of the concentric tube robot according to parameters of the concentric tube robot and a positive kinematics model; generating a surgical work environment point cloud according to the anatomical structure; generating an optimal working path of the concentric tube robot by using a normal distribution RRT algorithm; and calculating the driving space input quantity corresponding to each point on the path by using inverse kinematics based on Jacobian, and calculating the input quantity q corresponding to each path point more quickly by using the input quantity as an integral initial value of the current step. Compared with the prior art, the invention can generate an optimal path which meets the shape requirements of an operation and a concentric tube in a shorter time.
Description
Technical Field
The invention relates to the field of surgical robots, in particular to a motion planning method for a concentric tube robot based on normal distribution RRT and a Jacobian matrix.
Background
In recent years, with the steady development of the medical level, various robots capable of playing a key role in surgery have been produced. The ability of a continuous robot of the concentric tube type to flex flexibly and follow a preoperatively planned nonlinear path to a specified focal point begins to receive widespread attention as compared to typical rigid instruments. However, the joint freedom of such a robot tends to be infinite, and its shape in free space is very complicated, resulting in a significant increase in the complexity of its motion planning.
The modeling design of the concentric tube is mostly established on the assumption that the constant curvature and rigidity of the segment dominate, and the information such as shear strain and friction which is difficult to quantify is ignored. On the basis, a concentric tube positive kinematics model established by using a statics balance method and an energy minimum principle can achieve higher precision, and in the aspect of path planning, a sampling path planning algorithm which is generally suitable for a high-dimensional space is widely concerned by people, such as PRM and RRT.
There are still a number of problems that prevent further development of concentric tube robotic systems: the nickel-titanium alloy tube which is the raw material of the concentric tube is difficult to process, and can age and deform along with the lapse of time, so that the ideal assumption requirement of a kinematic model and the high-precision requirement of an operation cannot be met.
Disclosure of Invention
In order to overcome the defects of the prior art and improve the overall operation capacity of a concentric tube system to a certain extent, the invention provides a concentric tube robot motion planning method based on normal distribution RRT and Jacobian matrix, which can improve the working efficiency of a robot in a complex operation environment.
The technical scheme adopted by the invention is as follows:
a concentric tube robot motion planning method based on normal distribution RRT and Jacobian matrix comprises the following steps:
1) for a concentric tube robot with known geometric parameters and mechanical parameters, the positive kinematics solution of the concentric tube robot is pre-calculated, the working space of the robot is drawn, and a data table with one-to-one correspondence of drive input and terminal poses is established
2) Generating point cloud of surgical anatomical structure by endoscope system mounted at end of concentric tube robot, wrapping points whose distance is less than section diameter d of concentric tube with a minimum sphere, and setting radius of i-th barrier as Ri;
3) And (3) performing path planning of the concentric tube robot by using a normally distributed RRT algorithm: from data sheetSelecting a location x that is near a focal point and not within an obstacletargetAccording to the corresponding input, drawing the overall Shape of the robot in the working space by using a positive kinematics model, wherein the point set corresponding to the Shape is S0, and because the modeling of the concentric tube meets the assumption that the rigidity is dominant, if any point in S0 is not in an obstacle, the optimal working path of the concentric tube in the surgical environment is S0; if there is a section of the pathIf the section is cut off by the ith barrier, a new path planning needs to be carried out on the section;
4) according to the step 3), the optimal path planning of the obstacle segment is realized, a path S2 is obtained, and the optimal path S of the concentric tube robot in the working space is obtained, namely S0-S1+ S2.
5) In order to enable the robot to reach the focus point along the path S, the robot driving input quantity q corresponding to each point x on the path is calculated step by using inverse kinematics based on a Jacobian matrix J;
6) and (5) using the input quantity calculated in the step 5) as an initial integral value of the current step, and calculating the input quantity q corresponding to each path point more quickly.
Further, the process of step 3) is as follows:
3.1) first, the desired planned starting position x is set according to S1initTarget position xgoalIteration number n, step length p and collision risk assessment index: dis (x)i0,x1)≥Ri+λr0Wherein r is0Is the section radius of the concentric tube robot, lambda is a safety constant, the larger lambda represents the higher safety requirement, xi0Is the center position coordinate, x, of the ith obstacle1Position coordinates of any node in the working space;
3.2) based on normal random distribution in free spaceTo generate a point xrandAnd the mean μ of the normal distribution is close to the target position xgoalThe standard deviation σ is 10;
3.3) find x in search Tree TrandNearest node xnearestAnd along xnearestPoint of direction xrandIn the direction of (1), a new node x is generated in step size pnew;
3.4) by xnewIs a center riTo search for the radius, find all potential parent nodes x in the search tree TppTo update xnew. First, all potential parent nodes x foundppPerforming collision risk assessment, eliminating nodes which do not accord with risk indexes, and finally forming a potential father node set Epp;
3.5) first disregarding the collision detection, EppEach point in (1) is respectively used as a parent node and xnewConnected, calculate from xinitTo xnewIf the path length is smaller than the original path length, collision detection is performed. If the detection fails, considering the next potential father node; if the detection is passed, deleting redundant edges in the search tree T, and taking the node as a new father node;
3.6) traversing all potential father nodes to obtain the updated tree T;
3.7) the steps 3.2) to 3.6) are one iteration of searching the optimal path based on the normal distribution RRT, and when the maximum iteration number n is reached, an asymptotically optimal path is found.
The technical conception of the invention is as follows: the method comprises the steps of firstly pre-calculating a working space of a designed concentric tube robot according to the concentric tube robot, then generating a three-dimensional point cloud of a robot motion space according to an anatomical structure, determining an initial position and a target position of path planning, planning an optimal path according with risk assessment requirements by using a normal distribution-based RRT method, and finally calculating driving input corresponding to each point on the path by using Jacobian-based inverse kinematics.
The invention has the beneficial effects that: through the scheme, the concentric tube robot working path which accords with a specific anatomical structure can be designed.
Drawings
FIG. 1 is a flow chart of a concentric tube robot motion planning method based on normally distributed RRT and Jacobian matrix;
FIG. 2 is a schematic workspace of a concentric tube robot;
fig. 3 is a schematic diagram of a path result obtained by the obstacle avoidance algorithm of the present invention, which is used for the following analysis.
Detailed Description
The invention is further described below with reference to the accompanying drawings.
Referring to fig. 1 and 2, a method for planning the movement of a concentric tube robot based on normally distributed RRT and jacobian matrices includes the following steps:
1) for a concentric tube robot with known geometric parameters and mechanical parameters, the positive kinematics solution of the concentric tube robot is pre-calculated, the working space of the robot is drawn (as shown in figure 2), and a data table with one-to-one correspondence of driving input and end pose is established
2) Generating a point cloud of an operative anatomical structure by an endoscope system arranged at the tail end of a concentric tube robot, wrapping points with a minimum sphere, wherein the distance between the points is less than the diameter d of the section of the concentric tube, and setting the radius of the ith obstacle to be Ri;
3) Path planning of the concentric tube robot was performed using normal distribution based RRT algorithm: from data sheetSelecting a location x that is near a focal point and not within an obstacletargetAccording to the corresponding input, the overall Shape of the robot in the working space is drawn by using a positive kinematics model, the point set corresponding to the Shape is S0, and because the modeling of the concentric tube meets the assumption that the rigidity is dominant, if any point in S0 is not in the obstacle, the optimal working path of the concentric tube in the operation environment is S0; if present, isA section of pathIf the ith obstacle is intercepted, a new path planning needs to be performed on the segment, and the process is as follows:
3.1) first, the desired planned starting position x is set according to S1initTarget position xgoalIteration number n, step length p and collision risk assessment index: dis (x)i0,x1)≥Ri+λr0Wherein r is0Is the section radius of the concentric tube robot, lambda is a safety constant, the larger lambda represents the higher safety requirement, xi0Is the center position coordinate, x, of the ith obstacle1Position coordinates of any node in the working space;
3.2) generating a point x in free space based on a normal random distributionrandAnd the mean μ of the normal distribution is close to the target position xgoalThe standard deviation σ is 10;
3.3) find x in search Tree TrandNearest node xnearestAnd along xnearestPoint of direction xrandIn the direction of (1), a new node x is generated in step size pnew;
3.4) by xnewIs a center riTo search for the radius, find all potential parent nodes x in the search tree TppTo update xnew. First, all potential parent nodes x foundppPerforming collision risk evaluation, removing nodes which do not accord with risk indexes, and finally forming a potential father node set;
3.5) first disregarding the collision detection, EppEach point in (1) is respectively used as a parent node and xnewConnected, calculate from xinitTo xnewIf the path length is smaller than the original path length, collision detection is performed. If the detection fails, considering the next potential father node; if the detection is passed, deleting redundant edges in the search tree T, and taking the node as a new father node;
3.6) traversing all potential father nodes to obtain the updated tree T;
3.7) the steps 3.2) to 3.6) are one iteration of searching the optimal path based on the normal distribution RRT, and when the maximum iteration number n is reached, an asymptotically optimal path is found.
4) According to the step 3), the optimal path planning of the obstacle segment is realized, a path S2 is obtained, and then the optimal path S of the concentric tube robot in the working space is obtained, which is S0-S1+ S2, as shown in fig. 3;
5) in order to enable the robot to reach the focus point along the path S, the robot driving input quantity q corresponding to each point x on the path is calculated step by using the inverse kinematics based on the Jacobian matrix J,
6) and (5) using the input quantity calculated in the step 5) as an initial integral value of the current step, and calculating the input quantity q corresponding to each path point more quickly.
In this embodiment, a real anatomical point cloud generated by an endoscope is used as a surgical working environment, and surgical environment reconstruction with the same proportion is performed in MATLAB to perform path planning simulation of a concentric tube robot, and a method for planning motion of a concentric tube robot based on normally distributed RRT and jacobian matrix includes the following steps:
1) for the concentric tube robot with known geometric parameters and mechanical parameters, calculating the positive kinematic solution of the concentric tube robot in MATLAB, drawing a working space, and establishing a data table with one-to-one correspondence of drive inputs and terminal poses
2) Performing three-dimensional reconstruction of the same surgical environment in MATLAB;
3) path planning of the concentric tube robot was performed using normal distribution based RRT algorithm: from data sheetSelecting a site near the focal pointAnd not at position x within the obstacletargetAccording to the corresponding input, the overall Shape of the robot in the working space is drawn by using a positive kinematics model, the point set corresponding to the Shape is S0, and because the modeling of the concentric tube meets the assumption that the rigidity is dominant, if any point in S0 is not in the obstacle, the optimal working path of the concentric tube in the operation environment is S0; if there is a pathIf the section is cut off by the ith barrier, a new path planning needs to be carried out on the section;
3.1) first, the desired planned starting position x is set according to S1initTarget position xgoalIteration number n, step length p and collision risk assessment index: dis (x)i0,x1)≥Ri+λr0Wherein r is0Is the section radius of the concentric tube robot, lambda is a safety constant, the larger lambda represents the higher safety requirement, xi0Is the center position coordinate, x, of the ith obstacle1Position coordinates of any node in the working space;
3.2) the invention generates a point x in free space based on normal random distributionrandAnd the mean value μ of the normal distribution is close to the target position xgoalThe standard deviation σ is 10;
3.3) find x in search Tree TrandNearest node xnearestAnd along xnearestPoint of direction xrandIn the direction of (c), a new node x is generated in step pnew;
3.4) by xnewIs a center, riTo search for the radius, find all potential parent nodes x in the search tree TppTo update xnew. First, all potential parent nodes x foundppPerforming collision risk assessment, eliminating nodes which do not accord with risk indexes, and finally forming a potential father node set Epp;
3.5) first disregarding the collision detection, EppEach point in (1) as a parent node and x respectivelynewConnect and calculateFrom xinitTo xnewIf the path length is smaller than the original path length, collision detection is performed. If the detection fails, considering the next potential father node; if the detection is passed, deleting redundant edges in the search tree T, and taking the node as a new father node;
3.6) traversing all potential father nodes to obtain the updated tree T;
3.7) the steps 3.2) to 3.6) are one iteration of searching the optimal path based on the normal distribution RRT, and when the maximum iteration number n is reached, an asymptotically optimal path is found;
4) according to the step 3, the optimal path planning of the obstacle segment is realized, a path S2 is obtained, and the optimal path S of the concentric tube robot in the working space is obtained, namely S0-S1+ S2;
5) in order to enable the robot to reach the focus point along the path S, the invention uses inverse kinematics based on the Jacobian matrix J to gradually calculate the robot driving input quantity q corresponding to each point x on the path,
6) and (5) using the input quantity calculated in the step 5) as an initial integral value of the current step, and calculating the input quantity q corresponding to each path point more quickly.
By taking MATLAB R2018b simulation software as an embodiment, the concentric tube robot working path based on the normal distribution RRT algorithm can be obtained in a short time by using the method, and the shape of the concentric tube in the working space can be kept to the maximum extent on the premise of avoiding obstacles.
While the foregoing has described the invention in terms of a preferred embodiment, it will be appreciated that the invention is not limited to the embodiment described, but is capable of modification without departing from the spirit and scope of the invention as defined by the appended claims.
Claims (2)
1. A concentric tube robot motion planning method based on normal distribution and a Jacobian matrix is characterized by comprising the following steps:
1) for a concentric tube robot with known geometric parameters and mechanical parameters, the positive kinematics solution of the concentric tube robot is pre-calculated, the working space of the robot is drawn, and a data table with one-to-one correspondence of drive input and terminal poses is established
2) Generating point cloud of surgical anatomical structure by endoscope system mounted at end of concentric tube robot, wrapping points whose distance is less than section diameter d of concentric tube with a minimum sphere, and setting radius of i-th barrier as Ri;
3) Path planning of the concentric tube robot was performed using normal distribution based RRT algorithm: from data sheetSelecting a location x that is near a focal point and not within an obstacletargetAccording to the corresponding input, the overall Shape of the robot in the working space is drawn by using a positive kinematics model, the point set corresponding to the Shape is S0, and because the modeling of the concentric tube meets the assumption that the rigidity is dominant, if any point in S0 is not in the obstacle, the optimal working path of the concentric tube in the surgical environment is S0; if there is a pathIf the section is cut off by the ith barrier, a new path planning needs to be carried out on the section;
4) realizing the optimal path planning of the obstacle segment according to the step 3), obtaining a path S2, and further obtaining an optimal path S (S0-S1 + S2) of the concentric tube robot in the working space;
5) in order to enable the robot to reach the focus point along the path S, the robot driving input quantity q corresponding to each point x on the path is calculated step by using inverse kinematics based on a Jacobian matrix J;
6) and (5) using the input quantity calculated in the step 5) as an initial integral value of the current step, and calculating the input quantity q corresponding to each path point more quickly.
2. The method for concentric tube robot motion planning based on normal distribution and Jacobian matrix as claimed in claim 1, wherein the process of step 3) is as follows:
3.1) first, the desired planned starting position x is set according to S1initTarget position xgoalIteration number n, step length p and collision risk assessment index: dis (x)i0,x1)≥Ri+λr0Wherein r is0Is the section radius of the concentric tube robot, lambda is a safety constant, the larger lambda represents the higher safety requirement, xi0Is the center position coordinate, x, of the ith obstacle1Position coordinates of any node in the working space;
3.2) generating a point x in free space based on a normal random distributionrandAnd the mean μ of the normal distribution is close to the target position xgoalThe standard deviation σ is 10;
3.3) find x in search Tree TrandNearest node xnearestAnd along xnearestPoint of direction xrandIn the direction of (1), a new node x is generated in step size pnew;
3.4) by xnewIs a center, riTo search for the radius, find all potential parent nodes x in the search tree TppTo update xnewFirst, all potential parent nodes x found are searchedppPerforming collision risk assessment, eliminating nodes which do not accord with risk indexes, and finally forming a potential father node set Epp;
3.5) first disregarding the collision detection, EppEach point in (1) is respectively madeIs a parent node and xnewConnected, calculate from xinitTo xnewIf the path length is smaller than the original path length, performing collision detection; if the detection fails, considering the next potential father node; if the detection is passed, deleting redundant edges in the search tree T, and taking the node as a new father node;
3.6) traversing all potential father nodes to obtain the updated tree T;
3.7) the steps 3.2) to 3.6) are one iteration of searching the optimal path based on the normal distribution RRT, and when the maximum iteration number n is reached, an asymptotically optimal path is found.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110374981.6A CN113282077B (en) | 2021-04-08 | 2021-04-08 | Concentric tube robot motion planning method based on normal distribution and Jacobian matrix |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110374981.6A CN113282077B (en) | 2021-04-08 | 2021-04-08 | Concentric tube robot motion planning method based on normal distribution and Jacobian matrix |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113282077A CN113282077A (en) | 2021-08-20 |
CN113282077B true CN113282077B (en) | 2022-06-17 |
Family
ID=77276400
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110374981.6A Active CN113282077B (en) | 2021-04-08 | 2021-04-08 | Concentric tube robot motion planning method based on normal distribution and Jacobian matrix |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113282077B (en) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101282693A (en) * | 2005-10-11 | 2008-10-08 | 皇家飞利浦电子股份有限公司 | 3d tool path planning, simulation and control system |
CN106695802A (en) * | 2017-03-19 | 2017-05-24 | 北京工业大学 | Improved RRT<*> obstacle avoidance motion planning method based on multi-degree-of-freedom mechanical arm |
CN108685560A (en) * | 2017-04-12 | 2018-10-23 | 香港生物医学工程有限公司 | Automation steering and method for robotic endoscope |
CN108983780A (en) * | 2018-07-24 | 2018-12-11 | 武汉理工大学 | One kind is based on improvement RRT*The method for planning path for mobile robot of algorithm |
CN109434838A (en) * | 2018-12-25 | 2019-03-08 | 北方工业大学 | Coordinated motion planning method and system for endoscopic operation of line-driven continuous robot |
CN110497403A (en) * | 2019-08-05 | 2019-11-26 | 上海大学 | A kind of manipulator motion planning method improving two-way RRT algorithm |
CN110703768A (en) * | 2019-11-08 | 2020-01-17 | 福州大学 | Improved dynamic RRT mobile robot motion planning method |
CN111752281A (en) * | 2020-07-13 | 2020-10-09 | 浪潮软件股份有限公司 | Mobile robot path planning method and system based on improved RRT algorithm |
-
2021
- 2021-04-08 CN CN202110374981.6A patent/CN113282077B/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101282693A (en) * | 2005-10-11 | 2008-10-08 | 皇家飞利浦电子股份有限公司 | 3d tool path planning, simulation and control system |
CN106695802A (en) * | 2017-03-19 | 2017-05-24 | 北京工业大学 | Improved RRT<*> obstacle avoidance motion planning method based on multi-degree-of-freedom mechanical arm |
CN108685560A (en) * | 2017-04-12 | 2018-10-23 | 香港生物医学工程有限公司 | Automation steering and method for robotic endoscope |
CN108983780A (en) * | 2018-07-24 | 2018-12-11 | 武汉理工大学 | One kind is based on improvement RRT*The method for planning path for mobile robot of algorithm |
CN109434838A (en) * | 2018-12-25 | 2019-03-08 | 北方工业大学 | Coordinated motion planning method and system for endoscopic operation of line-driven continuous robot |
CN110497403A (en) * | 2019-08-05 | 2019-11-26 | 上海大学 | A kind of manipulator motion planning method improving two-way RRT algorithm |
CN110703768A (en) * | 2019-11-08 | 2020-01-17 | 福州大学 | Improved dynamic RRT mobile robot motion planning method |
CN111752281A (en) * | 2020-07-13 | 2020-10-09 | 浪潮软件股份有限公司 | Mobile robot path planning method and system based on improved RRT algorithm |
Non-Patent Citations (2)
Title |
---|
RRT-smooth Algorithm Applied to Motion Planning of Concentric Tube Robots;Di Zhang etc;《PROCEEDING OF THE IEEE INTERNATIONAL CONFERENCE ON INFORMATION AND AUTOMATION》;20181231;全文 * |
Task-oriented design of concentric tube robots using mechanics-based models;Luis G.Torres etc;《2012 IEEE/RSJ INTERNATIONAL CONFERENCE ON INTELLIGENT ROBOTS AND SYSTEMS》;20121231;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113282077A (en) | 2021-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9411335B2 (en) | Method and apparatus to plan motion path of robot | |
CN113103236B (en) | Rapid and gradual optimal mechanical arm obstacle avoidance path planning method | |
CN111761582B (en) | Mobile mechanical arm obstacle avoidance planning method based on random sampling | |
US11292132B2 (en) | Robot path planning method with static and dynamic collision avoidance in an uncertain environment | |
US20110035051A1 (en) | Path planning apparatus and method for robot | |
CN109343345A (en) | Mechanical arm polynomial interopolation method for planning track based on QPSO algorithm | |
CN115469576B (en) | Teleoperation system based on human-mechanical arm heterogeneous motion space hybrid mapping | |
CN109344477B (en) | 6-degree-of-freedom mechanical arm inverse kinematics solving method | |
CN107685343A (en) | A kind of Mechanical transmission test parameter calibration configuration optimization method | |
Sadiq et al. | Robot arm path planning using modified particle swarm optimization based on D* algorithm | |
JP2008204161A (en) | Path preparation device | |
CN113282077B (en) | Concentric tube robot motion planning method based on normal distribution and Jacobian matrix | |
Funke et al. | Design of planar multi-degree-of-freedom morphing mechanisms | |
Li et al. | Stiffness-maximum trajectory planning of a hybrid kinematic-redundant robot machine | |
Sun et al. | Hybrid task constrained planner for robot manipulator in confined environment | |
Zhu et al. | Online motion generation using accumulated swept volumes | |
Qian et al. | Path planning approach for redundant manipulator based on Jacobian pseudoinverse-RRT algorithm | |
Kubota et al. | Trajectory planning of reconfigurable redundant manipulator using virus-evolutionary genetic algorithm | |
CN114536351A (en) | Redundant double-arm robot teaching method and device, electronic equipment and system | |
Adhami et al. | Positioning tele-operated surgical robots for collision-free optimal operation | |
Wu et al. | Development of a configuration space motion planner for robot in dynamic environment | |
Boutchouang et al. | Analytical Approach to Inverse Kinematics of Single Section Mobile Continuum Manipulators | |
Guo et al. | Path planning of the spherical robot based on improved ant colony algorithm | |
Xie et al. | A training-evaluation method for nursing telerobot operator with unsupervised trajectory segmentation | |
Zhang et al. | Path planning of a 5-dof robotic arm based on BiRRT-APF algorithm considering obstacle avoidance |
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 |