qqqq
Dependencies: HEPTA_SENSOR mbed HEPTA_EPS HEPTA_COM HEPTA_CDH
Diff: main.cpp
- Revision:
- 29:eb84063fe5c9
- Parent:
- 28:60f73cc07244
- Child:
- 30:f300d1e88f4c
diff -r 60f73cc07244 -r eb84063fe5c9 main.cpp --- a/main.cpp Tue Nov 17 05:20:21 2020 +0000 +++ b/main.cpp Sun Nov 21 02:23:58 2021 +0000 @@ -3,138 +3,114 @@ #include "HEPTA_EPS.h" #include "HEPTA_SENSOR.h" #include "HEPTA_COM.h" -DigitalOut cond[]={LED1,LED2,LED3,LED4}; -Serial sat(USBTX,USBRX); //for satellite condition HEPTA_CDH cdh(p5, p6, p7, p8, "sd"); HEPTA_EPS eps(p16,p26); HEPTA_SENSOR sensor(p17, p28,p27,0xD0,0x18, p13,p14,p25,p24); -HEPTA_COM gs(p9,p10); //for ground station +HEPTA_COM com(p9,p10); +DigitalOut condition(LED1); +Serial sat(USBTX,USBRX,9600); +Timer sattime; int rcmd = 0,cmdflag = 0; //command variable //getting command and flag void commandget() { - rcmd=gs.getc(); + rcmd=com.getc(); cmdflag = 1; } //interrupting void receive(int rcmd, int cmdflag) { - gs.xbee.attach(commandget,Serial::RxIrq); + com.xbee.attach(commandget,Serial::RxIrq); } //initialzing void initialize() { rcmd = 0; cmdflag = 0; - cond[0] = 0; + condition = 0; } + int main() { - gs.baud(9600); - float sattime=0.0,btvol,temp; - float ax,ay,az; - float gx,gy,gz; - float mx,my,mz; - int quality=0,stnum=0,gps_check=0; - char ns='A',ew='B',aunit='m'; - float time=0.0,latitude=0.0,longitude=0.0,hacu=0.0,altitude=0.0; - int flag = 0; // condition + sat.printf("From Sat : Nominal Operation\r\n"); + com.printf("From Sat : Nominal Operation\r\n"); + com.baud(9600); + int flag = 0; //condition flag + float batvol, temp; //voltage, temperature + int rcmd=0,cmdflag=0; //command variable + sattime.start(); receive(rcmd,cmdflag); //interupting by ground station command - - gs.printf("From Sat : Operation Start...\r\n"); + eps.turn_on_regulator();//turn on 3.3V conveter for(int i = 0; i < 100; i++) { - //Sensing and Transmitting HK data , Power Saving Mode - eps.power_saving_mode(&flag,&btvol); + //satellite condition led + condition = !condition; + + //senssing HK data(dummy data) + eps.vol(&batvol); sensor.temp_sense(&temp); - gs.printf("HEPTASAT::Condition = %d, Time = %f [s], BatVol = %.2f [V],Temp = %.2f [C]\r\n",flag,sattime,btvol,temp); - //Condition - cond[0] = 1; - //Warning the status of temperature and battery voltage - if(flag == 1) { - gs.printf("Low Battery\r\n"); - } else if(temp > 35.0) { - gs.printf("High temperature\r\n"); - } else if((flag == 1) & (temp > 35.0)) { - gs.printf("Low Battery and High temperature\n"); + + //Transmitting HK data to Ground Station(GS) + com.printf("HEPTASAT::Condition = %d, Time = %f [s], batVol = %.2f [V],Temp = %.2f [C]\r\n",flag,sattime.read(),batvol,temp); + wait_ms(1000); + + //Power Saving Mode + if((batvol <= 3.5) | (temp > 35.0)){ + eps.shut_down_regulator(); + com.printf("Power saving mode ON\r\n"); + flag = 1; + } else if((flag == 1) & (batvol > 3.7) & (temp <= 25.0)) { + eps.turn_on_regulator(); + com.printf("Power saving mode OFF\r\n"); + flag = 0; } //Contents of command if (cmdflag == 1) { if (rcmd == 'a') { - for(int j=0;j<5;j++){ - gs.printf("HEPTASAT::Hello World!\r\n"); - cond[0] = 0; - wait(1); - cond[0] = 1; - } - } - if (rcmd == 'b') { + sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); + com.printf("Hepta-Sat Lite Uplink Ok\r\n"); + for(int j=0;j<5;j++){ + com.printf("Hello World!\r\n"); + condition = 1; + wait_ms(1000); + } + }else if (rcmd == 'b') { + sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); + com.printf("Hepta-Sat Lite Uplink Ok\r\n"); char str[100]; mkdir("/sd/mydir", 0777); - FILE *fp = fopen("/sd/mydir/test.txt","w"); + FILE *fp = fopen("/sd/mydir/satdata.txt","w"); if(fp == NULL) { error("Could not open file for write\r\n"); } - else - { - for(int i = 0; i < 10; i++) { - eps.vol(&btvol); - fprintf(fp,"%f\r\n",btvol); - wait(1.0); - } - fclose(fp); - fp = fopen("/sd/mydir/test.txt","r"); - for(int j = 0; j < 10; j++) { - fgets(str,100,fp); - gs.printf("%s",str); - } - fclose(fp); + for(int i = 0; i < 10; i++) { + eps.vol(&batvol); + fprintf(fp,"%f\r\n",batvol); + condition = 1; + wait_ms(1000); } - cond[0] = 0; - wait(1); - cond[0] = 1; - } - if (rcmd == 'c') { - sensor.temp_sense(&temp); - sensor.sen_gyro(&gx,&gy,&gz); - sensor.sen_acc(&ax,&ay,&az); - sensor.sen_mag(&mx,&my,&mz); - sensor.gga_sensing(&time,&latitude,&ns,&longitude,&ew,&quality,&stnum,&hacu,&altitude,&aunit,&gps_check); - gs.printf("temp=%f\r\n",temp); - gs.printf("gx=%f,gy=%f,gz=%f\r\n",gx,gy,gz); - gs.printf("ax=%f,ay=%f,az=%f\r\n",ax,ay,az); - gs.printf("mx=%f,my=%f,mz=%f\r\n",mx,my,mz); - gs.printf("latitude=%f, longtitude=%f, altitude%f\r\n",latitude,longitude,altitude); - cond[0] = 0; - wait(1); - cond[0] = 1; - } - if (rcmd == 'd') { - gs.printf("Start to take a picture\r\n"); - sensor.Sync(); - sensor.initialize(HeptaCamera_GPS::Baud115200, HeptaCamera_GPS::JpegResolution320x240); - gs.printf("[ OK ]:Picture taken\r\n"); - sensor.test_jpeg_snapshot_picture("/sd/MissionData/picture.jpg"); - gs.printf("Finish saving in SD\r\n"); - cond[0] = 0; - wait(1); - cond[0] = 1; - } - if (rcmd == 'e') { - // Please enter your answer in this part - - - - - + fclose(fp); + fp = fopen("/sd/mydir/satdata.txt","r"); + for(int i = 0; i < 10; i++) { + fgets(str,100,fp); + com.puts(str); + } + fclose(fp); + }else if (rcmd == 'c') { + //Please insert your answer + + }else if (rcmd == 'd') { + //Please insert your answer + + }else if (rcmd == 'e') { + //Please insert your answer + } initialize(); } - - //Operation Interval - wait(1.0); - sattime = sattime+1.0; } - gs.printf("From Sat : Operation Stop...\r\n"); + sattime.stop(); + sat.printf("From Sat : End of operation\r\n"); + com.printf("From Sat : End of operation\r\n"); }