[드론] 상보필터를 적용한 기본 루틴 구현하기
기본 루틴 구현하기 [목표]드론을 움직여도 프로세싱상에서 보여지는 도형들이 움직이지 않도록 Roll, Pitch, Yaw 각도에 대해 0으로 초기화 시킨 값만 전달하기 바로 코드로 넘어가겠습니다. 소스 코드 //기본 루틴 구현 #include const int MPU_addr = 0x68; int16_t AcX, AcY, AcZ, Tmp, GyX, GyY, GyZ; void setup() { initMPU6050(); //가속도 자이로 센서 값을 읽음 Serial.begin(115200); } void loop() { readAccelGyro(); SendDataToProcessing(); //Roll, Pitch, Yaw에 대한 각도 정보를 보냄 } //MPU-6050초기화 루틴 void initMPU..
드론 2016. 7. 31. 19:27