Navigation FRAME

The hexamite ultrasonic xyzlab setup can be useful to cancel IMU yaw drift. It can also be used to find the initial condition and provide absolute coordinates for IMU extrapolation and interpolation. Hx19lab is very precise, and smoothly stable for slow moving objects. IMU can be used to achieve reality sensation by increasing the sampling to over 43 s/s. The xyzLab setup below can be placed by every wall to create a surround positioning. Although hexamite 3d ultrasonic positioning requires only 3 receivers and 1 tag, for computational simplicity the xyzLab standard is to use 4 units, spaced at equal distances for 3d Cartesian coordinate results. 

Simplifying Spatial Configuration 

Receiver 0 at (0,0,0) and Receiver 1 at (X1,0,0) and Receiver 2 at (0,Y2,0) 

Given the above configuration, the following is true:

X =  (R02 - R12 + X12) / (2*X1)


Y =  (R02 - R2 + Y22) / (2*Y2)


Z2 =  R02 - X2 - Y2

Hx19 receiver 0 measures and returns R0 as mm, and similarly receiver 1 returns its distance R1 to the tag. In a clockwise enumeration receiver 3 returns R2

Receiver 2 is therefore redundant, and can be used to compute another set of X,Y,Z for averaging purposes.


Let the receivers on the cross be 1m apart in the x and y direction see illustration below. The green Z line is orthogonal on the yellow plane. The blue square represents the tag moving away and towards the yellow plane. Blue lines are the distances from tag to receivers (shown as blue circles at specific coordinate points). Blue line lengths is embedded in the serial string streaming from the receivers. Red lines are points on the yellow plane.

Let X1=1m and Y2=1m, then:

Receiver 0 at (0,0,0) and Receiver 1 at (1,0,0) and Receiver 2 at (0,1,0) then

X =  (R02 - R1 + 1) / 2

Y =  (R02 - R2 + 1) / 2


The above spatial arrangement makes positioning math efficient, simple and within grasp of those who don't have time for math elaboration. And it reduces processor load significantly, i.e. sets this operation within realm of most Microcontrollers.

Hx19 measurement is in millimeters. The distances between receivers on the hx19xyzLab cross is always 1000mm, so the axes should be in terms of mm instead of m.



Copyright 1999 [Hexamite]. All rights reserved. Revised: .