Explorar o código

将角速度乘以一个比例因子,在测试中发现航向角会小一段

liang %!s(int64=2) %!d(string=hai) anos
pai
achega
a6552e5658
Modificáronse 1 ficheiros con 6 adicións e 0 borrados
  1. 6 0
      motion/trajAlgorithm/footPDR.c

+ 6 - 0
motion/trajAlgorithm/footPDR.c

@@ -726,6 +726,12 @@ unsigned char footPDR(uint32_t num, float *gyr, float *acc, uint16_t front_press
 	gyr[1] -= gyrBias[1];
 	gyr[2] -= gyrBias[2];
 	
+	for (int i = 0; i < 3; i++)
+	{
+		gyr[i] *= 1.1072f;
+
+	}
+	
 
 	//ÏÂÃæΪ¹ßµ¼½âËã
 	if (frame_index == 0)