For Hepta-Sat Lite
HeptaXbee.cpp
- Committer:
- HEPTA
- Date:
- 2017-09-05
- Revision:
- 8:8e925f198e21
- Parent:
- 7:d07155a73b24
- Child:
- 9:96ed36bbc9dd
File content as of revision 8:8e925f198e21:
#include "HeptaXbee.h" #include "mbed.h" #include <stdarg.h> HeptaXbee::HeptaXbee(PinName tx, PinName rx) : xbee(tx,rx) { rcmd = 0; cmdflag = 0; } void HeptaXbee::baud(int rate) { xbee.baud(rate); } void HeptaXbee::xbee_recieve(int *xrcmd, int *xcmdflag) { xbee.attach(this,&HeptaXbee::commandget,Serial::RxIrq); //xbee.printf("ssXbeedata= %d,%d",HeptaXbee::rcmd,HeptaXbee::cmdflag); *xrcmd = HeptaXbee::rcmd; *xcmdflag = HeptaXbee::cmdflag; } void HeptaXbee::initialize() { HeptaXbee::rcmd = 0; HeptaXbee::cmdflag = 0; } void HeptaXbee::commandget() { HeptaXbee::rcmd=xbee.getc(); HeptaXbee::cmdflag = 1; //xbee.printf("Xbeedata= %d,%d",rcmd,cmdflag); } //*gyro×3 = A,B,C *Accel×3 = D,E,F *magnetic×3 = G,H,I *latitude = J *longitude = K *altitude = L *battery = M *temperature = N void HeptaXbee::xbee_transmit(char dataA[],char dataB[],char dataC[],char dataD[],char dataE[], char dataF[],char dataG[],char dataH[],char dataI[],char dataJ[], char dataK[],char dataL[],char dataM[],char dataN[]) { char OutputData[255]; int output_num,numA,numB,numC,numD,numE,numF,numG,numH,numI,numJ,numK,numL,numM,numN; numA = sizeof(dataA) / sizeof(dataA[0]); numB = sizeof(dataB) / sizeof(dataB[0]); numC = sizeof(dataC) / sizeof(dataC[0]); numD = sizeof(dataD) / sizeof(dataD[0]); numE = sizeof(dataE) / sizeof(dataE[0]); numF = sizeof(dataF) / sizeof(dataF[0]); numG = sizeof(dataG) / sizeof(dataG[0]); numH = sizeof(dataH) / sizeof(dataH[0]); numI = sizeof(dataI) / sizeof(dataI[0]); numJ = sizeof(dataJ) / sizeof(dataJ[0])*2; numK = sizeof(dataK) / sizeof(dataK[0])*2; numL = sizeof(dataL) / sizeof(dataL[0]); numM = sizeof(dataM) / sizeof(dataM[0]); numN = sizeof(dataN) / sizeof(dataN[0]); output_num=numA+numB+numC+numD+numE+numF+numG+numH+numI+numJ+numK+numL+numM+numN; int N=0,i=0,ii; for(i = 0; i <= numA-1; i++) { OutputData[N+i] = dataA[i]; } N=i; for(i = 0; i <= numB-1; i++) { OutputData[N+i] = dataB[i]; } N=N+i; for(i = 0; i <= numC-1; i++) { OutputData[N+i] = dataC[i]; } N=N+i; for(i = 0; i <= numD-1; i++) { OutputData[N+i] = dataD[i]; } N=N+i; for(i = 0; i <= numE-1; i++) { OutputData[N+i] = dataE[i]; } N=N+i; for(i = 0; i <= numF-1; i++) { OutputData[N+i] = dataF[i]; } N=N+i; for(i = 0; i <= numG-1; i++) { OutputData[N+i] = dataG[i]; } N=N+i; for(i = 0; i <= numH-1; i++) { OutputData[N+i] = dataH[i]; } N=N+i; for(i = 0; i <= numI-1; i++) { OutputData[N+i] = dataI[i]; } N=N+i; for(i = 0; i <= numJ-1; i++) { OutputData[N+i] = dataJ[i]; } N=N+i; for(i = 0; i <= numK-1; i++) { OutputData[N+i] = dataK[i]; } N=N+i; for(i = 0; i <= numL-1; i++) { OutputData[N+i] = dataL[i]; } N=N+i; for(i = 0; i <= numM-1; i++) { OutputData[N+i] = dataM[i]; } N=N+i; for(i = 0; i <= numN-1; i++) { OutputData[N+i] = dataN[i]; } for(ii=0; ii<output_num; ii++) { xbee.putc(OutputData[ii]); } xbee.putc(0x0a); } void HeptaXbee::puts( char *s ) { while ( char c = *s++ ) xbee.putc( c ); } void HeptaXbee::printf( char *format, ... ) { char s[ 100 ]; va_list args; va_start( args, format ); vsnprintf( s, 100, format, args ); va_end( args ); xbee.puts( s ); } char HeptaXbee::getc() { char character; character = xbee.getc(); return character; } void HeptaXbee::putc(char data) { xbee.putc(data); }