Assisted navigation algorithm for wireless sensor actuator and robot networks