Contador de pasos

Dependencies:   MMA8451Q mbed

Committer:
gilbertogn
Date:
Sun Feb 14 04:22:30 2016 +0000
Revision:
11:49b4472e155f
Parent:
8:bf6fa71e6999
me marca eerores en pc

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gilbertogn 11:49b4472e155f 1 #include "mbed.h"
gilbertogn 11:49b4472e155f 2 #include "mbed.h"
gilbertogn 11:49b4472e155f 3 #include "MMA8451Q.h"
gilbertogn 11:49b4472e155f 4
gilbertogn 11:49b4472e155f 5 #define MMA8451_I2C_ADDRESS (0x1d<<1)
gilbertogn 11:49b4472e155f 6 int contador;
gilbertogn 11:49b4472e155f 7 int main(void)
gilbertogn 11:49b4472e155f 8 {
gilbertogn 11:49b4472e155f 9 MMA8451Q acc(PTE25, PTE24, MMA8451_I2C_ADDRESS);
gilbertogn 11:49b4472e155f 10 PwmOut rled(LED_RED); // x y z
gilbertogn 11:49b4472e155f 11 PwmOut gled(LED_GREEN);
gilbertogn 11:49b4472e155f 12 PwmOut bled(LED_BLUE); // 4096 count/g, 2048 count/g, 1024 count/g
gilbertogn 11:49b4472e155f 13 // pc.baud(9600);
gilbertogn 11:49b4472e155f 14 //pc.format(8,SerialBase::None,1);
gilbertogn 11:49b4472e155f 15 pc.putc();
gilbertogn 11:49b4472e155f 16 while (true) {
gilbertogn 11:49b4472e155f 17 rled = 1.0 - abs(acc.getAccX());
gilbertogn 11:49b4472e155f 18 gled = 1.0 - abs(acc.getAccY());
gilbertogn 11:49b4472e155f 19 bled = 1.0 - abs(acc.getAccZ());
gilbertogn 11:49b4472e155f 20 wait(0.1);
gilbertogn 11:49b4472e155f 21
gilbertogn 11:49b4472e155f 22 if(1024>bled) {
gilbertogn 11:49b4472e155f 23 contador++;
gilbertogn 11:49b4472e155f 24 pc.printf("PASO NUMERO%\n",contador);
gilbertogn 11:49b4472e155f 25 } else {
gilbertogn 11:49b4472e155f 26 if(1024<bled) {
gilbertogn 11:49b4472e155f 27 pc.printf("NINGUN PASO%d\n",contador);
gilbertogn 11:49b4472e155f 28
gilbertogn 11:49b4472e155f 29
gilbertogn 11:49b4472e155f 30 }
gilbertogn 11:49b4472e155f 31 }
gilbertogn 11:49b4472e155f 32 /*
gilbertogn 7:c5947c4d9dd5 33 #ifndef GILBERTO
gilbertogn 7:c5947c4d9dd5 34 #define GILBERTO
gilbertogn 7:c5947c4d9dd5 35 #include "mbed.h"
gilbertogn 11:49b4472e155f 36 #include "MMA8451Q.h"
gilbertogn 11:49b4472e155f 37
gilbertogn 11:49b4472e155f 38
gilbertogn 11:49b4472e155f 39 Serial serial1 (USBTX, USBRX);
gilbertogn 11:49b4472e155f 40 MMA8451Q
gilbertogn 11:49b4472e155f 41
gilbertogn 11:49b4472e155f 42 DigitalOut myled(LED1);
gilbertogn 11:49b4472e155f 43
gilbertogn 11:49b4472e155f 44 Serial pc (USBTX, USBRX);
gilbertogn 11:49b4472e155f 45 MMA8451Q acc(PTE25, PTE24);
gilbertogn 11:49b4472e155f 46 PwmOut rled(LED_RED);
gilbertogn 11:49b4472e155f 47 PwmOut gled(LED_GREEN);
gilbertogn 11:49b4472e155f 48 PwmOut bled(LED_BLUE);
gilbertogn 11:49b4472e155f 49 int16_t data [3];
gilbertogn 11:49b4472e155f 50
gilbertogn 11:49b4472e155f 51 int cont,z;
gilbertogn 11:49b4472e155f 52
gilbertogn 11:49b4472e155f 53 int cont1,cont,z;
gilbertogn 11:49b4472e155f 54
gilbertogn 11:49b4472e155f 55
gilbertogn 11:49b4472e155f 56 int main() {
gilbertogn 11:49b4472e155f 57 pc.baud(9600);
gilbertogn 11:49b4472e155f 58
gilbertogn 11:49b4472e155f 59 // serial1.printf("%d\n",data[0]);
gilbertogn 11:49b4472e155f 60 // serial1.printf("%d\n",data[1]);
gilbertogn 11:49b4472e155f 61
gilbertogn 11:49b4472e155f 62 pc.printf("%d\n",data[2]);
gilbertogn 11:49b4472e155f 63
gilbertogn 11:49b4472e155f 64 pc.printf("%d\n",data[2]);
gilbertogn 11:49b4472e155f 65
gilbertogn 11:49b4472e155f 66
gilbertogn 11:49b4472e155f 67
gilbertogn 11:49b4472e155f 68 // rled = 1.0 - abs(data[0]/17000.0);
gilbertogn 11:49b4472e155f 69
gilbertogn 11:49b4472e155f 70 // rled1.0 - abs(data[0]/10.0);
gilbertogn 11:49b4472e155f 71
gilbertogn 11:49b4472e155f 72 // gled = 1.0 - abs(data[1]/17000.0);
gilbertogn 11:49b4472e155f 73
gilbertogn 11:49b4472e155f 74 z=bled = 1.0 - abs(data[2]/17000.0);
gilbertogn 11:49b4472e155f 75
gilbertogn 11:49b4472e155f 76 z= 1.0 - abs(data[2]/10.0);
gilbertogn 11:49b4472e155f 77
gilbertogn 11:49b4472e155f 78 wait(0.4);
gilbertogn 11:49b4472e155f 79
gilbertogn 11:49b4472e155f 80
gilbertogn 11:49b4472e155f 81
gilbertogn 11:49b4472e155f 82 }}
gilbertogn 11:49b4472e155f 83
gilbertogn 11:49b4472e155f 84 if(-4000>data[2]){
gilbertogn 11:49b4472e155f 85 cont1++;
gilbertogn 11:49b4472e155f 86 pc.printf("%d\n",cont1);
gilbertogn 11:49b4472e155f 87 if(-4000<data[2])
gilbertogn 11:49b4472e155f 88 pc.printf("%d\n",0);
gilbertogn 11:49b4472e155f 89 //}else{
gilbertogn 11:49b4472e155f 90 // cont=0;
gilbertogn 11:49b4472e155f 91
gilbertogn 11:49b4472e155f 92 }}}
gilbertogn 11:49b4472e155f 93
gilbertogn 7:c5947c4d9dd5 94
gilbertogn 7:c5947c4d9dd5 95
gilbertogn 11:49b4472e155f 96
gilbertogn 11:49b4472e155f 97
gilbertogn 7:c5947c4d9dd5 98 #endif
gilbertogn 11:49b4472e155f 99 */