Hepta communication

Dependencies:   Hepta9axis HeptaBattery HeptaXbee mbed

Fork of Lab7-01_template by HEPTA-Sat Training 2017~2018

main.cpp

Committer:
HEPTA
Date:
2017-09-06
Revision:
13:75f99f3edf93
Parent:
10:4d6870d0caa0

File content as of revision 13:75f99f3edf93:

#include "mbed.h"
#include "HeptaXbee.h"
#include "Hepta9axis.h"
#include "HeptaBattery.h"

Serial pc(USBTX,USBRX);
HeptaXbee xbee(p9,p10);
Hepta9axis n_axis(p28,p27,0xD0,0x18);
HeptaBattery battery(p16,p26);

int main()
{
    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();
        }
    }
}