显示姿态角
Sensor_Motion库-显示姿态角示例
所需硬件
电路搭建 将Sensor-Motion接到Hub的2,3引脚。
代码 #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);
}
|