Simultaneous quaternion estimation (QUEST) and bias determination