Working Code for 9DOF

Output:
ORIENTATION=roll,pitch,heading   in degrees
ACCEL=x,x,z in m/(s^2)
GYRO=x,y,z in rad/s