소스 검색

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

liang 2 년 전
부모
커밋
a6552e5658
1개의 변경된 파일6개의 추가작업 그리고 0개의 파일을 삭제
  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)