CN112549016A - Mechanical arm motion planning method - Google Patents
Mechanical arm motion planning method Download PDFInfo
- Publication number
- CN112549016A CN112549016A CN202011132260.6A CN202011132260A CN112549016A CN 112549016 A CN112549016 A CN 112549016A CN 202011132260 A CN202011132260 A CN 202011132260A CN 112549016 A CN112549016 A CN 112549016A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- obstacle
- path
- point
- planning
- 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.)
- Pending
Links
- 230000033001 locomotion Effects 0.000 title claims abstract description 33
- 238000000034 method Methods 0.000 title claims abstract description 29
- 238000005457 optimization Methods 0.000 claims abstract description 10
- 238000009499 grossing Methods 0.000 claims abstract description 9
- 238000004088 simulation Methods 0.000 claims abstract description 8
- 238000012545 processing Methods 0.000 claims abstract description 4
- 238000005070 sampling Methods 0.000 claims description 7
- 230000004888 barrier function Effects 0.000 claims description 6
- 238000001514 detection method Methods 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 5
- 230000001133 acceleration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000003780 insertion Methods 0.000 description 1
- 230000037431 insertion Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
The invention discloses a mechanical arm movement planning method, which is implemented according to the following steps: step 1, performing obstacle modeling by using a common space rule object to approximate an envelope obstacle; step 2, giving an initial position and a target position of the mechanical arm, and obtaining an inverse solution of the target position by an inverse kinematics method; step 3, calculating a track through a p-rrt algorithm; step 4, importing a seven-degree-of-freedom mechanical arm model, giving a target position of the mechanical arm, and obtaining an inverse solution of the target position through inverse kinematics; taking the path node of the obtained track as input and carrying out smooth optimization processing on the path by using a B spline curve; and 5, carrying out a simulation experiment in Matlab, adding simulation comparison after B spline curve optimization, comparing path curves before and after smoothing, verifying effectiveness, finishing arm motion planning, and solving the problem of poor smoothness of a planned path in the prior art.
Description
Technical Field
The invention belongs to the technical field of mechanical arm motion planning, and relates to a mechanical arm motion planning method.
Background
The motion planning problem of the robot is an important problem in the robot research field, and mainly comprises path planning and track planning (time), wherein a sequence point or a curve connecting a starting point position and a target point position is called a path, and a strategy of the path, namely the path planning, is formed.
Path planning is to find a series of path points to be traversed, path points being positions in space or joint angles, and trajectory planning is to give the path time information. Motion planning is the insertion of a sequence of intermediate points for control between given path end points to achieve smooth motion along a given path. And (3) adding time sequence information into the path planning in the track planning, and planning the speed and the acceleration of the robot when the robot executes a task so as to meet the requirements of smoothness, speed controllability and the like.
By adopting a rapid expanding Random Tree (rapid expanding Random Tree) path planning algorithm and performing collision detection on sampling points in a state space, the modeling of the space is avoided, and the problem of motion planning of the mechanical arm in a high-dimensional space and a complex environment can be effectively solved. However, the traditional RRT algorithm has poor guidance, and when the planning space is increased, the planned path has poor smoothness and the algorithm has high time complexity.
Disclosure of Invention
The invention aims to provide a mechanical arm motion planning method, which solves the problem of poor smoothness of a planned path in the prior art.
The technical scheme adopted by the invention is that a mechanical arm motion planning method is implemented according to the following steps:
step 1, performing obstacle modeling by using a common space rule object to approximate an envelope obstacle;
step 2, by using the model established in the step 1, giving an initial position and a target position of the mechanical arm, and obtaining an inverse solution of the target position by an inverse kinematics method;
step 3, calculating a track by using the inverse solution value obtained in the step 2 through a p-rrt algorithm;
step 4, importing a seven-degree-of-freedom mechanical arm model, giving a target position of the mechanical arm, and obtaining an inverse solution of the target position through inverse kinematics; taking the path node of the track obtained in the step 3 as input and carrying out smooth optimization processing on the path by using a B spline curve;
and 5, obtaining a path curve of the mechanical arm after smoothing according to the step 4, performing a simulation experiment in Matlab on the premise of ensuring that the mechanical arm does not collide with the obstacle, adding simulation comparison after B spline curve optimization into P, comparing the path curve before and after smoothing, verifying effectiveness, and finishing mechanical arm motion planning.
The invention is also characterized in that:
step 1 is specifically carried out as follows: acquiring the size and position information of the barrier, and setting a collision detection scheme; in order to avoid collision between each connecting rod of the mechanical arm and the obstacle, after the obstacle is enveloped into a sphere, the spatial position relation between the spherical obstacle and the connecting rod of the mechanical arm needs to be calculated, if the distance between the connecting rod of the mechanical arm and the circle center of the spherical obstacle is smaller than the sum of the radii, namely the intersection part of the connecting rod of the mechanical arm and the obstacle exists, collision can occur, and the other situations show that collision cannot occur.
Step 3 is specifically implemented according to the following steps:
step 3.1, random sampling is carried out in a map environment and a sampling point x is determinedrandFind the distance xrandNearest node xnear;
Step 3.2, determining a random point boundary and selecting whether the growth direction of the tree is towards a target point direction or a random direction according to the value of the probability function P; the probability set here is that there is a 0.5 probability straight going;
step 3.3, along xnearTo xrandThe distance of the step is advanced to obtain xnew;
Step 3.4, collisionFree (M, E) is adoptedi) Method for detecting Edge (x)new,xnear) Whether collision exists between the map and a barrier in the map environment or not can be judged, and if no collision exists, one-time successful space expansion search can be completed;
step 3.5, calculate the new point xnewIf the distance between the target point and the end point is smaller than the target point threshold value, finishing the tracing and generating a track;
in step 3, the map environment is initialized and a starting point x is determinedinitAnd target point xgoalAnd setting a target point threshold, and when the target point threshold is reached, the target point threshold is considered to be reached, wherein the threshold is set as follows: thr ═ 0.03.
Step 4 is specifically implemented according to the following steps:
step 4.1, the track obtained in step 3 is optimized by adopting three times of non-uniform B-spline interpolation:
k non-uniform B-spline curve definitions:
wherein d isiN is a control point, and the control points are sequentially connected to form a B spline control polygon, and N is a control pointi,k(U) is a k-th order canonical B-spline basis function defined on the non-uniform node vector U; and is provided with
N when K is 0i,k(u) if the degree is zero (i.e., K is 0), then the basis functions are all step functions, if in the ith node interval [ u ═ 0 ]i,ui+1]N of the above, then basis functioni,0(u)=1;
Wherein k is an even number of times:
path point q obtained based on P-RRTiObtaining a control point d by inverse solution of the non-uniform B-splineiAnd then generating a smooth track through the control points, completing the track optimization obtained in the step 3, and completing the motion planning of the mechanical arm.
The invention has the beneficial effects that: the invention relates to a mechanical arm motion planning method, which plans an obstacle avoidance path from an initial position to a target position by using a probability P-based RRT algorithm (P-RRT) in an obstacle environment and uses a B-spline curve for smoothing. Based on the traditional RRT algorithm, in each growth process of random numbers, whether the growth direction is a target point or a random point is selected according to the probability (a random value p of 0.0 to 1.0). The main improvement of the algorithm is that a Chose Target function is added in the extended function. This function is not all used as the extension direction, but a probability P is chosen for extension, with a probability choice of 1-P for extension; the convergence speed is accelerated; in addition, the invention adopts a local RRT algorithm, thereby avoiding the defects that the global RRT wastes time and is easy to generate singular solution or interference solution. And the B-spline is used for smoothing the path on the planned path, so that a smooth obstacle avoidance path is generated, and the robot is ensured to execute the planned path in a good state.
Drawings
Fig. 1 is a flowchart of the method for planning the motion of the robot arm according to the present invention, which combines the improved RRT algorithm with the B-spline.
Fig. 2 is a schematic diagram of a spherical envelope surface of an obstacle for describing the obstacle in the method for planning the motion of the mechanical arm according to the present invention.
Fig. 3 is a schematic diagram of a position relationship between an obstacle and a link in the method for planning the movement of the robot arm according to the present invention.
FIG. 4 is a schematic diagram of a search process of a P-RRT algorithm in a three-dimensional space according to the mechanical arm motion planning method.
FIG. 5 is a comparison diagram of paths before and after a B-spline function is added to a path planned by a manipulator model of the manipulator motion planning method according to the invention along a P-RRT for smoothing.
Detailed Description
The present invention will be described in detail below with reference to the accompanying drawings and specific embodiments.
The invention relates to a mechanical arm motion planning method, which is implemented according to the following steps as shown in figure 1:
step 1, performing obstacle modeling by using a common space rule object to approximate an envelope obstacle; as shown in figure 2 of the drawings, in which,
step 1 is specifically carried out as follows: acquiring the size and position information of the barrier, and setting a collision detection scheme; in order to avoid collision between each connecting rod of the mechanical arm and the obstacle, after the obstacle is enveloped into a sphere, the spatial position relationship between the spherical obstacle and the connecting rod of the mechanical arm needs to be calculated, as shown in fig. 3, if the distance between the connecting rod of the mechanical arm and the circle center of the spherical obstacle is smaller than the sum of the radii, namely the intersection part of the connecting rod of the mechanical arm and the obstacle, collision occurs, and the other situations indicate that collision does not occur.
Step 2, by using the model established in the step 1, giving an initial position and a target position of the mechanical arm, and obtaining an inverse solution of the target position by an inverse kinematics method;
and (3) solving the inverse function ikfine in the robot tool box (equivalent to a function pack), and solving the inverse solution of the mechanical arm according to the path points output in the third step by using the ikfine function.
Step 3, calculating a track by using the inverse solution value obtained in the step 2 through a p-rrt algorithm;
step 3 is specifically implemented according to the following steps:
initializing a map environment and determining a starting point xinitAnd target point xgoalAnd setting a target point threshold, and when the target point threshold is reached, the target point threshold is considered to be reached, wherein the threshold is set as follows:
Thr=0.03。
step 3.1, random sampling is carried out in a map environment and a sampling point x is determinedrandFind the distance xrandNearest node xnear;
Step 3.2, determining a random point boundary and selecting whether the growth direction of the tree is towards a target point direction or a random direction according to the value of the probability function P; the probability set here is that there is a 0.5 probability straight going;
step 3.3, along xnearTo xrandThe distance of the step is advanced to obtain xnew;
Step 3.4, collisionFree (M, E) is adoptedi) Method for detecting Edge (x)new,xnear) Whether collision exists between the map and a barrier in the map environment or not can be judged, and if no collision exists, one-time successful space expansion search can be completed;
step 3.5, calculate the new point xnewAnd if the distance from the end point is less than the target point threshold value, finishing the tracking and generating the track.
Probability P-based RRT path planning involved in step three
The pseudo code of the algorithm is as follows:
in the above code, M is a map environment, xinitIs the starting position, xgoalIs the target position and P is the probability function. The path space searching process starts from a starting point, firstly randomly scattering points xrand(ii) a Then find the distance xrandNearest node xnearAnd selecting the growing direction of the tree according to the value of the probability P; then along xnearTo xrandThe distance of the step is advanced to obtain xnew;collisionFree(M,Ei) Method for detecting Edge (x)new,xnear) Whether collision exists between the map and obstacles in the map environment or not can be judged, and if no collision exists, a successful space expansion search can be completed.
Step 4, importing a seven-degree-of-freedom mechanical arm model, giving a target position of the mechanical arm, and obtaining an inverse solution of the target position through inverse kinematics; taking the path node of the track obtained in the step 3 as input and carrying out smooth optimization processing on the path by using a B spline curve;
step 4 is specifically implemented according to the following steps:
step 4.1, the track obtained in step 3 is optimized by adopting three times of non-uniform B-spline interpolation:
k non-uniform B-spline curve definitions:
wherein d isiN is a control point, and the control points are sequentially connected to form a B spline control polygon, and N is a control pointi,k(U) is a k-th order canonical B-spline basis function defined on the non-uniform node vector U; and is provided with
N when K is 0i,k(u) if the degree is zero (i.e., K is 0), then the basis functions are all step functions, if in the ith node interval [ u ═ 0 ]i,ui+1]N of the above, then basis functioni,0(u)=1;
Wherein k is an even number of times:
path point q obtained based on P-RRTiFor non-uniform B-splinesInverse solution to obtain a control point diAnd then generating a smooth track through the control points, completing the track optimization obtained in the step 3, and completing the motion planning of the mechanical arm.
And 5, obtaining a path curve after the mechanical arm is smoothed according to the step 4, adding smooth path points as many as possible on the premise of ensuring that the mechanical arm does not collide with the obstacle during movement, so that the movement is more stable and effective, carrying out a simulation experiment in Matlab, searching a schematic diagram of a P-RRT in a three-dimensional space as shown in FIG. 4, adding a simulation pair optimized by a B-spline curve as shown in FIG. 5, comparing the path curves before and after smoothing, verifying the effectiveness, and finishing the movement planning of the mechanical arm.
Claims (5)
1. A mechanical arm motion planning method is characterized by being implemented according to the following steps:
step 1, performing obstacle modeling by using a common space rule object to approximate an envelope obstacle;
step 2, by using the model established in the step 1, giving an initial position and a target position of the mechanical arm, and obtaining an inverse solution of the target position by an inverse kinematics method;
step 3, calculating a track by using the inverse solution value obtained in the step 2 through a p-rrt algorithm;
step 4, importing a seven-degree-of-freedom mechanical arm model, giving a target position of the mechanical arm, and obtaining an inverse solution of the target position through inverse kinematics; taking the path node of the track obtained in the step 3 as input and carrying out smooth optimization processing on the path by using a B spline curve;
and 5, obtaining a path curve of the mechanical arm after smoothing according to the step 4, performing a simulation experiment in Matlab on the premise of ensuring that the mechanical arm does not collide with the obstacle during movement, adding simulation comparison after B spline curve optimization, comparing the path curve before and after smoothing, verifying effectiveness, and finishing mechanical arm movement planning.
2. The method for planning the motion of the robot arm according to claim 1, wherein the step 1 is specifically performed as follows: acquiring the size and position information of the barrier, and setting a collision detection scheme; in order to avoid collision between each connecting rod of the mechanical arm and the obstacle, after the obstacle is enveloped into a sphere, the spatial position relation between the spherical obstacle and the connecting rod of the mechanical arm needs to be calculated, if the distance between the connecting rod of the mechanical arm and the circle center of the spherical obstacle is smaller than the sum of the radii, namely the intersection part of the connecting rod of the mechanical arm and the obstacle exists, collision can occur, and the other situations show that collision cannot occur.
3. The method for planning the motion of the robot arm according to claim 1, wherein the step 3 is specifically performed according to the following steps:
step 3.1, random sampling is carried out in a map environment and a sampling point x is determinedrandFind the distance xrandNearest node xnear;
Step 3.2, determining a random point boundary and selecting whether the growth direction of the tree is towards a target point direction or a random direction according to the value of the probability function P; the probability set here is that there is a 0.5 probability straight going;
step 3.3, along xnearTo xrandThe distance of the step is advanced to obtain xnew;
Step 3.4, collisionFree (M, E) is adoptedi) Method for detecting Edge (x)new,xnear) Whether collision exists between the map and a barrier in the map environment or not can be judged, and if no collision exists, one-time successful space expansion search can be completed;
step 3.5, calculate the new point xnewAnd if the distance from the end point is less than the target point threshold value, finishing the tracking and generating the track.
4. A method for planning the movement of a robot arm according to claim 3, wherein in step 3, a map environment is initialized and a starting point x is determinedinitAnd target point xgoalAnd setting a target point threshold, and when the target point threshold is reached, the target point threshold is considered to be reached, wherein the threshold is set as follows:
Thr=0.03。
5. the method for planning the motion of the robot arm according to claim 1, wherein the step 4 is specifically performed according to the following steps:
step 4.1, the track obtained in step 3 is optimized by adopting three times of non-uniform B-spline interpolation:
k non-uniform B-spline curve definitions:
wherein d isiN is a control point, and the control points are sequentially connected to form a B spline control polygon, and N is a control pointi,k(U) is a k-th order canonical B-spline basis function defined on the non-uniform node vector U; and is provided with
N when K is 0i,k(u) if the degree is zero (i.e., K is 0), then the basis functions are all step functions, if in the ith node interval [ u ═ 0 ]i,ui+1]N of the above, then basis functioni,0(u)=1;
Wherein k is an even number of times:
path point q obtained based on P-RRTiObtaining a control point d by inverse solution of the non-uniform B-splineiAnd then generating a smooth track through the control points, completing the track optimization obtained in the step 3, and completing the motion planning of the mechanical arm.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011132260.6A CN112549016A (en) | 2020-10-21 | 2020-10-21 | Mechanical arm motion planning method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011132260.6A CN112549016A (en) | 2020-10-21 | 2020-10-21 | Mechanical arm motion planning method |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112549016A true CN112549016A (en) | 2021-03-26 |
Family
ID=75042552
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011132260.6A Pending CN112549016A (en) | 2020-10-21 | 2020-10-21 | Mechanical arm motion planning method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112549016A (en) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112947489A (en) * | 2021-04-08 | 2021-06-11 | 华东理工大学 | Method and device for planning collision-free path of welding robot in complex environment |
CN113084811A (en) * | 2021-04-12 | 2021-07-09 | 贵州大学 | Mechanical arm path planning method |
CN113246143A (en) * | 2021-06-25 | 2021-08-13 | 视比特(长沙)机器人科技有限公司 | Mechanical arm dynamic obstacle avoidance trajectory planning method and device |
CN113478495A (en) * | 2021-09-08 | 2021-10-08 | 南京蓝昊智能科技有限公司 | Multi-dimensional mechanical arm smooth path planning method |
CN113954073A (en) * | 2021-11-08 | 2022-01-21 | 北京华航唯实机器人科技股份有限公司 | Trajectory analysis method and device for movable part of robot and robot equipment |
CN114227672A (en) * | 2021-11-26 | 2022-03-25 | 北京工业大学 | Mechanical arm safety collision trajectory planning method and device, storage medium and equipment |
CN114310918A (en) * | 2022-03-14 | 2022-04-12 | 珞石(北京)科技有限公司 | Mechanical arm track generation and correction method under man-machine cooperation |
CN114952870A (en) * | 2022-07-29 | 2022-08-30 | 山东亚历山大智能科技有限公司 | Four-axis mechanical arm motion control method and system for high-frequency contact object disinfection |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010155328A (en) * | 2009-01-01 | 2010-07-15 | Sony Corp | Path planning device, path planning method, and computer program |
CN104407613A (en) * | 2014-10-20 | 2015-03-11 | 河南工业职业技术学院 | Obstacle avoidance path smooth optimization method |
KR20150126482A (en) * | 2014-05-02 | 2015-11-12 | 한화테크윈 주식회사 | Path planning apparatus of mobile robot |
CN107116540A (en) * | 2016-02-24 | 2017-09-01 | 中国科学院沈阳计算技术研究所有限公司 | A kind of robot collision checking method that structure is surrounded based on SCS |
CN108705532A (en) * | 2018-04-25 | 2018-10-26 | 中国地质大学(武汉) | A kind of mechanical arm obstacle-avoiding route planning method, equipment and storage device |
CN110497403A (en) * | 2019-08-05 | 2019-11-26 | 上海大学 | A kind of manipulator motion planning method improving two-way RRT algorithm |
CN110919661A (en) * | 2019-12-26 | 2020-03-27 | 中国科学院沈阳自动化研究所 | Motion planning method for mechanical arm in glove box closed space |
CN110962130A (en) * | 2019-12-24 | 2020-04-07 | 中国人民解放军海军工程大学 | Heuristic RRT mechanical arm motion planning method based on target deviation optimization |
-
2020
- 2020-10-21 CN CN202011132260.6A patent/CN112549016A/en active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010155328A (en) * | 2009-01-01 | 2010-07-15 | Sony Corp | Path planning device, path planning method, and computer program |
KR20150126482A (en) * | 2014-05-02 | 2015-11-12 | 한화테크윈 주식회사 | Path planning apparatus of mobile robot |
CN104407613A (en) * | 2014-10-20 | 2015-03-11 | 河南工业职业技术学院 | Obstacle avoidance path smooth optimization method |
CN107116540A (en) * | 2016-02-24 | 2017-09-01 | 中国科学院沈阳计算技术研究所有限公司 | A kind of robot collision checking method that structure is surrounded based on SCS |
CN108705532A (en) * | 2018-04-25 | 2018-10-26 | 中国地质大学(武汉) | A kind of mechanical arm obstacle-avoiding route planning method, equipment and storage device |
CN110497403A (en) * | 2019-08-05 | 2019-11-26 | 上海大学 | A kind of manipulator motion planning method improving two-way RRT algorithm |
CN110962130A (en) * | 2019-12-24 | 2020-04-07 | 中国人民解放军海军工程大学 | Heuristic RRT mechanical arm motion planning method based on target deviation optimization |
CN110919661A (en) * | 2019-12-26 | 2020-03-27 | 中国科学院沈阳自动化研究所 | Motion planning method for mechanical arm in glove box closed space |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112947489B (en) * | 2021-04-08 | 2022-11-22 | 华东理工大学 | Method and device for planning collision-free path of welding robot in complex environment |
CN112947489A (en) * | 2021-04-08 | 2021-06-11 | 华东理工大学 | Method and device for planning collision-free path of welding robot in complex environment |
CN113084811A (en) * | 2021-04-12 | 2021-07-09 | 贵州大学 | Mechanical arm path planning method |
CN113084811B (en) * | 2021-04-12 | 2022-12-13 | 贵州大学 | Mechanical arm path planning method |
CN113246143A (en) * | 2021-06-25 | 2021-08-13 | 视比特(长沙)机器人科技有限公司 | Mechanical arm dynamic obstacle avoidance trajectory planning method and device |
CN113478495A (en) * | 2021-09-08 | 2021-10-08 | 南京蓝昊智能科技有限公司 | Multi-dimensional mechanical arm smooth path planning method |
CN113478495B (en) * | 2021-09-08 | 2022-03-11 | 南京蓝昊智能科技有限公司 | Multi-dimensional mechanical arm smooth path planning method |
CN113954073A (en) * | 2021-11-08 | 2022-01-21 | 北京华航唯实机器人科技股份有限公司 | Trajectory analysis method and device for movable part of robot and robot equipment |
CN113954073B (en) * | 2021-11-08 | 2024-03-22 | 北京华航唯实机器人科技股份有限公司 | Track analysis method and device for movable part of robot and robot equipment |
CN114227672A (en) * | 2021-11-26 | 2022-03-25 | 北京工业大学 | Mechanical arm safety collision trajectory planning method and device, storage medium and equipment |
CN114227672B (en) * | 2021-11-26 | 2022-07-26 | 北京工业大学 | Mechanical arm safety collision track planning method and device, storage medium and equipment |
CN114310918A (en) * | 2022-03-14 | 2022-04-12 | 珞石(北京)科技有限公司 | Mechanical arm track generation and correction method under man-machine cooperation |
CN114952870A (en) * | 2022-07-29 | 2022-08-30 | 山东亚历山大智能科技有限公司 | Four-axis mechanical arm motion control method and system for high-frequency contact object disinfection |
CN114952870B (en) * | 2022-07-29 | 2023-09-29 | 山东亚历山大智能科技有限公司 | Four-axis mechanical arm motion control method and system for high-frequency contact object disinfection |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112549016A (en) | Mechanical arm motion planning method | |
CN112677153B (en) | Improved RRT algorithm and industrial robot path obstacle avoidance planning method | |
CN111546347B (en) | Mechanical arm path planning method suitable for dynamic environment | |
CN110962130B (en) | Heuristic RRT mechanical arm motion planning method based on target deviation optimization | |
CN113219998B (en) | Improved bidirectional-RRT-based vehicle path planning method | |
CN107234617B (en) | Obstacle avoidance path planning method guided by artificial potential field irrelevant to obstacle avoidance task | |
CN109343345B (en) | Mechanical arm polynomial interpolation track planning method based on QPSO algorithm | |
CN111347429A (en) | Collision detection mechanical arm path planning method based on improved ant colony algorithm | |
CN111761582B (en) | Mobile mechanical arm obstacle avoidance planning method based on random sampling | |
CN112650256A (en) | Improved bidirectional RRT robot path planning method | |
CN114161416B (en) | Robot path planning method based on potential function | |
CN111610786A (en) | Mobile robot path planning method based on improved RRT algorithm | |
CN113442140B (en) | Cartesian space obstacle avoidance planning method based on Bezier optimization | |
CN114147708B (en) | Mechanical arm obstacle avoidance path planning method based on improved longhorn beetle whisker search algorithm | |
JP2014502393A (en) | Determination method and determination apparatus | |
CN112809665A (en) | Mechanical arm motion planning method based on improved RRT algorithm | |
Tian | Research on robot optimal path planning method based on improved ant colony algorithm | |
CN115416016A (en) | Mechanical arm obstacle avoidance path planning method based on improved artificial potential field method | |
CN116690557A (en) | Method and device for controlling humanoid three-dimensional scanning motion based on point cloud | |
CN115933637A (en) | Path planning method and device for substation equipment inspection robot and storage medium | |
CN115981311A (en) | Path planning method and system for complex pipeline maintenance robot | |
CN114310904A (en) | Novel bidirectional RRT method suitable for mechanical arm joint space path planning | |
Chen et al. | Improved A-star Method for Collision Avoidance and Path Smoothing | |
Zhao et al. | Improved Path Planning Algorithm Based on RRT Algorithm and Quintic B-spline Curve | |
Ji et al. | Grasping Control of a Vision Robot Based on a Deep Attentive Deterministic Policy Gradient |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210326 |
|
RJ01 | Rejection of invention patent application after publication |