Python filters added:
trim, bias, accel, gyro, tf all work really well.
rviz is a work in progress but probably going to delete it
working on a fusion of the accelerometer and gyro now (_simple)
Fixed orient_accel! :D
Fused accel and gyro together, works well! :D :D
Added Mahony and MadgwickAHRS implementations.
mag scripts are not ready yet.