CPC G01C 21/1652 (2020.08) [G01C 21/206 (2013.01); G01S 13/426 (2013.01); G01S 13/867 (2013.01); G01S 13/89 (2013.01)] | 20 Claims |
1. A method of mapping and routing, comprising:
mounting a sensor assembly on a wearable pack to be worn by a mobile object, the sensor assembly comprising an inertial measurement unit (IMU) and one or more radio-frequency (RF) radar units;
collecting, via the sensor assembly, sensing data comprising (i) one or more radar velocities from the one or more RF radar units, (ii) one or more angular velocities of the mobile object from the IMU, and (iii) one or more linear accelerations from the IMU;
determining, via a processor, translation information and absolute orientation information of the mobile object based on the sensing data;
determining, via the processor, a time series of poses of the mobile object based on a combination of the determined translation information and the determined absolute orientation information; and
combining, via the processor, the time series of poses into a path of the mobile object.
|