A simple implementation of some complex Sensor Fusion algorithms
remove warnings by @markub3327
added initQuat() by jonasBoss
initQuat()