Skip to main content
. 2022 May 26;22(11):4022. doi: 10.3390/s22114022
Algorithm 1 HPPM-PRA general procedure.
Require:  R(w),C(w), Esstart,Esgoal, L,v ▹ The task to be solved is proposed
Require:  PC,PR ▹ Assign the repulsion parameter
1: Get (wstart,wgoal,a0) ▹ See Algorithm 2
2: Get the value of Q ▹ See Algorithm 3
3: Set the non-linear equation system to solve (f1,,fv) ▹ See Algorithm 4
4: Generate the homotopy equation (H) ▹ See Algorithm 5
5: Create hypersphere Si wstart is used as the center of the first hypersphere
6: Formulation of the homotopy system (HS)
7: iteration=0 ▹ A temporary variable is used as the counter
8: while(λ1)do ▹ Use the hyperspherical path-tracking algorithm, until λ=1
9:     if (iteration<2) then
10:         Euler’s predictor (HS) ▹ Euler’s predictor is used
11:     else
12:         Vector predictor (HS) ▹ The vector predictor is used
13:     end if
14:     Broyden’s method (HS) ▹ The corrector method is used
15:     The numeric homotopy path is stored
16:     Update the center of the hypersphere (Si)
17:     iteration++
18: end while
Ensure:  The numerical homotopy path ▹ The robotic arm can execute the path