Implementing Sensor Fusion Algorithm Cold Start

Read sensor data to calculate an approximate orientation when starting.
This allows subsequent outputs to converge to the actual value much
faster, instead of slowly converging in around 60 seconds.
Revert "Implementing Sensor Fusion Algorithm Cold Start"

This reverts commit 9b7ac1a062ab423fd66082b055d7213e855d2271.
Read sensor data to calculate an approximate orientation when starting.
Merge pull request #1 from tengyifei/master

Implementing Sensor Fusion Algorithm Cold Start