Как включить значение YAW в код esp8266? - PullRequest
Новая
       14

Как включить значение YAW в код esp8266?

0 голосов
/ 25 сентября 2019

У меня esp8266 ic с MPU6050.

Я использую библиотеку github для подключения обоих модулей

, она хорошо работает для отображения PITCH и ROLL, но не отображает значение YAW.

Как включить значение YAW в этот код?

возможно ли рассчитать значение YAW из PITCH и ROLL.

Код указан ниже БИБЛИОТЕКА IПОЛУЧИЛ 

  

#include <Wire.h>
#include <ESP8266WiFi.h> 
#include <MPU6050.h>

MPU6050 mpu;

int SCL_PIN=D1;
int SDA_PIN=D2;

void setup() 
{
  WiFi.forceSleepBegin();// turn off ESP8266 RF
  delay(1);
  Serial.begin(9600);

  Serial.println("Initialize MPU6050");

  while(!mpu.beginSoftwareI2C(SCL_PIN,SDA_PIN,MPU6050_SCALE_2000DPS, MPU6050_RANGE_2G))
  {
    Serial.println("Could not find a valid MPU6050 sensor, check wiring!");
    delay(500);
  }
}

void loop()
{
  // Read normalized values 
  Vector normAccel = mpu.readNormalizeAccel();

  // Calculate Pitch & Roll
  int pitch = -(atan2(normAccel.XAxis, sqrt(normAccel.YAxis*normAccel.YAxis + normAccel.ZAxis*normAccel.ZAxis))*180.0)/M_PI;
  int roll = (atan2(normAccel.YAxis, normAccel.ZAxis)*180.0)/M_PI;

  // Output
  Serial.print(" Pitch = ");
  Serial.print(pitch);
  Serial.print(" Roll = ");
  Serial.print(roll);
  
  Serial.println();
  
  delay(10);
}
...