|
|
本帖最后由 Albert,_Einste 于 2014-10-29 14:43 编辑
[url=陀螺仪加速度计 MPU6050 启用DMP运算角度代码 http://www.geek-workshop.com/thread-6126-1-1.html]
我用上面这个程序为什么编译不过1.0.6版本{:soso_e103:}
// Arduino Wire library is required if I2Cdev I2CDEV_ARDUINO_WIRE implementation
// is used in I2Cdev.h
#include "Wire.h"
// I2Cdev and MPU6050 must be installed as libraries, or else the .cpp/.h files
// for both classes must be in the include path of your project
#include "I2Cdev.h"
#include "MPU6050_6Axis_MotionApps20.h"
MPU6050 mpu(0x68);
// MPU control/status vars
bool dmpReady = false; // set true if DMP init was successful
uint8_t mpuIntStatus; // holds actual interrupt status byte from MPU
uint8_t devStatus; // return status after each device operation (0 = success, !0 = error)
uint16_t packetSize; // expected DMP packet size (default is 42 bytes)
uint16_t fifoCount; // count of all bytes currently in FIFO
uint8_t fifoBuffer[64]; // FIFO storage buffer
// orientation/motion vars
Quaternion q; // [w, x, y, z] quaternion container
VectorFloat gravity; // [x, y, z] gravity vector
float ypr[3]; // [yaw, pitch, roll] yaw/pitch/roll container and gravity vector
// ================================================================
// === INTERRUPT DETECTION ROUTINE ===
// ================================================================
volatile bool mpuInterrupt = false; // indicates whether MPU interrupt pin has gone high
void dmpDataReady() {
mpuInterrupt = true;
}
// ================================================================
// === INITIAL SETUP ===
// ================================================================
void mpu_setup() {
//Serial.begin(115200); // opens serial port, sets data rate to 9600 bps
// join I2C bus (I2Cdev library doesn't do this automatically)
Wire.begin();
// initialize device
Serial.println("Initializing I2C devices...");
mpu.initialize();
// verify connection
Serial.println("Testing device connections...");
Serial.println(mpu.testConnection() ? "MPU6050 connection successful" : "MPU6050 connection failed");
delay(2);
// load and configure the DMP
Serial.println("Initializing DMP...");
devStatus = mpu.dmpInitialize();
// make sure it worked (returns 0 if so)
if (devStatus == 0) {
// turn on the DMP, now that it's ready
Serial.println("Enabling DMP...");
mpu.setDMPEnabled(true);
// enable Arduino interrupt detection
Serial.println("Enabling interrupt detection (Arduino external interrupt 0)...");
attachInterrupt(0, dmpDataReady, RISING);
mpuIntStatus = mpu.getIntStatus();
// set our DMP Ready flag so the main loop() function knows it's okay to use it
Serial.println("DMP ready! Waiting for first interrupt...");
dmpReady = true;
// get expected DMP packet size for later comparison
packetSize = mpu.dmpGetFIFOPacketSize();
}
else {
// ERROR!
// 1 = initial memory load failed
// 2 = DMP configuration updates failed
// (if it's going to break, usually the code will be 1)
Serial.print("DMP Initialization failed (code ");
Serial.print(devStatus);
Serial.println(")");
}
}
void mpu_loop()
{
float alpha,omiga;
// if programming failed, don't try to do anything
if (!dmpReady)
return;
// wait for MPU interrupt or extra packet(s) available
if (!mpuInterrupt && fifoCount < packetSize)
return;
// reset interrupt flag and get INT_STATUS byte
mpuInterrupt = false;
mpuIntStatus = mpu.getIntStatus();
// get current FIFO count
fifoCount = mpu.getFIFOCount();
// check for overflow (this should never happen unless our code is too inefficient)
if ((mpuIntStatus & 0x10) || fifoCount == 1024) {
// reset so we can continue cleanly
mpu.resetFIFO();
Serial.println("FIFO overflow!");
// otherwise, check for DMP data ready interrupt (this should happen frequently)
}
else if (mpuIntStatus & 0x02) {
// wait for correct available data length, should be a VERY short wait
while (fifoCount < packetSize) fifoCount = mpu.getFIFOCount();
// read a packet from FIFO
mpu.getFIFOBytes(fifoBuffer, packetSize);
// track FIFO count here in case there is > 1 packet available
// (this lets us immediately read more without waiting for an interrupt)
fifoCount -= packetSize;
mpu.dmpGetQuaternion(&q, fifoBuffer);
mpu.dmpGetGravity(&gravity, &q);
mpu.dmpGetYawPitchRoll(ypr, &q, &gravity); //从DMP中取出Yaw、Pitch、Roll三个轴的角度,放入数组ypr。单位:弧度
alpha=-ypr[2] * 180/M_PI;
omiga=mpu.getRotationX()/16.4; //配置是16位表示正负2000°/s, 65536/4000
Serial.print("Alpha ");
Serial.print(alpha);//x轴平行偏移角度
Serial.print("\tOmiga ");
Serial.println(omiga);//对应加速度力道
}
}
错误为Arduino: 1.0.6 (Windows 7), Board: "Arduino Nano w/ ATmega328"
D:\Arduino\hardware\tools\avr\bin\avr-g++ -c -g -Os -Wall -fno-exceptions -ffunction-sections -fdata-sections -mmcu=atmega328p -DF_CPU=16000000L -MMD -DUSB_VID=null -DUSB_PID=null -DARDUINO=106 -ID:\Arduino\hardware\arduino\cores\arduino -ID:\Arduino\hardware\arduino\variants\eightanaloginputs -ID:\Arduino\libraries\Wire -ID:\Arduino\libraries\I2Cdev -ID:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h C:\Users\ADMINI~1\AppData\Local\Temp\build5691815205658356843.tmp\sketch_oct29a.cpp -o C:\Users\ADMINI~1\AppData\Local\Temp\build5691815205658356843.tmp\sketch_oct29a.cpp.o
In file included from sketch_oct29a.ino:9:
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:37:27: error: helper_3dmath.h: No such file or directory
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:42:21: error: MPU6050.h: No such file or directory
In file included from sketch_oct29a.ino:9:
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:89: warning: only initialized variables can be placed into program memory area
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:229: warning: only initialized variables can be placed into program memory area
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:271: warning: only initialized variables can be placed into program memory area
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:281: error: 'MPU6050' has not been declared
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: In function 'uint8_t dmpInitialize()':
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:284: error: 'reset' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:295: error: 'setSleepEnabled' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:299: error: 'setMemoryBank' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:301: error: 'setMemoryStartAddress' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:303: error: 'readMemoryByte' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:311: error: 'getOTPBankValid' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:317: error: 'getXGyroOffset' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:318: error: 'getYGyroOffset' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:319: error: 'getZGyroOffset' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:329: error: 'setSlaveAddress' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:331: error: 'setI2CMasterModeEnabled' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:335: error: 'resetI2CMaster' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:342: error: 'writeProgMemoryBlock' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:349: error: 'writeProgDMPConfigurationSet' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:353: error: 'MPU6050_CLOCK_PLL_ZGYRO' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:353: error: 'setClockSource' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:356: error: 'setIntEnabled' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:359: error: 'setRate' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:362: error: 'MPU6050_EXT_SYNC_TEMP_OUT_L' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:362: error: 'setExternalFrameSync' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:365: error: 'MPU6050_DLPF_BW_42' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:365: error: 'setDLPFMode' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:368: error: 'MPU6050_GYRO_FS_2000' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:368: error: 'setFullScaleGyroRange' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:371: error: 'setDMPConfig1' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:372: error: 'setDMPConfig2' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:375: error: 'setOTPBankValid' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:378: error: 'setXGyroOffset' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:379: error: 'setYGyroOffset' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:380: error: 'setZGyroOffset' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:383: error: 'setXGyroOffsetUser' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:384: error: 'setYGyroOffsetUser' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:385: error: 'setZGyroOffsetUser' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:391: error: 'writeMemoryBlock' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:398: error: 'resetFIFO' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:401: error: 'getFIFOCount' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:406: error: 'getFIFOBytes' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:409: error: 'setMotionDetectionThreshold' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:412: error: 'setZeroMotionDetectionThreshold' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:415: error: 'setMotionDetectionDuration' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:418: error: 'setZeroMotionDetectionDuration' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:424: error: 'setFIFOEnabled' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:427: error: 'setDMPEnabled' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:430: error: 'resetDMP' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:453: error: 'getIntStatus' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:460: error: 'readMemoryBlock' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:487: error: 'dmpPacketSize' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:303: warning: unused variable 'hwRevision'
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:311: warning: unused variable 'otpValid'
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: At global scope:
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:506: error: 'MPU6050' has not been declared
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: In function 'bool dmpPacketAvailable()':
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:507: error: 'getFIFOCount' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:507: error: 'dmpGetFIFOPacketSize' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: At global scope:
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:533: error: 'MPU6050' has not been declared
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: In function 'uint8_t dmpGetAccel(int32_t*, const uint8_t*)':
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:535: error: 'dmpPacketBuffer' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:536: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:536: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:537: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:537: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:538: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:538: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: At global scope:
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:541: error: 'MPU6050' has not been declared
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: In function 'uint8_t dmpGetAccel(int16_t*, const uint8_t*)':
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:543: error: 'dmpPacketBuffer' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: At global scope:
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:549: error: 'MPU6050' has not been declared
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:549: error: 'uint8_t dmpGetAccel' redeclared as different kind of symbol
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:541: error: previous declaration of 'uint8_t dmpGetAccel(int16_t*, const uint8_t*)'
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:549: error: 'VectorInt16' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:549: error: 'v' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:549: error: expected primary-expression before 'const'
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:557: error: 'MPU6050' has not been declared
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: In function 'uint8_t dmpGetQuaternion(int32_t*, const uint8_t*)':
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:559: error: 'dmpPacketBuffer' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:560: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:560: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:561: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:561: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:562: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:562: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:563: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:563: warning: left shift count >= width of type
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: At global scope:
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:566: error: 'MPU6050' has not been declared
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: In function 'uint8_t dmpGetQuaternion(int16_t*, const uint8_t*)':
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:568: error: 'dmpPacketBuffer' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h: At global scope:
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:575: error: 'MPU6050' has not been declared
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:575: error: 'uint8_t dmpGetQuaternion' redeclared as different kind of symbol
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:566: error: previous declaration of 'uint8_t dmpGetQuaternion(int16_t*, const uint8_t*)'
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:575: error: 'Quaternion' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:575: error: 'q' was not declared in this scope
D:\Arduino\libraries\MPU6050_6Axis_MotionApps20.h/MPU6050_6Axis_MotionApps20.h:575: error: expected primary-expression before 'const'
求大神解释
|
本帖子中包含更多资源
您需要 登录 才可以下载或查看,没有帐号?注册
x
|