Lab5
Dependencies: mbed HeptaBattery Hepta9axis HeptaXbee
Diff: main.cpp
- Revision:
- 13:75f99f3edf93
- Parent:
- 10:4d6870d0caa0
--- a/main.cpp Tue Sep 05 17:15:38 2017 +0000 +++ b/main.cpp Wed Sep 06 04:37:24 2017 +0000 @@ -1,25 +1,42 @@ #include "mbed.h" -#include "SDFileSystem.h" #include "HeptaXbee.h" -#include "HeptaCamera_GPS.h" #include "Hepta9axis.h" -#include "HeptaTemp.h" #include "HeptaBattery.h" Serial pc(USBTX,USBRX); -SDFileSystem sd(p5, p6, p7, p8, "sd"); HeptaXbee xbee(p9,p10); -HeptaCamera_GPS cam_gps(p13, p14,p25,p24); Hepta9axis n_axis(p28,p27,0xD0,0x18); -HeptaTemp temp(p17); -HeptaBattery bat(p16,p26); - -DigitalOut myled(LED1); +HeptaBattery battery(p16,p26); int main() { - myled = 1; - wait(0.5); - myled = 0; - wait(0.5); + int i = 0,rcmd=0,cmdflag=0; + float bt,ax,ay,az; + xbee.printf("Count Up!\r\n"); + while(1) { + xbee.printf("num = %d\r\n",i); + i++; + wait(1.0); + xbee.xbee_recieve(&rcmd,&cmdflag); + pc.printf("rcmd=%d, cmdflag=%d\r\n",rcmd, cmdflag); + if (cmdflag == 1) { + if (rcmd == 'a') { + pc.printf("Command Get %d\r\n",rcmd); + xbee.printf("HEPTA Uplink OK\r\n"); + pc.printf("===================\r\n"); + pc.printf("Accel sensing Mode\r\n"); + pc.printf("===================\r\n"); + for(int ii = 0; ii < 10; ii++) { + n_axis.sen_acc(&ax,&ay,&az); + battery.vol(&bt); + xbee.printf("AX = %f\r\n",ax); + xbee.printf("AY = %f\r\n",ay); + xbee.printf("AZ = %f\r\n",az); + xbee.printf("V = %f\r\n",bt); + wait(0.5); + } + } + xbee.initialize(); + } + } } \ No newline at end of file