MPU9250 Arduino Simple Code: Difference between revisions

From wikiluntti
 
(7 intermediate revisions by the same user not shown)
Line 1: Line 1:
== Introduction ==
== Introduction ==


MPU9250 Simple code  
MPU9250 Simple code
 
NOTE: MPU9250 is 3.3V device, so it might break if connected wrong. Double check that Arduino's +5 V is on VCC. Doublecheck that SCL and SCA are on the Analog inputs, and do not push current into those pins. See more at https://electronics.stackexchange.com/questions/492792/does-the-mpu9250-require-a-5-to-3-3-v-level-shifter-when-used-with-arduino-uno
 
NOTE: delay() do not work with MPU9250.h used below!


== The simple code ==  
== The simple code ==  
Line 167: Line 171:
</syntaxhighlight>
</syntaxhighlight>


== Code 3d ==
== Code 3: Implement delay() ==
 
== Code MPU6500 The smaller ==


<syntaxhighlight lang="C">
<syntaxhighlight lang="C">
/***************************************************************************
#include "MPU9250.h"
* Example sketch for the MPU6500_WE library
* For further information visit:
* https://wolles-elektronikkiste.de/en/mpu9250-9-axis-sensor-module-part-1  (English)
***************************************************************************/


#include <MPU6500_WE.h>
MPU9250 mpu;
#include <Wire.h>
#define MPU6500_ADDR 0x68


MPU6500_WE myMPU6500 = MPU6500_WE(MPU6500_ADDR);
const int buzzer = 9; //buzzer to arduino pin 9


void setup() {
void setup(){
  pinMode(buzzer, OUTPUT); // Set buzzer - pin 9 as an output
   Serial.begin(115200);
   Serial.begin(115200);
   Wire.begin();
   Wire.begin();
   if(!myMPU6500.init()){
  delay(2000);
    Serial.println("MPU6500 does not respond");
 
   }
   if (!mpu.setup(0x68)) { // change to your own address
  else{
      while (1) {
     Serial.println("MPU6500 is connected");
          Serial.println("MPU connection failed. Please check your connection with `connection_check` example.");
  }
          delay(5000);
      }
   }  
}
 
int fi = 100;
 
void loop(){
 
     if (mpu.update()) {
        static uint32_t prev_ms = millis();
        if (millis() > prev_ms + 25) {
            print_roll_pitch_yaw();
            prev_ms = millis();
        }
    }
    
    
  Serial.println("Position you MPU6500 flat and don't move it - calibrating...");
    tone(buzzer, fi); // Send sound signal...
  delay(1000);
    static uint32_t prev_ms_sound = millis();
  myMPU6500.autoOffsets();
    if (millis() > prev_ms_sound + 100) {
  Serial.println("Done!");
      noTone(buzzer);
 
      fi += 100;  
  myMPU6500.enableGyrDLPF();
      prev_ms_sound = millis();
  //myMPU6500.disableGyrDLPF(MPU6500_BW_WO_DLPF_8800); // bandwdith without DLPF
      if (fi > 10000){
        fi = 100;
  /*  Sample rate divider divides the output rate of the gyroscope and accelerometer.
      }
  *  Sample rate = Internal sample rate / (1 + divider)  
    }
  *  It can only be applied if the corresponding DLPF is enabled and 0<DLPF<7!
  *  Divider is a number 0...255
  */
  myMPU6500.setSampleRateDivider(5);
  myMPU6500.setGyrRange(MPU6500_GYRO_RANGE_250);
  myMPU6500.setAccRange(MPU6500_ACC_RANGE_2G);
  myMPU6500.enableAccDLPF(true);


  delay(200);
}
}


void loop() {
</syntaxhighlight>
   xyzFloat gValue = myMPU6500.getGValues();
 
   float temp = myMPU6500.getTemperature();
== Code 4a ==
 
== Code MPU6050 The smaller ==
 
Code from https://www.arduinolearning.com/code/arduino-mpu6500-6-axis-motion-tracking-device.php
 
<syntaxhighlight lang="C">
#include "Wire.h"
#include "I2Cdev.h"
#include "MPU6050.h"
 
MPU6050 accelgyro;
 
int16_t ax, ay, az;
int16_t gx, gy, gz;
 
#define LED_PIN 13
bool blinkState = false;
 
void setup() {
   Wire.begin();
  Serial.begin(38400);
 
  Serial.println("Initializing I2C devices...");
  accelgyro.initialize();
 
  Serial.println("Testing device connections...");
   Serial.println(accelgyro.testConnection() ? "MPU6050 connection successful" : "MPU6050 connection failed");


   Serial.println("Acceleration in g (x,y,z):");
   pinMode(LED_PIN, OUTPUT);
  Serial.print(gValue.x);
}
  Serial.print("  ");
  Serial.print(gValue.y);
  Serial.print("  ");
  Serial.println(gValue.z);


  Serial.print("Temperature in °C: ");
void loop() {
   Serial.println(temp);
   accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);


   Serial.println("********************************************");
  Serial.print(ax); Serial.print("\t");
  Serial.print(ay); Serial.print("\t");
   Serial.println(az); Serial.print("\t");


   delay(1000);
   // blink LED to indicate activity
  blinkState = !blinkState;
  digitalWrite(LED_PIN, blinkState);
}
}
</syntaxhighlight>
</syntaxhighlight>

Latest revision as of 17:03, 22 November 2024

Introduction

MPU9250 Simple code

NOTE: MPU9250 is 3.3V device, so it might break if connected wrong. Double check that Arduino's +5 V is on VCC. Doublecheck that SCL and SCA are on the Analog inputs, and do not push current into those pins. See more at https://electronics.stackexchange.com/questions/492792/does-the-mpu9250-require-a-5-to-3-3-v-level-shifter-when-used-with-arduino-uno

NOTE: delay() do not work with MPU9250.h used below!

The simple code

This is very similar to that given in https://github.com/hideakitai/MPU9250

#include "MPU9250.h"

MPU9250 mpu;

void setup() {
    Serial.begin(115200);
    Wire.begin();
    delay(2000);

    if (!mpu.setup(0x68)) {  // change to your own address
        while (1) {
            Serial.println("MPU connection failed. Please check your connection with `connection_check` example.");
            delay(5000);
        }
    }
}

void loop() {
    if (mpu.update()) {
        static uint32_t prev_ms = millis();
        if (millis() > prev_ms + 25) {
            print_roll_pitch_yaw();
            prev_ms = millis();
        }
    }
}

void print_roll_pitch_yaw() {
    Serial.print("Yaw, Pitch, Roll: ");
    Serial.print(mpu.getYaw(), 2);
    Serial.print(", ");
    Serial.print(mpu.getPitch(), 2);
    Serial.print(", ");
    Serial.println(mpu.getRoll(), 2);
}

Code 2

Simple, given by Fabo

/**
 Original: @file read9axis.ino 
 @brief This is an Example for the FaBo 9Axis I2C Brick. 
 http://fabo.io/202.html
 Released under APACHE LICENSE, VERSION 2.0
 @author FaBo<info@fabo.io>
*/

#include <Wire.h>
#include <FaBo9Axis_MPU9250.h>

FaBo9Axis fabo_9axis;

void setup() {
  Serial.begin(115200);
  Serial.println("RESET");
  Serial.println();

  Serial.println("configuring device.");

  if (fabo_9axis.begin()) {
    Serial.println("configured FaBo 9Axis I2C Brick");
  } else {
    Serial.println("device error");
    while(1);
  }
}

void loop() {
  float ax,ay,az;

  fabo_9axis.readAccelXYZ(&ax,&ay,&az);

  Serial.print("ax: ");
  Serial.print(ax);
  Serial.print(" ay: ");
  Serial.print(ay);
  Serial.print(" az: ");
  Serial.println(az);

  delay(1000);
}


Code 2b

Add temperature and other data.

/**
 Original: @file read9axis.ino 
 @brief This is an Example for the FaBo 9Axis I2C Brick. 
 http://fabo.io/202.html
 Released under APACHE LICENSE, VERSION 2.0
 @author FaBo<info@fabo.io>
*/

#include <Wire.h>
#include <FaBo9Axis_MPU9250.h>

FaBo9Axis fabo_9axis;

void setup() {
  Serial.begin(115200);
  Serial.println("RESET");
  Serial.println();

  Serial.println("configuring device.");

  if (fabo_9axis.begin()) {
    Serial.println("configured FaBo 9Axis I2C Brick");
  } else {
    Serial.println("device error");
    while(1);
  }
}

void loop() {
  float ax,ay,az;
  float gx,gy,gz;
  float mx,my,mz;
  float temp;

  fabo_9axis.readAccelXYZ(&ax,&ay,&az);
  fabo_9axis.readGyroXYZ(&gx,&gy,&gz);
  fabo_9axis.readMagnetXYZ(&mx,&my,&mz);
  fabo_9axis.readTemperature(&temp);

  Serial.print("ax: ");
  Serial.print(ax);
  Serial.print(" ay: ");
  Serial.print(ay);
  Serial.print(" az: ");
  Serial.println(az);

  Serial.print("gx: ");
  Serial.print(gx);
  Serial.print(" gy: ");
  Serial.print(gy);
  Serial.print(" gz: ");
  Serial.println(gz);

  Serial.print("mx: ");
  Serial.print(mx);
  Serial.print(" my: ");
  Serial.print(my);
  Serial.print(" mz: ");
  Serial.println(mz);

  Serial.print("temp: ");
  Serial.println(temp);

  delay(1000);
}

Code 3: Implement delay()

#include "MPU9250.h"

MPU9250 mpu;

const int buzzer = 9; //buzzer to arduino pin 9

void setup(){
  pinMode(buzzer, OUTPUT); // Set buzzer - pin 9 as an output
  Serial.begin(115200);
  Wire.begin();
  delay(2000);

  if (!mpu.setup(0x68)) {  // change to your own address
      while (1) {
          Serial.println("MPU connection failed. Please check your connection with `connection_check` example.");
          delay(5000);
      }
  } 
}

int fi = 100;

void loop(){

    if (mpu.update()) {
        static uint32_t prev_ms = millis();
        if (millis() > prev_ms + 25) {
            print_roll_pitch_yaw();
            prev_ms = millis();
        }
    }
  
    tone(buzzer, fi); // Send sound signal...
    static uint32_t prev_ms_sound = millis();
    if (millis() > prev_ms_sound + 100) {
      noTone(buzzer);
      fi += 100;    
      prev_ms_sound = millis();
      if (fi > 10000){
        fi = 100;
      }
    }

}

Code 4a

Code MPU6050 The smaller

Code from https://www.arduinolearning.com/code/arduino-mpu6500-6-axis-motion-tracking-device.php

#include "Wire.h"
#include "I2Cdev.h"
#include "MPU6050.h"

MPU6050 accelgyro;

int16_t ax, ay, az;
int16_t gx, gy, gz;

#define LED_PIN 13
bool blinkState = false;

void setup() {
  Wire.begin();
  Serial.begin(38400);

  Serial.println("Initializing I2C devices...");
  accelgyro.initialize();

  Serial.println("Testing device connections...");
  Serial.println(accelgyro.testConnection() ? "MPU6050 connection successful" : "MPU6050 connection failed");

  pinMode(LED_PIN, OUTPUT);
}

void loop() {
  accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);

  Serial.print(ax); Serial.print("\t");
  Serial.print(ay); Serial.print("\t");
  Serial.println(az); Serial.print("\t");

  // blink LED to indicate activity
  blinkState = !blinkState;
  digitalWrite(LED_PIN, blinkState);
}