Stap 3: Code:
De code van de deeltjes voor MPU-6000 kan worden gedownload van onze github archief-ControlEverythingCommunity
Hier is de link voor hetzelfde:
https://github.com/ControlEverythingCommunity/MPU-...
Het gegevensblad van MPU-6000 kan hier worden gevonden:
https://S3.amazonaws.com/controleverything.Media/c...
Wij hebben twee bibliotheken gebruikt voor particle code, die application.h en spark_wiring_i2c.h. Spark_wiring_i2c bibliotheek is vereist om de I2C communicatie met de sensor.
U kunt ook de code kopiëren vanaf hier, het wordt als volgt gegeven:
Gedistribueerd met een licentie van de vrije wil.
Gebruik het elke manier wilt u, op de winst of het gratis, mits het past in de licenties van de bijbehorende werken.
MPU-6000
Deze code is ontworpen om te werken met de MPU-6000_I2CS I2C Mini Module beschikbaar vanaf ControlEverything.com.
https://www.controleverything.com/content/Accelor...
#include < application.h >
#include < spark_wiring_i2c.h >
MPU-6000 I2C adres is 0x68(104)
#define Addr 0x68
int xGyro = 0, yGyro = 0, zGyro = 0, xAccl = 0, yAccl = 0, zAccl = 0;
VOID Setup
{
Variabele instellen
Particle.variable ("i2cdevice", "MPU-6000");
Particle.variable ("xAccl", xAccl);
Particle.variable ("yAccl", yAccl);
Particle.variable ("zAccl", zAccl);
Particle.variable ("xGyro", xGyro);
Particle.variable ("yGyro", yGyro);
Particle.variable ("zGyro", zGyro);
I2C communicatie als Master initialiseren
Wire.begin();
Initialiseren van seriële communicatie, set baud-rate = 9600
Serial.begin(9600);
I2C-overdracht starten
Wire.beginTransmission(Addr);
Selecteer gyroscoop configuratie register
Wire.write(0x1B);
Bereik van het volledige schaalbereik = 2000 dps
Wire.write(0x18);
Stop I2C transmissie
Wire.endTransmission();
I2C-overdracht starten
Wire.beginTransmission(Addr);
Selecteer versnellingsmeter configuratie register
Wire.write(0x1C);
Bereik van het volledige schaalbereik = +/-16g
Wire.write(0x18);
Stop I2C transmissie
Wire.endTransmission();
I2C-overdracht starten
Wire.beginTransmission(Addr);
Selecteer energiebeheer registreren
Wire.write(0x6B);
PLL met xGyro referentie
Wire.write(0x01);
Stop I2C transmissie
Wire.endTransmission();
delay(300);
}
void loop
{
unsigned int gegevens [6];
I2C-overdracht starten
Wire.beginTransmission(Addr);
Selecteer gegevens registreren
Wire.write(0x3B);
Stop I2C transmissie
Wire.endTransmission();
6 bytes aan gegevens aanvragen
Wire.requestFrom (Addr, 6);
Lees 6 byte van de gegevens
Als (Wire.available() == 6)
{
gegevens [0] = Wire.read();
gegevens [1] = Wire.read();
gegevens [2] = Wire.read();
gegevens [3] = Wire.read();
gegevens [4] = Wire.read();
gegevens [5] = Wire.read();
}
delay(800);
De gegevens converteren
xAccl = ((gegevens [1] * 256) + data[0]);
Als (xAccl > 32767)
{
xAccl-= 65536;
}
yAccl = ((gegevens [3] * 256) + data[2]);
Als (yAccl > 32767)
{
yAccl-= 65536;
}
zAccl = ((gegevens [5] * 256) + data[4]);
Als (zAccl > 32767)
{
zAccl-= 65536;
}
delay(800);
I2C-overdracht starten
Wire.beginTransmission(Addr);
Selecteer gegevens registreren
Wire.write(0x43);
Stop I2C transmissie
Wire.endTransmission();
6 bytes aan gegevens aanvragen
Wire.requestFrom (Addr, 6);
Lees 6 byte van de gegevens
Als (Wire.available() == 6)
{
gegevens [0] = Wire.read();
gegevens [1] = Wire.read();
gegevens [2] = Wire.read();
gegevens [3] = Wire.read();
gegevens [4] = Wire.read();
gegevens [5] = Wire.read();
}
delay(800);
De gegevens converteren
xGyro = ((gegevens [1] * 256) + data[0]);
Als (xGyro > 32767)
{
xGyro-= 65536;
}
yGyro = ((gegevens [3] * 256) + data[2]);
Als (yGyro > 32767)
{
yGyro-= 65536;
}
zGyro = ((gegevens [5] * 256) + data[4]);
Als (zGyro > 32767)
{
zGyro-= 65536;
}
delay(800);
Uitvoergegevens naar dashboard
Particle.publish ("versnelling van de x-as:", String(xAccl));
Particle.publish ("versnelling van de y-as:", String(yAccl));
Particle.publish ("versnelling in de z-as:", String(zAccl));
delay(1000);
Particle.publish ("x-as van rotatie:", String(xGyro));
Particle.publish ("y-as van rotatie:", String(yGyro));
Particle.publish ("z-as van rotatie:", String(zGyro));
delay(1000);
}