LSM303D
Dependencies: 4DGL-uLCD-SE mbed
Revision 0:479264cbb58d, committed 2015-05-14
- Comitter:
- shurjo_1234
- Date:
- Thu May 14 19:41:16 2015 +0000
- Commit message:
- Latest Version;
Changed in this revision
diff -r 000000000000 -r 479264cbb58d 4DGL-uLCD-SE.lib --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/4DGL-uLCD-SE.lib Thu May 14 19:41:16 2015 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/4180_1/code/4DGL-uLCD-SE/#e39a44de229a
diff -r 000000000000 -r 479264cbb58d LSM303D.lib --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/LSM303D.lib Thu May 14 19:41:16 2015 +0000 @@ -0,0 +1,1 @@ +http://developer.mbed.org/users/DrCoyle/code/LSM303D/#f186dd92c836
diff -r 000000000000 -r 479264cbb58d main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Thu May 14 19:41:16 2015 +0000 @@ -0,0 +1,101 @@ +#include "mbed.h" +#include "LSM303D.h" +#include <string> + +SPI spi(p5, p6, p7); // mosi, miso, sclk +//SPI spi(p11, p12, p13); + +Serial pc(USBTX, USBRX); // tx, rx + +LSM303D sensor1(spi,p15); +LSM303D sensor2(spi,p16); +LSM303D sensor3(spi,p17); +LSM303D sensor4(spi,p18); + +//LSM303D sensor1(spi,p27); +//LSM303D sensor2(spi,p28); +//LSM303D sensor3(spi,p29); +//LSM303D sensor4(spi,p30); + +DigitalOut myled1(LED1); +DigitalOut myled2(LED2); +DigitalOut myled3(LED3); +DigitalOut myled4(LED4); + + +int main() { + sensor1.initialize(); + sensor2.initialize(); + sensor3.initialize(); + sensor4.initialize(); + + int check[] = {0,0,0,0}; + + int a[] = {sensor1.magnitometer(0)+ sensor1.magnitometer(1)+ sensor1.magnitometer(2), + sensor2.magnitometer(0)+ sensor2.magnitometer(1)+ sensor2.magnitometer(2), + sensor3.magnitometer(0)+ sensor3.magnitometer(1)+ sensor3.magnitometer(2), + sensor4.magnitometer(0)+ sensor4.magnitometer(1)+ sensor4.magnitometer(2)}; + + int b[] = {sensor1.magnitometer(0)+ sensor1.magnitometer(1)+ sensor1.magnitometer(2), + sensor2.magnitometer(0)+ sensor2.magnitometer(1)+ sensor2.magnitometer(2), + sensor3.magnitometer(0)+ sensor3.magnitometer(1)+ sensor3.magnitometer(2), + sensor4.magnitometer(0)+ sensor4.magnitometer(1)+ sensor4.magnitometer(2)}; + + while (true) + { + for (int i=0; i<4; i++) + { + a[i] = b[i]; + } + + b[0] = sensor1.magnitometer(0)+ sensor1.magnitometer(1)+ sensor1.magnitometer(2); + b[1] = sensor2.magnitometer(0)+ sensor2.magnitometer(1)+ sensor2.magnitometer(2); + b[2] = sensor3.magnitometer(0)+ sensor3.magnitometer(1)+ sensor3.magnitometer(2); + b[3] = sensor4.magnitometer(0)+ sensor4.magnitometer(1)+ sensor4.magnitometer(2); + + for (int i=0; i<4; i++) + { + if (b[i] == a[i]) + check[i]++; + else + check[i]--; + + if (check[i] < -5) + check[i] = -5; + else if (check[i] >15) + check[i] = 15; + + + } + + + + if (check[0]<10) + myled1 = 1; + else + myled1 = 0; + + if (check[1]<10) + myled2 = 1; + else + myled2 = 0; + + if (check[2]<10) + myled3 = 1; + else + myled3 = 0; + + if (check[3]<10) + myled4 = 1; + else + myled4 = 0; + + wait(.01); + + //printf("%d,%d,%d,%d\n",check[0],check[1],check[2],check[3]); + + + } + + +} \ No newline at end of file
diff -r 000000000000 -r 479264cbb58d mbed.bld --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Thu May 14 19:41:16 2015 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed/builds/4fc01daae5a5 \ No newline at end of file