|
Algorithm 1 HPPM-PRA general procedure. |
|
|
Require: , ,
|
▹ The task to be solved is proposed |
|
Require:
|
▹ Assign the repulsion parameter |
| 1: Get
|
▹ See Algorithm 2 |
| 2: Get the value of Q
|
▹ See Algorithm 3 |
| 3: Set the non-linear equation system to solve () |
▹ See Algorithm 4 |
| 4: Generate the homotopy equation (H) |
▹ See Algorithm 5 |
| 5: Create hypersphere
|
▹ is used as the center of the first hypersphere |
| 6: Formulation of the homotopy system () |
|
| 7: iteration=0 |
▹ A temporary variable is used as the counter |
| 8: whiledo
|
▹ Use the hyperspherical path-tracking algorithm, until
|
| 9: if then
|
|
| 10: Euler’s predictor () |
▹ Euler’s predictor is used |
| 11: else
|
|
| 12: Vector predictor () |
▹ The vector predictor is used |
| 13: end if
|
|
| 14: Broyden’s method () |
▹ The corrector method is used |
| 15: The numeric homotopy path is stored |
|
| 16: Update the center of the hypersphere () |
|
| 17: iteration++ |
|
| 18: end while
|
|
|
Ensure: The numerical homotopy path |
▹ The robotic arm can execute the path |