You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
39 lines
836 B
39 lines
836 B
6 years ago
|
//TestG521.ino affichage TerSer
|
||
|
|
// 1g is given as 16384
|
||
|
|
#define aadd 0x68*2 // adresse 8bits du 6050 .. a faire mieux
|
||
|
|
|
||
|
|
// déf et variables globales
|
||
|
|
int16_t GyX,GyY,GyZ;
|
||
|
|
int16_t AcX,AcY,AcZ;
|
||
|
|
|
||
|
|
#include "Witty.h"
|
||
|
|
#include "TerSer.h"
|
||
|
|
#include "I2Ctwi.h"
|
||
|
|
#include "Gy521.h"
|
||
|
|
|
||
|
|
void setup() {
|
||
|
|
SetupWitty();
|
||
|
|
SetupI2Ctwi();
|
||
|
|
SetupGy521();
|
||
|
|
SetupTerSer();
|
||
|
|
}
|
||
|
|
|
||
|
|
int var;
|
||
|
|
void loop() {
|
||
|
|
DelMs(1000); //Wait 1s for stabilisation
|
||
|
|
Text("Gy521 values"); CR();
|
||
|
|
int16_t AcX,AcY,AcZ;
|
||
|
|
while(1){
|
||
|
|
AcX=ReadWordAt(0x3B); //Accelerometer
|
||
|
|
AcY=ReadWordAt(0x3D);
|
||
|
|
AcZ=ReadWordAt(0x3F);
|
||
|
|
|
||
|
|
Text(" AcX= "); Dec16s(AcX);
|
||
|
|
Text(" AcY= "); Dec16s(AcY);
|
||
|
|
Text(" AcZ= "); Dec16s(AcZ);
|
||
|
|
CR();
|
||
|
|
DelMs (500);
|
||
|
|
} // end while
|
||
|
|
} // end loop
|
||
|
|
|