diff --git a/examples/TestGlis.ino b/examples/TestGlis.ino new file mode 100644 index 0000000..608687b --- /dev/null +++ b/examples/TestGlis.ino @@ -0,0 +1,37 @@ +//TestGlis.ino Display values and average +//use TerSer +#define aadd 0x68*2 // adresse 8bits du 6050 .. a faire mieux + +// variables AcX ... defined in Gy521.h +volatile int16_t iniAcZ,mAcZ; +volatile int16_t iniGyX,mGyX; +volatile int16_t acumAcZ; + +#include "Witty.h" +#include "TerSer.h" +#include "I2Ctwi.h" +#include "Gy521.h" +#include "Glis.h" + +void setup() { + SetupWitty(); + SetupI2Ctwi(); + SetupGy521(); + SetupTerSer(); + DelMs(1000); // Put in place/stabilization time + AcZ=ReadWordAt(0x3F); + IniGlis1(AcZ); iniAcZ=AcZ; + GyX=ReadWordAt(0x43); + IniGlis2(GyX); iniGyX=GyX; +} + +void loop() { + Text("Gy521 initial values"); CR(); + Text("iniAcZ "); Dec16s(iniAcZ); Text(" iniGyX "); Dec16s(iniGyX); CR(); + while(1){ + AcZ=ReadWordAt(0x3F); GyX=ReadWordAt(0x43); + Text(" AcZ "); Dec16s(AcZ); Dec8s((AcZ-iniAcZ)/16); Text("%%"); + Text(" GyX "); Dec16s(GyX); Dec8s((GyX-iniGyX)/16); Text("%%"); CR(); + DelMs (500); + } // end while +} // end loop