Browse Source

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

liang 2 years ago
parent
commit
a6552e5658
1 changed files with 6 additions and 0 deletions
  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)