简单利用mpu6050 lib,进行测试,接开发板D7,D8针
代码如下
- #include "mbed.h"
- #include "MPU6050.h"
-
- MPU6050 mpu(D7,D8);//for Nucleo-F042K6
- Serial pc(USBTX,USBRX);
-
- float gx,gy,gz,ax,ay,az;
-
- int main()
- {
- pc.baud(115200);
- if(mpu.getID()==0x68) {
- pc.printf("MPU6050 OK");
- wait(1);
- } else {
- pc.printf("MPU6050 error ID=0x%x\r\n",mpu.getID());
- while(1) {
- }
- }
- mpu.start();
- while(1) {
- mpu.read(&gx,&gy,&gz,&ax,&ay,&az);
- pc.printf("gx,gy,gz,ax,ay,az %.1f,%.1f,%.1f,%.2f,%.2f,%.2f\r\n",gx,gy,gz,ax,ay,az);
- wait(0.1);
- }
- }
-
复制代码 mbed os下写代码是不是很简单
|
搜一下,mbed下有很多的,引入进来即可。