Revert "Trimmed the branch to only the imu_filter_madgwick sub directory"

This reverts commit 980298575972300cdb26218e36530a7b35bae503.
Rebase from 'upstream'
Trimmed the branch to only the imu_filter_madgwick sub directory