Revert "remove sensor fusion package"

This reverts commit ce63dcb0c8306822a95becb8f96b5be17550a29e.