added a sensor fusion test

if the boundary body  is switched to static from kinematic, FusionTest
outlines how to use the mag, acc, and gyro data to calculate position
and orientation