added compass calibration function
added roll and pitch calculation from accelerometer
added roll, pitch and yaw calculation from magnetometer, but it's still buggy
added roll/pitch/yaw plot (still buggy due to wrong compass yaw)