A quaternion based sensor fusion algorithm that fuses accelerometers and gyroscopes and optionally magnetometers - Blake Johnson - bjohnsonfl