Better attitude filter, not sensitive to sudden accelerations

This fixes some issues we had with aggressive multirotor flight. Tested in lab setup, not flown outdoors with RC. Please test and report back.