gs testing
Dependencies: HEPTA_CDH HEPTA_COM HEPTA_EPS HEPTA_SENSOR mbed
main.cpp
- Committer:
- tomoyuki1021
- Date:
- 2022-09-25
- Revision:
- 31:cb894a9a4f15
- Parent:
- 30:f300d1e88f4c
File content as of revision 31:cb894a9a4f15:
#include "mbed.h" #include "HEPTA_CDH.h" #include "HEPTA_EPS.h" #include "HEPTA_SENSOR.h" #include "HEPTA_COM.h" 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 com(p9,p10); DigitalOut condition(LED1); Serial sat(USBTX,USBRX,9600); Timer sattime; int rcmd = 0,cmdflag = 0; //command variable int main() { 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(); eps.turn_on_regulator();//turn on 3.3V conveter while(1) { com.xbee_receive(&rcmd,&cmdflag);//interupting by ground station command //senssing HK data(dummy data) eps.vol(&batvol); sensor.temp_sense(&temp); wait_ms(100); //Transmitting HK data to Ground Station(GS) sensor.gps_setting(); 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; com.printf("HEPTASAT::Condition=%d,Time=%f[s],batVol=%.2f[V],Temp=%.2f[C],GPGGA,%f,%f,%f\r\n", flag,sattime.read(),batvol,temp,latitude,longitude,altitude); 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 == '0') { sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); com.printf("Hepta-Sat 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 == '1') { sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); com.printf("Hepta-Sat Uplink Ok\r\n"); char str[100]; mkdir("/sd/mydir", 0777); FILE *fp = fopen("/sd/mydir/satdata.txt","w"); if(fp == NULL) { error("Could not open file for write\r\n"); } for(int i = 0; i < 10; i++) { eps.vol(&batvol); fprintf(fp,"%f\r\n",batvol); condition = 1; wait_ms(1000); } 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 == '2') { sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); com.printf("Hepta-Sat Uplink Ok\r\n"); sensor.gps_setting(); 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; for(int i=1; i<1000; i++) { sensor.gga_sensing(&time, &latitude, &ns, &longitude, &ew, &quality, &stnum, &hacu, &altitude, &aunit, &gps_check); if((gps_check==0)|(gps_check==1)) { com.printf("GPGGA,%f,%f,%c,%f,%c,%d,%d,%f,%f,%c\r\n",time,latitude,ns,longitude,ew,quality,stnum,hacu,altitude,aunit); } } } else if (rcmd == '3') { sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); com.printf("Hepta-Sat Uplink Ok\r\n"); float ax,ay,az; com.printf("Accel Sensor Mode\r\n"); for(int i = 0; i<50; i++) { sensor.sen_acc(&ax,&ay,&az); com.printf("%f,%f,%f\r\n",ax,ay,az); wait(0.5); } } else if (rcmd == '4') { sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); com.printf("Hepta-Sat Uplink Ok\r\n"); float gx,gy,gz; com.printf("Gyro Sensor Mode\r\n"); for(int i = 0; i<50; i++) { sensor.sen_gyro(&gx,&gy,&gz); com.printf("%f,%f,%f\r\n",gx,gy,gz); wait(0.5); } } else if (rcmd == '5') { sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); com.printf("Hepta-Sat Uplink Ok\r\n"); float mx,my,mz; com.printf("Magnetometer Mode\r\n"); for(int i = 0; i<50; i++) { sensor.sen_mag(&mx,&my,&mz); com.printf("%f,%f,%f\r\n",mx,my,mz); wait(0.5); } } else if (rcmd == '6') { sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); com.printf("Hepta-Sat Uplink Ok\r\n"); float ax,ay,az; float gx,gy,gz; float mx,my,mz; com.printf("9-axis sensor Mode\r\n"); for(int i = 0; i<50; i++) { sensor.sen_acc(&ax,&ay,&az); sensor.sen_gyro(&gx,&gy,&gz); sensor.sen_mag(&mx,&my,&mz); com.printf("-,-,-,-,-,-,-,-,-,-,-,-,-,-,-,%f,%f,%f,%f,%f,%f,%f,%f,%f\r\n",ax,ay,az,gx,gy,gz,mx,my,mz); wait(0.5); } } else if (rcmd == '7') { sat.printf("rcmd=%c,cmdflag=%d\r\n",rcmd,cmdflag); com.printf("Hepta-Sat Uplink Ok\r\n"); com.printf("CAMERA\r\n"); sensor.Sync(); sensor.initialize(HeptaCamera_GPS::Baud115200, HeptaCamera_GPS::JpegResolution320x240); sensor.test_jpeg_snapshot_data("/sd/test.txt"); FILE *fp = fopen("/sd/test.txt", "r"); if(fp == NULL) { sat.printf("Could not open file for write\r\n"); } else { char str[1024]; com.printf("INICIO\r\n"); while((fgets(str,256,fp))!=NULL) { com.printf("%s",str); wait(0.001); } com.printf("FIN\r\n"); //com.printf("Data transmitting finished:)\r\n"); fclose(fp); } } else if (rcmd == '8') { com.initialize(); sattime.stop(); sat.printf("From Sat : End of operation\r\n"); com.printf("From Sat : End of operation\r\n"); break; } //} } }