#include "mbed.h"
#include "xbee.h"          //xbee library
#include "C12832_lcd.h"    //new applications board library
 #include "MSCFileSystem.h"
 
MSCFileSystem fs("fs");
C12832_LCD lcd;         //initialise lcd screen
xbee xbee1(p9,p10,p11); //Initalise xbee_lib
Serial pc(USBTX, USBRX); //Initalise PC serial comms
void returnSomeData();
void clearBuf(char *p);
void tickFn(void);
int flag=0;
Ticker t;
int cnt=0;

void tickFn(void)
{
    flag=1;
    cnt++;
}

int main()
{
    t.attach(&tickFn,5);
    FILE *fp = fopen("/fs/test.csv","w");
    printf("Create filehandle for test.csv\n");
 
    while(1) {
        
       char read_data[202];
       clearBuf(read_data);
        xbee1.RecieveData(read_data, 0); //Read data from the XBee
               lcd.cls();
    
        printf("Bytes received is: %i\n",strlen(read_data));
        lcd.printf("Value Received: %s  \n",read_data); 
        
        printf("Value Received: %s \n",read_data);      
        
        memset(&read_data[0], 0, sizeof(read_data));
        
        if (flag==1)
        {
            printf("Writing data\n");
            flag=0;
            for(int i=0;i<4;i++)
                fputc(read_data[i],fp);
        }
       
        if (cnt==20){
            printf("data sorted\n");
            fclose(fp);
        
            cnt=0;
            
        }
        
        
}
}
void clearBuf(char *p)
{
    for (int i=0;i<202;i++)*p++='\0';
}