View full-text article in PMC Sensors (Basel). 2026 Jul 26;26(15):4740. doi: 10.3390/s26154740 Search in PMC Search in PubMed View in NLM Catalog Add to search Copyright and License information © 2026 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license. PMC Copyright notice 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