가속도,자이로 센서에 대한 상보필터 적용시키기 가속도 센서와 자이로 센서의 단점들을 보안하고자 상보필터를 이용해서 값을 추출하는 방법에 대해 한번 알아보도록 하겠습니다. 일단 상보필터를 구하는 근사공식에 대해 알아보겠습니다. 상보필터 근사공식 위 공식을 참고해서 상보필터 처리 루틴을 한번 구현해보도록 하겠습니다. 소스코드 //상보필터 적용시키기 #include const int MPU_addr = 0x68; int16_t AcX, AcY, AcZ, Tmp, GyX, GyY, GyZ; void setup() { initMPU6050(); //가속도 자이로 센서 값을 읽음 Serial.begin(115200); calibAccelGyro(); //센서 보정 루틴 initDT();// 시간 간격에 대한 초기화..
자이로 센서 처리 루틴 구현 먼저 참고해야할 포스팅 [드론]자이로 센서 개념정리[드론]자이로 센서 값 해석하기 이번 포스팅 목적: 자이로 값을 이용해서 Roll, Pitch, Yaw의 각도를 구하는 루틴을 추가하기 소스코드 //자이로 센서 처리 루틴 구현 #include const int MPU_addr = 0x68; int16_t AcX, AcY, AcZ, Tmp, GyX, GyY, GyZ; void setup() { initMPU6050(); //가속도 자이로 센서 값을 읽음 Serial.begin(115200); calibAccelGyro(); //센서 보정 루틴 initDT();// 시간 간격에 대한 초기화 } void loop() { readAccelGyro(); calcDT(); //시간 간격..
자이로 센서 값 해석하기 안녕하세요 바로 이전 포스팅에서 자이로 센서에 대한 개념정리를 추가적으로 해보았습니다.이번 포스팅에서는 자이로 센서 값에 대한 해석하는 방법에 대해 알아보도록 하겠습니다^^ 자이로 값 해석하기에 들어가기 앞서 여기서 사용된 소스코드는[드론]MPU-6050 가속도 자이로 센서 포스팅에 사용된 소스코드로 사용하도록 하겠습니다. 가속도 센서 값 해석하기 포스팅도 참고하시면 좋을거 같네요^^ 소스코드에 보시면 int16_t 타입으로 변수를 선언을 해주었습니다. 이는 16비트 타입의 범위로 정의를 해준 것 이며 16비트 타입은 -32769 ~ 32767 사이의 값을 가질 수 있습니다. 여기서 GyX, GyY, GyZ가 가질 수 있는 정수 값의 범위는 -32769 ~ 32767입니다. 그러..