1 Introduction
2 Robot structure and control system
Fig.3 Robot and tool workspace. (a) Front view of the robot with degrees of freedom. Joint 1 is a translation joint and Joints 2 and 3 are rotation joints and their limitations are [5d, 11d], [0, 2π), and [0, π], respectively, where d is the distance between two tube holes. (b) Tool workspace (red ring area) with the tool length of 2. |
Tab.1 D–H parameter of the robot |
Link | θi | αi | Li | di |
---|---|---|---|---|
1 | θ1 | π/2 | 0 | 0 |
2 | 0 | π/2 | 0 | d2 |
3 | θ3 | 0 | d | 0 |
3 Problem formulation
4 Method
4.1 Input parameters
Tab.2 Task planning input parameters |
No. | Parameters | Symbol | Influence |
---|---|---|---|
1 | Distribution of the tube holes | Robot moving direction | |
2 | Distribution of the plugging holes | Planned path | |
3 | Distribution of the task holes | Task planning results | |
4 | Robot maximum translation distance | Motion speed and accuracy | |
5 | Distribution of the base toes | Robot reachable position | |
6 | Distance between the foot toes | Tool working space | |
7 | Distance between the tools | Task planning results | |
8 | Distance from the foot toe to the tool | Tool working space | |
9 | Robot rotation speed | Action cost | |
10 | Robot translation speed | Action cost | |
11 | Robot grasping time | Action cost | |
12 | Robot releasing time | Action cost |
4.2 Workspace analysis
4.3 Task allocation
4.4 Robot base position search
4.4.1 Determine the length of the overall search
4.4.2 Select key tasks
4.4.3 Re-judge the tasks
4.5 Robot path, base sequence, and task sequence planning robot base position search
5 Experiments
5.1 Task planning experiment
Tab.3 Experimental results for task planning on a semicircular tube plate |
Planning time/ms | Running time/ms | Base number | Base cost | Completed task number | ||||||||||||||||||||
---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|
No. | Task number | Task planning | Path planning | |||||||||||||||||||||
M1 | M2 | M3 | M1 | M2 | M3 | M1 | M2 | M3 | M1 | M2 | M3 | M1 | M2 | M3 | M1 | M2 | M3 | |||||||
1 | 40 | 25 | 30 | 18 | 236 | 537 | 47 | 349 | 415 | 306 | 5 | 8 | 1 | 8.1 | 9.0 | 5.1 | 40† | 48 | 40* | |||||
2 | 216 | 52 | 59 | 28 | 3023 | 13563 | 124 | 1508 | 1833 | 1072 | 17 | 38 | 3 | 41.3 | 40.0 | 10.1 | 224 | 216† | 216* | |||||
3 | 200 | 49 | 55 | 40 | 1544 | 5814 | 252 | 1349 | 1678 | 1206 | 14 | 29 | 5 | 19.1 | 29.0 | 18.2 | 240 | 200† | 200* | |||||
4 | 570 | 136 | 150 | 61 | 13041 | 30701 | 1595 | 4617 | 4935 | 2934 | 48 | 75 | 14 | 68.3 | 75.0 | 30.2 | 672† | 760 | 572* | |||||
5 | 240 | 92 | 63 | 53 | 7491 | 5261 | 167 | 2453 | 2178 | 1272 | 36 | 28 | 4 | 44.1 | 36.1 | 15.2 | 252† | 260 | 242* |
5.2 Base sequence planning
Tab.4 Experiment results for base sequence planning |
No. | Base position | Optimal path cost | Computation time/ms | Iteration | |||||
---|---|---|---|---|---|---|---|---|---|
ACO | PSO | ABC | ACO | PSO | ABC | ||||
1 | 6 | 19.2 | 84 | 23 | 609 | 1 | 3 | 5 | |
2 | 10 | 16.1 | 217 | 60 | 1390 | 1 | 14 | 8 | |
3 | 15 | 21.1 | 108 | 30 | 1814 | 1 | 19 | 13 |