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-22
Revision:
4:37d118f2348c
Parent:
3:ab9f94d112c0
Child:
5:451b8203ef99

File content as of revision 4:37d118f2348c:

#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 IMU_serial_ISR() {
    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(&IMU_serial_ISR);
    
    while (1) {
        led1 = !led1;
        wait(0.5);
    }
}