Switch from DMP to Kalman Filter

[SammyOina]

reaction-wheel/src/main.cpp

Lines 333 to 339 in ed1feb0

	if ((mpu.dmpGetCurrentFIFOPacket(fifoBuffer)) && (elapsedTime > sampleTime)); { // Get the Latest packet
	// display Euler angles in degrees
	mpu.dmpGetQuaternion(&q, fifoBuffer);
	mpu.dmpGetGravity(&gravity, &q);
	mpu.dmpGetYawPitchRoll(ypr, &q, &gravity);
	mpu.getMotion6(&accData[0], &accData[1], &accData[2], &gyrData[0], &gyrData[1], &gyrData[2]);

• Implement Kalman filter to obtain roll velocity

• refer to this :
  https://github.com/nakujaproject/N2-flight-software/blob/4ac1c76ee76bc993420b845453921ee96a13478c/include/kalmanfilter.h#L1-L78