]> Pileus Git - ~andy/csm213a-hw/blob - hw1/mbed.cc
Add initial hw1 stuff
[~andy/csm213a-hw] / hw1 / mbed.cc
1 #include "mbed.h"
2 #include "tsi.h"
3 #include "acc.h"
4 #include "mag.h"
5
6 /* Sensors:
7  *   accel [x,y,z]
8  *   compas
9  *   light
10  *   slider 
11  *   a2d[6]
12  */
13
14 #define ACC_ADDR (0x1D<<1)
15 #define MAG_ADDR (0x1D)    // FIXME
16
17 DigitalOut led1(LED1);
18 DigitalOut led2(LED2);
19 MMA8451Q   acc(PTE25, PTE24, ACC_ADDR);
20 MAG3110    mag(PTE25, PTE24, MAG_ADDR);
21 TSISensor  tsi;
22
23 static int state = 0;
24
25 int main(int argc, char **argv)
26 {
27         printf("Starting...\r\n");
28         while (1) {
29                 int chr = getchar();
30                 putchar(chr);
31
32                 printf("tsi: [%d]\r\n",
33                                 tsi.readDistance());
34                 printf("acc: [%d,%d,%d]\r\n",
35                                 acc.getAccX(),
36                                 acc.getAccY(),
37                                 acc.getAccZ());
38                 printf("mag: [%d,%d,%d]\r\n",
39                                 mag.getMagX(),
40                                 mag.getMagY(),
41                                 mag.getMagZ());
42
43                 led2 = state;
44                 state ^= 1;
45         }
46         return 0;
47 }