Updated kalmanFilter to just accelerometer Angle and gyro Omega. Performance is between madgwick and mahoney in terms of acceleration sensitivity and drift.