Senior_Design_Sailboat / Mbed 2 deprecated ECE4012_Sailboat

GPS and IMU reading works

Dependencies:   mbed Servo SDFileSystem

/media/uploads/taoqiuyang/img_2352.jpg

main.cpp

Committer:
taoqiuyang
Date:
2015-08-08
Revision:
3:ab9f94d112c0
Parent:
2:afb333543af5
Child:
4:37d118f2348c

File content as of revision 3:ab9f94d112c0:

#include "mbed.h"
#include <string>

DigitalOut led1(LED1);
DigitalOut led2(LED2);
 
Serial pc(USBTX, USBRX);
Serial IMU(p28, p27);  // tx, rx

char IMU_message[256];
int  IMU_message_counter=0;
 
void callback() {
    char buf;
    
     while (IMU.readable()) {
        buf = IMU.getc();
        
        IMU_message_counter+=1;
        IMU_message[IMU_message_counter]=buf;
        
        if (buf=='#'){
            IMU_message_counter=0;
        }
        
        if (buf=='\n'){
            int i;
            for(i=0;i<=IMU_message_counter;i++){
                pc.putc(IMU_message[i]);  
            }  
        } 
    }
     
     
    led2 = !led2;
}
 
 
 
 
int main() {
    IMU.baud(57600);
    IMU.attach(&callback);
    
    while (1) {
        led1 = !led1;
        wait(0.5);
    }
}