Skip to main content
. 2026 Jul 26;26(15):4740. doi: 10.3390/s26154740
Algorithm 1 Virtual Navigation Trajectory Generation
  •   1:

    Initialize pi,kv(t)=pi,kd(t) for t≥0

  •   2:

    while collision avoidance occurs (Ei,ka(τin)≠0) do

  •   3:

          Set pi,kv(t)=pi,kd(τin)+∫τintp˙i,kv(τ)dτ

  •   4:

          Compute p˙i,kv via (23)

  •   5:

    end while

  •   6:

    Update pi,kv(t) to latest pi,kd(t) using smooth transition

  •   7:

    Repeat when new avoidance is triggered