显示姿态角

来自Microduino Wikipedia
跳转至: 导航搜索

Sensor_Motion库-显示姿态角示例


在下面的示例中,使用Core+核心通过硬串口引脚(2,3)与Sensor-Motion通信。

所需硬件



电路搭建

将Sensor-Motion接到Hub的2,3引脚。
将Battery、Core+、Hub堆叠在一起,通过MicroUSB数据线接入电脑。



代码

#include <sensor_motion.h>

sensorMotion motion(&Serial1);

float ypr[3];//用来存放三轴姿态角

void setup() {
  Serial.begin(115200);
  motion.begin();
}

void loop() {
  //如果成功接收数据,则串口输出三轴姿态角
  if(motion.get_data(MOTION_3, ypr)){
    Serial.print(ypr[0]); 
    Serial.print("  "); 
    Serial.print(ypr[1]); 
    Serial.print("  "); 
    Serial.println(ypr[2]);
  }
  delay(10);
}


[返回Sensor-Motion]