working direction cosine implementation for angle determination
yaw-pitch-roll detection seems to work