آی ام یو ( 10dof imu / ahrs ) نه محوره gy-80 - ماژول قطب نمای دیجیتال ، سنسور شتاب

یک ماژول قدرتمند برای ربات پرنده ، خودروی هوشمند و یا سایر پروژه های شما! این ماژول از چهار سنسور l3g4200d ( سنسور زاویه سنج سه محوره ) ، adxl345 (سنسور شتاب سنج سه محوره ) ، hmc5883l ( قطب نمای دیجیتال ) و bmp085 که یک سنسور فشار بارومتریک می باشد تشکیل شده است . این سنسور در کنار اتصال به یک ماژول موقعیت یاب ماهواره ای ( gps ) هر آنچه را که برای جهت یابی در کنترل هوشمند و خودکار ، سیستم های آتوپایلوت یا آتولندینگ ، ساخت یک هواپیمای مدل و یا سایر ربات های پرنده بدون سرنشین خودکار نیاز دارید در اختیار شما قرار می دهد. با استفاده از داده های قطب نمای دیجیتال ، می توانید جهت های جغرافیایی را معین نمایید ، با استفاده از شتاب سنج میزان سرعت و شتاب را اندازه گیری کنید ، سنسور زاویه سنج روی برد ، زاویه را در سه محور مشخص می نمایند و در نهایت فشارسنج نصب شده بر روی برد در اصل می تواند به صورت یک ارتفاع سنج عمل نموده و میزان ارتفاع را به شما اعلام کند. مصرف کم ، قیمت مناسب و رابط دیجیتال i2c این برد برای اتصال به برد آردوینو و یا سایر میکروکنترل ها از سایر ویژگی های این ماژول می باشند.
فایل پیوست 341 فایل پیوست 342 فایل پیوست 343 فایل پیوست 351
امکانات:
چیپ ها : L3g4200d + adxl345 + hmc5883l +bmp085
رگلاتور داخلی برای پشتیبانی از ولتاژهای 3.3 و 5 ولت میکروکنترل ها
رابط دیجیتال i2c
کیفیت بالای مدار pcb

برنامه زير پارامترهاي yaw,pitch,roll,temperature,pressure,altitude را از طريق serial monitor نمايش ميدهد.

GY-80CODE

جهت سفارش این کالا، به این بخش در فروشگاه آفتاب رایانه مراجعه نمایید.

برای راه اندازی این ماژول و هر چهار سنسور اون فقط کافیه 5 سیم اول رو طبق عکس به آردوینو متصل کنید و هیچ نیازی به وصل کردن سیم های دیگه نیست
فایل پیوست 768

برای راه اندازی سنسور HMC5883L یا همون قطب نمای خودمون باید فایل HMC5883L.zip رو دانلود کنید و بعد از اکسترکت کردن اون رو تو پوشه Library برنامه آردوینو قرار بدید
و بعد از نمونه کد زیر استفاده کنید

این نمونه کد خروجی قطب نما رو به دو صورت زاویه و رادیان نمایش میده.

کد:

---

#include <Wire.h>
// Reference the HMC5883L Compass Library
#include <HMC5883L.h>

// Store our compass as a variable.
HMC5883L compass;
// Record any errors that may occur in the compass.
int error = 0;

// Out setup routine, here we will configure the microcontroller and compass.
void setup()
{
  Serial.begin(9600);
  Wire.begin(); // Start the I2C interface.
  compass = HMC5883L(); // Construct a new HMC5883 compass.
  error = compass.SetScale(1.3); // Set the scale of the compass.
  if(error != 0)
  error = compass.SetMeasurementMode(Measurement_Continuous); // Set the measurement mode to Continuous
  if(error != 0)
  Serial.println(compass.GetErrorText(error));
}

void loop()
{
  MagnetometerRaw raw = compass.ReadRawAxis();
  MagnetometerScaled scaled = compass.ReadScaledAxis();
 
  // Values are accessed like so:
  int MilliGauss_OnThe_XAxis = scaled.XAxis;// (or YAxis, or ZAxis)

  // Calculate heading when the magnetometer is level, then correct for signs of axis.
  float heading = atan2(scaled.YAxis, scaled.XAxis);
 
  float declinationAngle = 0.0457;
  heading += declinationAngle;
 
  if(heading < 0)
    heading += 2*PI;
   
  // Check for wrap due to addition of declination.
  if(heading > 2*PI)
    heading -= 2*PI;
 
  // Convert radians to degrees for readability.
  float headingDegrees = heading * 180/M_PI;
 
  Serial.print("Heading: ");
  Serial.print(heading);
  Serial.print(" Radians ");
  Serial.print(headingDegrees);
  Serial.println(" Degrees");
}

---

برای راه اندازی سنسور BMP085 یا همون فشار سنج هوا نیازی به هیچ کتابخونه ای نیست
فقط کافیه از کد زیر استفاده کنید
این کد چهار پارامتر دمای محیط با واحد درجه سانتی گراد، ارتفاع از سطح دریا با واحد متر، فشار هوا با دو واحد پاسکال و اتمسفر به ما میده

کد:

---

#include <Wire.h>
#define BMP085_ADDRESS 0x77  // I2C address of BMP085
const unsigned char OSS = 0;  // Oversampling Setting
// Calibration values
int ac1;
int ac2;
int ac3;
unsigned int ac4;
unsigned int ac5;
unsigned int ac6;
int b1;
int b2;
int mb;
int mc;
int md;
long b5;

void setup(){
  Serial.begin(9600);
  Wire.begin();
  bmp085Calibration();
}

void loop()
{
  float temperature = bmp085GetTemperature(bmp085ReadUT()); //MUST be called first
  float pressure = bmp085GetPressure(bmp085ReadUP());
  float atm = pressure / 101325; // "standard atmosphere"
  float altitude = calcAltitude(pressure); //Uncompensated caculation - in Meters

  Serial.print("Temperature: ");
  Serial.print(temperature, 2);
  Serial.println("deg C");

  Serial.print("Pressure: ");
  Serial.print(pressure, 0);
  Serial.println(" Pa");

  Serial.print("Standard Atmosphere: ");
  Serial.println(atm, 4);

  Serial.print("Altitude: ");
  Serial.print(altitude, 2);
  Serial.println(" M");

  Serial.println();

  delay(1000);
}

void bmp085Calibration()
{
  ac1 = bmp085ReadInt(0xAA);
  ac2 = bmp085ReadInt(0xAC);
  ac3 = bmp085ReadInt(0xAE);
  ac4 = bmp085ReadInt(0xB0);
  ac5 = bmp085ReadInt(0xB2);
  ac6 = bmp085ReadInt(0xB4);
  b1 = bmp085ReadInt(0xB6);
  b2 = bmp085ReadInt(0xB8);
  mb = bmp085ReadInt(0xBA);
  mc = bmp085ReadInt(0xBC);
  md = bmp085ReadInt(0xBE);
}

// Calculate temperature in deg C
float bmp085GetTemperature(unsigned int ut){
  long x1, x2;

  x1 = (((long)ut - (long)ac6)*(long)ac5) >> 15;
  x2 = ((long)mc << 11)/(x1 + md);
  b5 = x1 + x2;

  float temp = ((b5 + 8)>>4);
  temp = temp /10;

  return temp;
}
long bmp085GetPressure(unsigned long up){
  long x1, x2, x3, b3, b6, p;
  unsigned long b4, b7;

  b6 = b5 - 4000;
  // Calculate B3
  x1 = (b2 * (b6 * b6)>>12)>>11;
  x2 = (ac2 * b6)>>11;
  x3 = x1 + x2;
  b3 = (((((long)ac1)*4 + x3)<<OSS) + 2)>>2;

  // Calculate B4
  x1 = (ac3 * b6)>>13;
  x2 = (b1 * ((b6 * b6)>>12))>>16;
  x3 = ((x1 + x2) + 2)>>2;
  b4 = (ac4 * (unsigned long)(x3 + 32768))>>15;

  b7 = ((unsigned long)(up - b3) * (50000>>OSS));
  if (b7 < 0x80000000)
    p = (b7<<1)/b4;
  else
    p = (b7/b4)<<1;

  x1 = (p>>8) * (p>>8);
  x1 = (x1 * 3038)>>16;
  x2 = (-7357 * p)>>16;
  p += (x1 + x2 + 3791)>>4;

  long temp = p;
  return temp;
}

// Read 1 byte from the BMP085 at 'address'
char bmp085Read(unsigned char address)
{
  unsigned char data;

  Wire.beginTransmission(BMP085_ADDRESS);
  Wire.write(address);
  Wire.endTransmission();

  Wire.requestFrom(BMP085_ADDRESS, 1);
  while(!Wire.available())
    ;

  return Wire.read();
}

int bmp085ReadInt(unsigned char address)
{
  unsigned char msb, lsb;

  Wire.beginTransmission(BMP085_ADDRESS);
  Wire.write(address);
  Wire.endTransmission();

  Wire.requestFrom(BMP085_ADDRESS, 2);
  while(Wire.available()<2)
    ;
  msb = Wire.read();
  lsb = Wire.read();

  return (int) msb<<8 | lsb;
}

// Read the uncompensated temperature value
unsigned int bmp085ReadUT(){
  unsigned int ut;

  // Write 0x2E into Register 0xF4
  // This requests a temperature reading
  Wire.beginTransmission(BMP085_ADDRESS);
  Wire.write(0xF4);
  Wire.write(0x2E);
  Wire.endTransmission();

  // Wait at least 4.5ms
  delay(5);

  // Read two bytes from registers 0xF6 and 0xF7
  ut = bmp085ReadInt(0xF6);
  return ut;
}

// Read the uncompensated pressure value
unsigned long bmp085ReadUP(){

  unsigned char msb, lsb, xlsb;
  unsigned long up = 0;

  // Write 0x34+(OSS<<6) into register 0xF4
  // Request a pressure reading w/ oversampling setting
  Wire.beginTransmission(BMP085_ADDRESS);
  Wire.write(0xF4);
  Wire.write(0x34 + (OSS<<6));
  Wire.endTransmission();

  // Wait for conversion, delay time dependent on OSS
  delay(2 + (3<<OSS));

  // Read register 0xF6 (MSB), 0xF7 (LSB), and 0xF8 (XLSB)
  msb = bmp085Read(0xF6);
  lsb = bmp085Read(0xF7);
  xlsb = bmp085Read(0xF8);

  up = (((unsigned long) msb << 16) | ((unsigned long) lsb << 8) | (unsigned long) xlsb) >> (8-OSS);

  return up;
}

void writeRegister(int deviceAddress, byte address, byte val) {
  Wire.beginTransmission(deviceAddress); // start transmission to device
  Wire.write(address);      // send register address
  Wire.write(val);        // send value to write
  Wire.endTransmission();    // end transmission
}

int readRegister(int deviceAddress, byte address){

  int v;
  Wire.beginTransmission(deviceAddress);
  Wire.write(address); // register to read
  Wire.endTransmission();

  Wire.requestFrom(deviceAddress, 1); // read a byte

  while(!Wire.available()) {
    // waiting
  }

  v = Wire.read();
  return v;
}

float calcAltitude(float pressure){

  float A = pressure/101325;
  float B = 1/5.25588;
  float C = pow(A,B);
  C = 1 - C;
  C = C /0.0000225577;

  return C;
}

---

برای راه اندازی سنسور ژیروسکوپ L3G4200D Tripple Axis Gyroscope نیاز به کتابخونه نداره
برای دریافت سه پارامتر X Y Z
از کد زیر استفاده کنید

کد:

---

#include <Wire.h>

#define CTRL_REG1 0x20
#define CTRL_REG2 0x21
#define CTRL_REG3 0x22
#define CTRL_REG4 0x23
#define CTRL_REG5 0x24

int L3G4200D_Address = 105; //I2C address of the L3G4200D

int x;
int y;
int z;

void setup(){

  Wire.begin();
  Serial.begin(9600);

  Serial.println("starting up L3G4200D");
  setupL3G4200D(2000); // Configure L3G4200  - 250, 500 or 2000 deg/sec

  delay(1500); //wait for the sensor to be ready
}

void loop(){
  getGyroValues();  // This will update x, y, and z with new values

  Serial.print("X:");
  Serial.print(x);

  Serial.print(" Y:");
  Serial.print(y);

  Serial.print(" Z:");
  Serial.println(z);

  delay(100); //Just here to slow down the serial to make it more readable
}

void getGyroValues(){

  byte xMSB = readRegister(L3G4200D_Address, 0x29);
  byte xLSB = readRegister(L3G4200D_Address, 0x28);
  x = ((xMSB << 8) | xLSB);

  byte yMSB = readRegister(L3G4200D_Address, 0x2B);
  byte yLSB = readRegister(L3G4200D_Address, 0x2A);
  y = ((yMSB << 8) | yLSB);

  byte zMSB = readRegister(L3G4200D_Address, 0x2D);
  byte zLSB = readRegister(L3G4200D_Address, 0x2C);
  z = ((zMSB << 8) | zLSB);
}

int setupL3G4200D(int scale){
  //From  Jim Lindblom of Sparkfun's code

  // Enable x, y, z and turn off power down:
  writeRegister(L3G4200D_Address, CTRL_REG1, 0b00001111);

  // If you'd like to adjust/use the HPF, you can edit the line below to configure CTRL_REG2:
  writeRegister(L3G4200D_Address, CTRL_REG2, 0b00000000);

  // Configure CTRL_REG3 to generate data ready interrupt on INT2
  // No interrupts used on INT1, if you'd like to configure INT1
  // or INT2 otherwise, consult the datasheet:
  writeRegister(L3G4200D_Address, CTRL_REG3, 0b00001000);

  // CTRL_REG4 controls the full-scale range, among other things:

  if(scale == 250){
    writeRegister(L3G4200D_Address, CTRL_REG4, 0b00000000);
  }else if(scale == 500){
    writeRegister(L3G4200D_Address, CTRL_REG4, 0b00010000);
  }else{
    writeRegister(L3G4200D_Address, CTRL_REG4, 0b00110000);
  }

  // CTRL_REG5 controls high-pass filtering of outputs, use it
  // if you'd like:
  writeRegister(L3G4200D_Address, CTRL_REG5, 0b00000000);
}

void writeRegister(int deviceAddress, byte address, byte val) {
    Wire.beginTransmission(deviceAddress); // start transmission to device
    Wire.write(address);      // send register address
    Wire.write(val);        // send value to write
    Wire.endTransmission();    // end transmission
}

int readRegister(int deviceAddress, byte address){

    int v;
    Wire.beginTransmission(deviceAddress);
    Wire.write(address); // register to read
    Wire.endTransmission();

    Wire.requestFrom(deviceAddress, 1); // read a byte

    while(!Wire.available()) {
        // waiting
    }

    v = Wire.read();
    return v;
}

---

برای راه اندازی سنسور شتاب سنج نیاز به کتابخونه دارید Adxl345.zip
یه مثال جالب برای این سنسور پیدا کردم به این صورت که از این سنسور برای تشخیص وضعیت سکون ، حرکت ، وارد شدن ضربه به سنسور ، حس کردن ضربه دوبل و تشخیص سقوط آزاد میشه استفاده کرد.

کد:

---

#include <Wire.h>
#include <ADXL345.h>
ADXL345 adxl; //variable adxl is an instance of the ADXL345 library

void setup(){
  Serial.begin(9600);
  adxl.powerOn();

  //set activity/ inactivity thresholds (0-255)
  adxl.setActivityThreshold(75); //62.5mg per increment
  adxl.setInactivityThreshold(75); //62.5mg per increment
  adxl.setTimeInactivity(10); // how many seconds of no activity is inactive?
 
  //look of activity movement on this axes - 1 == on; 0 == off
  adxl.setActivityX(1);
  adxl.setActivityY(1);
  adxl.setActivityZ(1);
 
  //look of inactivity movement on this axes - 1 == on; 0 == off
  adxl.setInactivityX(1);
  adxl.setInactivityY(1);
  adxl.setInactivityZ(1);
 
  //look of tap movement on this axes - 1 == on; 0 == off
  adxl.setTapDetectionOnX(0);
  adxl.setTapDetectionOnY(0);
  adxl.setTapDetectionOnZ(1);
 
  //set values for what is a tap, and what is a double tap (0-255)
  adxl.setTapThreshold(50); //62.5mg per increment
  adxl.setTapDuration(15); //625μs per increment
  adxl.setDoubleTapLatency(80); //1.25ms per increment
  adxl.setDoubleTapWindow(200); //1.25ms per increment
 
  //set values for what is considered freefall (0-255)
  adxl.setFreeFallThreshold(7); //(5 - 9) recommended - 62.5mg per increment
  adxl.setFreeFallDuration(45); //(20 - 70) recommended - 5ms per increment
 
  //setting all interupts to take place on int pin 1
  //I had issues with int pin 2, was unable to reset it
  adxl.setInterruptMapping( ADXL345_INT_SINGLE_TAP_BIT,  ADXL345_INT1_PIN );
  adxl.setInterruptMapping( ADXL345_INT_DOUBLE_TAP_BIT,  ADXL345_INT1_PIN );
  adxl.setInterruptMapping( ADXL345_INT_FREE_FALL_BIT,    ADXL345_INT1_PIN );
  adxl.setInterruptMapping( ADXL345_INT_ACTIVITY_BIT,    ADXL345_INT1_PIN );
  adxl.setInterruptMapping( ADXL345_INT_INACTIVITY_BIT,  ADXL345_INT1_PIN );
 
  //register interupt actions - 1 == on; 0 == off 
  adxl.setInterrupt( ADXL345_INT_SINGLE_TAP_BIT, 1);
  adxl.setInterrupt( ADXL345_INT_DOUBLE_TAP_BIT, 1);
  adxl.setInterrupt( ADXL345_INT_FREE_FALL_BIT,  1);
  adxl.setInterrupt( ADXL345_INT_ACTIVITY_BIT,  1);
  adxl.setInterrupt( ADXL345_INT_INACTIVITY_BIT, 1);
}

void loop(){
 
  //Boring accelerometer stuff 
  int x,y,z; 
  adxl.readAccel(&x, &y, &z); //read the accelerometer values and store them in variables  x,y,z

  // Output x,y,z values - Commented out
  //Serial.print(x);
  //Serial.print(y);
  //Serial.println(z);
 
  //getInterruptSource clears all triggered actions after returning value
  //so do not call again until you need to recheck for triggered actions
  byte interrupts = adxl.getInterruptSource();
 
  // freefall
  if(adxl.triggered(interrupts, ADXL345_FREE_FALL)){
    Serial.println("freefall");
    //add code here to do when freefall is sensed
  }
 
  //inactivity
  if(adxl.triggered(interrupts, ADXL345_INACTIVITY)){
    Serial.println("inactivity");
    //add code here to do when inactivity is sensed
  }
 
  //activity
  if(adxl.triggered(interrupts, ADXL345_ACTIVITY)){
    Serial.println("activity");
    //add code here to do when activity is sensed
  }
 
  //double tap
  if(adxl.triggered(interrupts, ADXL345_DOUBLE_TAP)){
    Serial.println("double tap");
    //add code here to do when a 2X tap is sensed
  }
 
  //tap
  if(adxl.triggered(interrupts, ADXL345_SINGLE_TAP)){
    Serial.println("tap");
    //add code here to do when a tap is sensed
  }

 
}

---

سلام به همه دوستان
من میخام این ماژول رو با بسکام راه بندازم. کسی میتونه کمکم کنه؟ممنون میشم

یه سوال فنی با استفاده ار شتاب چه جوزی سرعت رو بدست می آرن ؟؟؟؟؟؟؟؟؟//
با استفاده از شتاب میشه مسافت طی شده بدست آورد؟؟؟؟؟؟؟؟//
چه جوری میشه خروجی هر کدوم از سنسور ها رو دید که فهمید دقیقا چه جوری خروجی میدن.؟؟؟؟

سلام
با یکبار انتگرال گیری از شتاب ، سرعت و با دوبار انتگرال گیری مسافت طی شده به دست میاد البته این روش بیشتر قابل استفاده در ربات های پرنده مثل هواپیما و یا زیردریایی هاست که نوسانات حرکتی کمتری دارند .
در مورد داده های سنسور ها اگر به کد نگاه بندازید متوجه میشین که هر کدام ب تفکیک قابل دسترس هست.

نقل قول:

---

نوشته اصلی توسط spark

سلام
با یکبار انتگرال گیری از شتاب ، سرعت و با دوبار انتگرال گیری مسافت طی شده به دست میاد البته این روش بیشتر قابل استفاده در ربات های پرنده مثل هواپیما و یا زیردریایی هاست که نوسانات حرکتی کمتری دارند .
در مورد داده های سنسور ها اگر به کد نگاه بندازید متوجه میشین که هر کدام ب تفکیک قابل دسترس هست.

---

خوب شتابی که شتاب سنج اندازه گیری می کنه، هم شتاب استاتیک ه (ناشی از گرانش) و هم شتاب دینامیک (ناشی از حرکت) خوب برای بدست آوردن سرعت و مکان باید از شتاب دینامیک خالص انتگرال گیری بشه! در صورتی که سنسور شتاب سنج مجموع دو شتاب دینامیک و استاتیک رو می ده! چجوری می شه فقط شتاب دینامیک رو اندازه گیری کرد!

در ضمن آیا کدهای موجود برای Ardu IMU برای این IMU کاربرد داره؟ مرسی

سلام
در حرکت های خطی و بدون نوسان شتاب گرانش یک مقدار ثابت هست برای همین میشه تفکیکش کرد

نقل قول:

---

نوشته اصلی توسط spark

سلام
در حرکت های خطی و بدون نوسان شتاب گرانش یک مقدار ثابت هست برای همین میشه تفکیکش کرد

---

اخه حرکت من خطی نیست! اونوقت باید چی کار کرد! مثلا برای یه کواد کپتر فرضا

نقل قول:

---

نوشته اصلی توسط spark

سلام
با یکبار انتگرال گیری از شتاب ، سرعت و با دوبار انتگرال گیری مسافت طی شده به دست میاد البته این روش بیشتر قابل استفاده در ربات های پرنده مثل هواپیما و یا زیردریایی هاست که نوسانات حرکتی کمتری دارند .
در مورد داده های سنسور ها اگر به کد نگاه بندازید متوجه میشین که هر کدام ب تفکیک قابل دسترس هست.

---

من زیاد از برنامه ها سر در نیاوردم .:(:(:(
منظورم از خروجی هر سنسور چه شکلیه این که اگر فرضاً به یک پورت ای سی ATMEGA وصلش کنیم و یک پورت دیگه ای ای سی هم به ال سی وصل باشه خروجی سنسور روی ال سی دی نشون داده می شه ؟؟؟؟
یا میشه خروجی هر سنسوری ریخت توی یه پورت ای سی بعد از اون پرت توی محاسبات انتگرال گیری استفاده کرد ؟؟؟/
راستی انتگرال رو چه جوری توی کدویژن می نویسن؟؟؟:confused:

با سلام
برای مکان یابی و تعیین مسافت در ربات ها می تونید از GPS یا سایر روش ها مثل Local Positioning استفاده کنید
این هم بد نیست مطالعه کنید:
Robotic mapping - Wikipedia, the free encyclopedia

نقل قول:

---

نوشته اصلی توسط yosoufe

اخه حرکت من خطی نیست! اونوقت باید چی کار کرد! مثلا برای یه کواد کپتر فرضا

---

با فرض اینکه سنسور حساسیت بالا و SNR خوبی داشته باشه، شما میتونید شتاب دینامیکی خالص رو بدست بیارید. کافیه مقدار نرمال شده شتاب گرانش زمین رو در ماتریس دوران (خروجی فیلتر شده ی IMU) ضرب کنید و این مقدار رو از مقدار خروجی شتاب سنج کم کنید. به زبان ساده تر فرض کنیم کواد 30 درجه در محور رول کچ شده و داره شتاب می گیره، برای حذف شتاب گرانش باید مقدار زاویه انحراف رو تو محاسبات وارد کنیم (g*sin30 برای محورy و z) و از خروجی محورهای شتاب کم کنیم.

اما در عمل سنسورهای mems یا حساسیت بالایی ندارند یا به نویز حساس هستند. بنابراین اینکه یخواید یا انتگرالگیری و این صحبتها از روی شتابسنج mems حتی سرعت رو تخمین بزنید عملی نیست! حالا چه برسه به دوبار انتگرال گیری و بدست آوردن موقعیت. تنها حالتی که میشه تا یه حدودی سرعت رو تخمین زد وقتی هست که اولا لرزش خیلی کم باشه و ثانیا شتاب قابل توجهی هم وجود داشته باشه (مثلا 0.5g). تنها با این شرایط میشه تو فاصله زمانی کوتاهی سرعت رو تخمین زد.

نقل قول:

---

نوشته اصلی توسط farzadsw

با فرض اینکه سنسور حساسیت بالا و SNR خوبی داشته باشه، شما میتونید شتاب دینامیکی خالص رو بدست بیارید. کافیه مقدار نرمال شده شتاب گرانش زمین رو در ماتریس دوران (خروجی فیلتر شده ی IMU) ضرب کنید و این مقدار رو از مقدار خروجی شتاب سنج کم کنید. به زبان ساده تر فرض کنیم کواد 30 درجه در محور رول کچ شده و داره شتاب می گیره، برای حذف شتاب گرانش باید مقدار زاویه انحراف رو تو محاسبات وارد کنیم (g*sin30 برای محورy و z) و از خروجی محورهای شتاب کم کنیم.

اما در عمل سنسورهای mems یا حساسیت بالایی ندارند یا به نویز حساس هستند. بنابراین اینکه یخواید یا انتگرالگیری و این صحبتها از روی شتابسنج mems حتی سرعت رو تخمین بزنید عملی نیست! حالا چه برسه به دوبار انتگرال گیری و بدست آوردن موقعیت. تنها حالتی که میشه تا یه حدودی سرعت رو تخمین زد وقتی هست که اولا لرزش خیلی کم باشه و ثانیا شتاب قابل توجهی هم وجود داشته باشه (مثلا 0.5g). تنها با این شرایط میشه تو فاصله زمانی کوتاهی سرعت رو تخمین زد.

---

ممنون از جوابت! آخه بدست آوردن زاویه هم داستان خودشو داره چون باید از خروجی جایرو باز انتگرال گرفت! درسته؟ این انتگرال گیری هم خطا داره و اشکال انتگرال هم اینه که این خطا ها رو با هم جمع می کنه!
جزوه آموزشی در این زمینه دارید؟ فیلتر ها چگونه اند؟ مرسی!

نقل قول:

---

نوشته اصلی توسط yosoufe

ممنون از جوابت! آخه بدست آوردن زاویه هم داستان خودشو داره چون باید از خروجی جایرو باز انتگرال گرفت! درسته؟ این انتگرال گیری هم خطا داره و اشکال انتگرال هم اینه که این خطا ها رو با هم جمع می کنه!
جزوه آموزشی در این زمینه دارید؟ فیلتر ها چگونه اند؟ مرسی!

---

در واقع از خروجی جایرو انتگرال گرفته میشه و با اطلاعات شتاب سنج (شتاب گرانش) ترکیب میشه. این ترکیبش روشهای مختلفی داره ولی روشی که ساده تره و محاسبات کمتری می خواد complementary filter هست که اغلب هم روی میکرو از همین استفاده می کنند. مثال آردوینو هم براش هست. عملکرد این فیلتر به طور خلاصه یه این صورته که زاویه جایرو (انتگرال گرفته شده) رو از یه فیلتر بالاگذر رد می کنه و زاویه شتاب سنج (زاویه از روی شتاب گرانش) رو از یه فیلتر پایین گذر و اینها رو با هم جمع می کنه. به این صورت نویز (فرکانس بالا) که تو خروجی شتابسنج زیاد هست حذف میشه و دیریفت جایرو (پاسخ دائمی) که به خاطر انتگرال گیری هست هم از بین میره. البته فرض این روش اینه که در مدت طولانی شتاب خطی دینامیکی زیادی نداریم. مثلا اگه کواد دائما با شتاب 0.5g به سمت شمال حرکت کنه خروجی زاویه فیلتر شده خطا خواهد داشت که مسلما در عمل برای سیستم های شناوری مثل کوادروتور همچین شتابی به صورت دائمی وجود نداره.

من جزوه خاصی ندارم، این مطالب رو از اینترنت و مقالات مختلف (انگلیسی) خوندم که همین complementary filter رو جستجو کنید مطلب در موردش زیاد هست. انتگرال گیری از جایرو سه محوره هم به وسیله DCM انچام میشه که همون ماتریس دوران هست.

سلام

اکه بخوایم از این قطعه توی APm2.6 استفاده کنیم، چه کاری باید انجام دهیم

آیا اتصال اون به وسله پورت I2C به APM کافی هستش؟

خیلی ممنون میشم اگه راهنماییتون رو به این آدرس بفرستید!

mfzavareh@hotmail.com

سلام
apm 2.6 آی ام یو مخصوص به خودش رو داره که سنسورهاش روی خود برد نصب شدن

دوستان کسی این سنسور رو بدون آردوینو راه انداخته و ازش خروجی گرفته باشه؟
من این کارو کردم ولی مشکلم توی قطب نما هست که نمیدونم چطوری زاویه رو میده
در واقع چون سه مولفه x,y,z رومیده زاویه اون در فضا یکه نیست. چظوری میتونم بفهمم کوادروتور توی چه جهتی هست؟
مرسی

ُسلام
برای اتصال این ماژول به آردوینو نانو هم باید مثل صفحه ی اول عملکرد؟برای ساخت فلایت کنترل می خوام
ممنون

سلام
بله ، نانو و uno تفاوت پین ندارن

سلام.برنامه ای که در صفحه اول قرار دادید در خروجی yaw میدهد. من برای پروژم نیاز به Heading یا azimuth دارم چیکار باید بکنم که خروجیم Heading یا azimuth بشه؟

با عرض سلام من کد های L3G4200D Tripple Axis Gyroscope
کپی کردم ودر نرم افزار اردینو پست کردم ولی وقتی ران می کنم سریال مانیتور چیزی نشون نمی ده ..... کمکم کنید ....

سلام

من یک مشکلی دارم
مشکل من در l3g4200d می باشد که وقتی کدها را بارگذاری میکنم مقادیر x,y,z مختلفی را نشان میده یعنی ثابت نیست کمکم کنید

سلام
تغییر ها در حد اعشار هست یا بیشتر؟

نقل قول:

---

نوشته اصلی توسط ehsan_1990

برای راه اندازی سنسور شتاب سنج نیاز به کتابخونه دارید Adxl345.zip
یه مثال جالب برای این سنسور پیدا کردم به این صورت که از این سنسور برای تشخیص وضعیت سکون ، حرکت ، وارد شدن ضربه به سنسور ، حس کردن ضربه دوبل و تشخیص سقوط آزاد میشه استفاده کرد.

کد:

---

#include <Wire.h>
#include <ADXL345.h>
ADXL345 adxl; //variable adxl is an instance of the ADXL345 library

void setup(){
  Serial.begin(9600);
  adxl.powerOn();

  //set activity/ inactivity thresholds (0-255)
  adxl.setActivityThreshold(75); //62.5mg per increment
  adxl.setInactivityThreshold(75); //62.5mg per increment
  adxl.setTimeInactivity(10); // how many seconds of no activity is inactive?
 
  //look of activity movement on this axes - 1 == on; 0 == off
  adxl.setActivityX(1);
  adxl.setActivityY(1);
  adxl.setActivityZ(1);
 
  //look of inactivity movement on this axes - 1 == on; 0 == off
  adxl.setInactivityX(1);
  adxl.setInactivityY(1);
  adxl.setInactivityZ(1);
 
  //look of tap movement on this axes - 1 == on; 0 == off
  adxl.setTapDetectionOnX(0);
  adxl.setTapDetectionOnY(0);
  adxl.setTapDetectionOnZ(1);
 
  //set values for what is a tap, and what is a double tap (0-255)
  adxl.setTapThreshold(50); //62.5mg per increment
  adxl.setTapDuration(15); //625μs per increment
  adxl.setDoubleTapLatency(80); //1.25ms per increment
  adxl.setDoubleTapWindow(200); //1.25ms per increment
 
  //set values for what is considered freefall (0-255)
  adxl.setFreeFallThreshold(7); //(5 - 9) recommended - 62.5mg per increment
  adxl.setFreeFallDuration(45); //(20 - 70) recommended - 5ms per increment
 
  //setting all interupts to take place on int pin 1
  //I had issues with int pin 2, was unable to reset it
  adxl.setInterruptMapping( ADXL345_INT_SINGLE_TAP_BIT,  ADXL345_INT1_PIN );
  adxl.setInterruptMapping( ADXL345_INT_DOUBLE_TAP_BIT,  ADXL345_INT1_PIN );
  adxl.setInterruptMapping( ADXL345_INT_FREE_FALL_BIT,    ADXL345_INT1_PIN );
  adxl.setInterruptMapping( ADXL345_INT_ACTIVITY_BIT,    ADXL345_INT1_PIN );
  adxl.setInterruptMapping( ADXL345_INT_INACTIVITY_BIT,  ADXL345_INT1_PIN );
 
  //register interupt actions - 1 == on; 0 == off 
  adxl.setInterrupt( ADXL345_INT_SINGLE_TAP_BIT, 1);
  adxl.setInterrupt( ADXL345_INT_DOUBLE_TAP_BIT, 1);
  adxl.setInterrupt( ADXL345_INT_FREE_FALL_BIT,  1);
  adxl.setInterrupt( ADXL345_INT_ACTIVITY_BIT,  1);
  adxl.setInterrupt( ADXL345_INT_INACTIVITY_BIT, 1);
}

void loop(){
 
  //Boring accelerometer stuff 
  int x,y,z; 
  adxl.readAccel(&x, &y, &z); //read the accelerometer values and store them in variables  x,y,z

  // Output x,y,z values - Commented out
  //Serial.print(x);
  //Serial.print(y);
  //Serial.println(z);
 
  //getInterruptSource clears all triggered actions after returning value
  //so do not call again until you need to recheck for triggered actions
  byte interrupts = adxl.getInterruptSource();
 
  // freefall
  if(adxl.triggered(interrupts, ADXL345_FREE_FALL)){
    Serial.println("freefall");
    //add code here to do when freefall is sensed
  }
 
  //inactivity
  if(adxl.triggered(interrupts, ADXL345_INACTIVITY)){
    Serial.println("inactivity");
    //add code here to do when inactivity is sensed
  }
 
  //activity
  if(adxl.triggered(interrupts, ADXL345_ACTIVITY)){
    Serial.println("activity");
    //add code here to do when activity is sensed
  }
 
  //double tap
  if(adxl.triggered(interrupts, ADXL345_DOUBLE_TAP)){
    Serial.println("double tap");
    //add code here to do when a 2X tap is sensed
  }
 
  //tap
  if(adxl.triggered(interrupts, ADXL345_SINGLE_TAP)){
    Serial.println("tap");
    //add code here to do when a tap is sensed
  }

 
}

---

---

سلام
فایل adxl345.h رو دقیقا چکار باید کرد که پیغام خطا "ADXL345_run.pde:23:21: fatal error: ADXL345.h: No such file or directory" مانع اجرا نشه؟
باتشکر

نقل قول:

---

نوشته اصلی توسط aiomf

سلام
فایل adxl345.h رو دقیقا چکار باید کرد که پیغام خطا "ADXL345_run.pde:23:21: fatal error: ADXL345.h: No such file or directory" مانع اجرا نشه؟
باتشکر

---

باید کتابخانه را به کتابخانه های arduino اضافه کنید.

نقل قول:

---

نوشته اصلی توسط pi.siqma

باید کتابخانه را به کتابخانه های arduino اضافه کنید.

---

هم فایل و هم خود adxl345.h رو اضافه کردم ولی بازم error میده. چیکار بایذ کرد؟

دارید یه جا توی add کردن اشتباه میکنید.
دقت کنید اسم کتابخوته دقیقا با اسم ولدری که توی libraries ریختید یکی باشه

نقل قول:

---

نوشته اصلی توسط ali_elect62

سلام.برنامه ای که در صفحه اول قرار دادید در خروجی yaw میدهد. من برای پروژم نیاز به heading یا azimuth دارم چیکار باید بکنم که خروجیم heading یا azimuth بشه؟

---

سلام

این کار ساده است،

اگر توجه کنید متوجه میشود که وجود و فلسفه مگنومتر دقیقا برای این کار است...

آزیموت یا با gps در می آوردند یا با مگنومتر ...

توصیه میکنم دیتا شت مگنومتر خودتون، یا دیتا شت های مگنومتر های هانی ول بخونید...

توجه کنید این سنسورهای بنجول چینی مفتشون گرونه چون بعدا که جلو میرید مبینید اینها اورتگنالیتی دارند و ....

توصیه میکنم با محصولات آمریکایی اسپارک فان شروع به کار کنید

راستی به جای استفاده از ماتریس کوسینوس های هادی بهتر است از کواترنیون ها استفاده کنید زیرا نقطه تکین در محاسبات ایجاد نمی کنند. زوایای ایولر هم به راحتی به واسته آنها قابل محاسبه است

کلا توصیه میکنم کتاب استاد معظم تیترتون را مطالعه کنید

نقل قول:

---

نوشته اصلی توسط farzadsw

با فرض اینکه سنسور حساسیت بالا و snr خوبی داشته باشه، شما میتونید شتاب دینامیکی خالص رو بدست بیارید. کافیه مقدار نرمال شده شتاب گرانش زمین رو در ماتریس دوران (خروجی فیلتر شده ی imu) ضرب کنید و این مقدار رو از مقدار خروجی شتاب سنج کم کنید. به زبان ساده تر فرض کنیم کواد 30 درجه در محور رول کچ شده و داره شتاب می گیره، برای حذف شتاب گرانش باید مقدار زاویه انحراف رو تو محاسبات وارد کنیم (g*sin30 برای محورy و z) و از خروجی محورهای شتاب کم کنیم.

اما در عمل سنسورهای mems یا حساسیت بالایی ندارند یا به نویز حساس هستند. بنابراین اینکه یخواید یا انتگرالگیری و این صحبتها از روی شتابسنج mems حتی سرعت رو تخمین بزنید عملی نیست! حالا چه برسه به دوبار انتگرال گیری و بدست آوردن موقعیت. تنها حالتی که میشه تا یه حدودی سرعت رو تخمین زد وقتی هست که اولا لرزش خیلی کم باشه و ثانیا شتاب قابل توجهی هم وجود داشته باشه (مثلا 0.5g). تنها با این شرایط میشه تو فاصله زمانی کوتاهی سرعت رو تخمین زد.

---

سلام، وقت بخیر

کاملا با صحبت شما مخالف هستم درباره دقت mems به صورت کلی ....

اگر شما خطا ها را به صورت صحیح مدل کنید، (یک نمونه مناسب آن در کتاب زیپل وجود دارد) و از یک فیلتر مناسب (کالمن و ... و نه فیلترهای ساده) به راحتی زوایای اویلر و سرعت را با دقت مناسب خواهید داشت، البته توجه کنید سخت افزار حرف اول را میزند ...

توصیه میکنم کتاب تیترون و بخشی انتهای فصل 5 زیفل را مطالعه کنید.

نقل قول:

---

نوشته اصلی توسط farzadsw

با فرض اینکه سنسور حساسیت بالا و snr خوبی داشته باشه، شما میتونید شتاب دینامیکی خالص رو بدست بیارید. کافیه مقدار نرمال شده شتاب گرانش زمین رو در ماتریس دوران (خروجی فیلتر شده ی imu) ضرب کنید و این مقدار رو از مقدار خروجی شتاب سنج کم کنید. به زبان ساده تر فرض کنیم کواد 30 درجه در محور رول کچ شده و داره شتاب می گیره، برای حذف شتاب گرانش باید مقدار زاویه انحراف رو تو محاسبات وارد کنیم (g*sin30 برای محورy و z) و از خروجی محورهای شتاب کم کنیم.

اما در عمل سنسورهای mems یا حساسیت بالایی ندارند یا به نویز حساس هستند. بنابراین اینکه یخواید یا انتگرالگیری و این صحبتها از روی شتابسنج mems حتی سرعت رو تخمین بزنید عملی نیست! حالا چه برسه به دوبار انتگرال گیری و بدست آوردن موقعیت. تنها حالتی که میشه تا یه حدودی سرعت رو تخمین زد وقتی هست که اولا لرزش خیلی کم باشه و ثانیا شتاب قابل توجهی هم وجود داشته باشه (مثلا 0.5g). تنها با این شرایط میشه تو فاصله زمانی کوتاهی سرعت رو تخمین زد.

---

سلام، وقت بخیر

کاملا با صحبت شما مخالف هستم درباره دقت mems به صورت کلی ....

اگر شما خطا ها را به صورت صحیح مدل کنید، (یک نمونه مناسب آن در کتاب زیپل وجود دارد) و از یک فیلتر مناسب (کالمن و ... و نه فیلترهای ساده) به راحتی زوایای اویلر و سرعت را با دقت مناسب خواهید داشت، البته توجه کنید سخت افزار حرف اول را میزند ...

توصیه میکنم کتاب تیترون و بخشی انتهای فصل 5 زیپفل را مطالعه کنید.

سلام
من برای مکان یابی در انتخاب بین دو ماژول GY-80 و MPU9250 موندم :angry:
دقت برام مهمترین چیزه
کسی با این دو ماژول کار کرده؟ کدوم دقیق تر و صحیحتره ؟

سلام من از برد due و اردینو 1.5.7 استفاده می کنم. موقع اجرای کدی که در صفحه اول برای AHRS قرار داده شده یه خطا به صورت زیر میده :
Arduino: 1.5.7 (Windows 8), Board: "Arduino Due (Programming Port)"

C:\Users\Mir\Documents\Arduino\libraries\Adafruit_ BMP085\Adafruit_BMP085.cpp:18:24: fatal error: util/delay.h: No such file or directory
#include <util/delay.h>
^
compilation terminated.

This report would have more information with
"Show verbose output during compilation"
enabled in File > Preferences.

کسی میدونه مشکل از کجاست؟

سلام دوستان
اگه بخوام یه قطب نمای دیجیتالی درست کنم خیلی سخته
خدایی کسی بلده راهنمایم کنه مرسی

سلام دوستان
به نظرتون برای یک فلایت کنترل اتوماتیک gy-80 بهتره یا cmps11 ؟ (از pid هم استفاده می کنم)
همیشه که گرونتره بهتر نیست !

نقل قول:

---

نوشته اصلی توسط smm

سلام من از برد due و اردینو 1.5.7 استفاده می کنم. موقع اجرای کدی که در صفحه اول برای AHRS قرار داده شده یه خطا به صورت زیر میده :
Arduino: 1.5.7 (Windows 8), Board: "Arduino Due (Programming Port)"

C:\Users\Mir\Documents\Arduino\libraries\Adafruit_ BMP085\Adafruit_BMP085.cpp:18:24: fatal error: util/delay.h: No such file or directory
#include <util/delay.h>
^
compilation terminated.

This report would have more information with
"Show verbose output during compilation"
enabled in File > Preferences.

کسی میدونه مشکل از کجاست؟

---

دوست من خودش که داره میگه چشه
با یکی ا کتابخونه ها مشکل داره.درستش کنید.

نقل قول:

---

نوشته اصلی توسط mohamad_ahmadi

سلام دوستان
اگه بخوام یه قطب نمای دیجیتالی درست کنم خیلی سخته
خدایی کسی بلده راهنمایم کنه مرسی

---

دوست من یه بچه سرچ بزنی کلی اطلاعات پیدا می کنی
Arduino Digital Magnetic Compass (HMC5883L - 2 display modes)
Arduino-er: HMC5883L library with calibration, for Arduino

یکی میشه جواب منو بده ؟
آیا ارزششو داره 50 بیشتر بدم تا از cmps11 استفاده کنم ؟