main.cpp

00001 #include "mbed.h"
00002  
00003 Serial pc(USBTX, USBRX); // tx, rx
00004 Serial nodemcu1(PA_15,PB_7);    //UART1
00005 PwmOut Out_1(PB_10);
00006 PwmOut Out_2(PB_4);
00007 int main() {
00008     Out_1.period(1.0f);  
00009     Out_1.write(0.5f);
00010     Out_2.period(0.5f);  
00011     Out_2.write(0.5f);
00012     int rssi_meas;
00013     float imu_meas[9];
00014     char c;
00015     pc.printf("Started.\n");
00016     
00017     while(1) {
00018         if(nodemcu1.readable()){//Incoming data present
00019             pc.printf("Readable.\n");
00020             nodemcu1.scanf("%c",&c);
00021             pc.printf("Char read: %c",c);
00022             if(c=='r'){
00023                 nodemcu1.scanf("%d",&rssi_meas);
00024                 pc.printf("RSSI data read\n%d",rssi_meas);
00025             }
00026             else if(c=='i'){
00027                 nodemcu1.scanf("%f,%f,%f,%f,%f,%f,%f,%f,%f",&imu_meas[0],&imu_meas[1],&imu_meas[2],&imu_meas[3],&imu_meas[4],&imu_meas[5],&imu_meas[6],&imu_meas[7],&imu_meas[8]);
00028                 pc.printf("IMU data READ\n%f,%f,%f,%f,%f,%f,%f,%f,%f\n",imu_meas[0],imu_meas[1],imu_meas[2],imu_meas[3],imu_meas[4],imu_meas[5],imu_meas[6],imu_meas[7],imu_meas[8]);
00029             }
00030         }
00031     }
00032 }