Implementation Of A 3D Imaging Sensor Aided Inertial Measurement Unit Navigation System