Progress (I hope). Attempted sensor fusion, rather than just noise filtering like in the class example