Updated attitude filter, mostly works, pretty neat demo.