File content as of revision 3:ef7e0cbade6d:

#include "mbed.h"
#include "MODSERIAL.h"
#include "initDatabed.h"
#include "UI.h"

Timer t_debug;

int main()
{
    int dataIn[4], dataOut[4], buffer;
    dataOut[0]=7;
    dataOut[1]=30;
    mainPower=1;//Don't turn on for initial testing
    initializeDatabed();
    comm.reply(dataOut[0]);//make this the first message
    pc.printf("DataBed On!\r\n");
    int counter=0;
    int ii=0;
    //float blah=1;
    //t_debug.start();
    while (1) { //Run these functions as fast as possible

        /*if(comm.receive()) {
            dataIn[0] = comm.read();
            comm.reply(UI);         // Make this the next reply
            while(dataIn[0]==7) {
                if(comm.receive()) {
                    dataIn[1]=comm.read();
                    comm.reply(22);
                    break;
                    dataIn[0]=0;
                }
            }
            while(dataIn[1]==30) {
                if(comm.receive()) {
                    dataIn[2]=comm.read();
                    comm.reply(5);
                    pc.printf("Fault: %d, %d ", leftFault.read(), rightFault.read());
                    pc.printf("Data1: %u, Data2: %u, Data3: %u\r\n", dataIn[0], dataIn[1], dataIn[2]);
                    dataIn[1]=0;
                    break;
                }
            }*/
        if(comm.receive()) {
            buffer = comm.read();
            if(buffer==0xFE) { //end of message
                ii=0;
                dataIn[3]=buffer;
                comm.reply(5);
                counter++;
                if(BMS.read(msg)) {
                    if(msg.id==0x18FF8320) {
                        pc.printf("%x\r\n",msg.data[0]);
                    }
                }
                phone.attachment();
            } else if(buffer==0xFF) { //beginning of message
                ii=1;
                dataIn[0]=buffer;
                comm.reply(UI);
            } else if(ii==1) {
                ii++;
                dataIn[1]=buffer;
                comm.reply(52);
            } else if(ii==2) {
                ii++;
                dataIn[2]=buffer;
                comm.reply(25);
            }

        }
        if(counter>=10) {
            UI=0;//set the UI to 0 unless it's changed in checkUI_Xbee()
            readBuffer();
            checkUI_XBee(); //check UI from Xbee
            xbeeUI.rxBufferFlush();
            counter=0;
        }
        //counter++;
        //}

    }
}