显示姿态角

来自Microduino Wikipedia
Machine1987讨论 | 贡献2017年7月5日 (三) 06:06的版本 (创建页面,内容为“{| style="width: 800px;" |- | <p style="color: #4F4E4E;font-size:220%">'''Sensor_Motion库-显示姿态角示例'''</p> <br> 在下面的示例中,使用Core+核...”)
(差异) ←上一版本 | 最后版本 (差异) | 下一版本→ (差异)
跳转至: 导航搜索

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);
}