sd 32 update
Dependencies: FreescaleIAP mbed-rtos mbed
Fork of COM_MNG_TMTC_SIMPLE by
OBSRS.h
00001 // problem in check pa and valid sid not sending anything in one for loop 00002 00003 00004 00005 // no error case 2 ackl234new->TM_string[2] = (101_0000) = 0x_0; spare = 0 10100000 = 0xA0 00006 // Hardware failure Case 4 ackl234new->TM_string[2] = (100_0101) = 0x_5; spare = 0 10000101 = 0x85 comes from cdms ask pradeep 00007 // Invalid FSC Case 4 ackl234new->TM_string[2] = (100_0110) = 0x_6; spare = 0 10000110 = 0x86 Invalid FSC 00008 // Illegal TC Case 3 ackl234new->TM_string[2] = (000_0010) = 0x_2; spare = 0 00000010 = 0x02 invalid SID 00009 00010 00011 00012 #define TMID_ACK_L234 0xB 00013 #define T_frames_in_segment 10 00014 00015 using namespace std; 00016 Serial pc(USBTX, USBRX); // tx, rx 00017 00018 DigitalOut gpo(D0); 00019 DigitalOut led(LED_RED); 00020 00021 bool send_EoS_and_stop = false; 00022 bool adf_limit = false; 00023 bool stop = false; 00024 bool check_PA = true; 00025 bool PA_HOT=0; 00026 bool short_TC; 00027 bool valid_SID = true; 00028 bool enable_call_sign = true; 00029 bool enable_new_segment=true; 00030 bool enable_S_frame = true; 00031 bool enable_read_block = false; 00032 bool enable_T_frame = false; 00033 bool enable_Ack_andcallsign = false; 00034 bool enable_ackandcallsign = false; 00035 bool new_session =true; 00036 bool enable_EoS=false; 00037 bool create_Ack_andcallsign = true; 00038 bool Ack_andcallsign_over = false; 00039 bool repeat_last_2T_frames = false; 00040 bool last_block = false; 00041 bool last_buffer = false; 00042 bool new_OBSRS_TC = true; 00043 bool enable_SCH = true; 00044 bool enable_FCCH = false; 00045 bool enable_DS = false; 00046 00047 uint8_t SID ; 00048 unsigned char buffer_112[112]; 00049 uint32_t FSC; 00050 uint16_t read_success = false; 00051 uint16_t counter_buffer_112=0, counter_EoS=0,T_frames_sent=0; 00052 uint16_t counter_call_sign_buffer=0; 00053 uint16_t counter_buffer_512=0; 00054 uint16_t counter_Ack_andcallsign = 0; 00055 uint16_t max_segments = 65415/(48+T_frames_in_segment*159); 00056 uint16_t ack_code = 0xA0; 00057 uint16_t segments_sent = 0; 00058 uint8_t counter_SCH40 = 0; 00059 uint8_t counter_FCCH80 = 0; 00060 uint8_t counter_S_frame = 0; 00061 uint16_t T_frame_Ack_andcallsign_sent = 0; 00062 uint16_t T_frame_in_Ackandcallsign = 4; // needs to get from sukhdeep depends on size of Ack_L1 00063 uint64_t start_block_num ; 00064 uint32_t block_counter = 0; 00065 uint32_t no_of_frames =0; 00066 int Ack_L1; // should be always even 00067 00068 //#define max_segments = 65415/(48+T_frames_in_segment*159) 00069 // data 288 byte with convolution without xoring 0x38,0x90,0x7B,0x40,0x01,0x56,0x45,0xE0,0x3C,0xA0,0x7A,0x90,0x3D,0xE6,0x3E,0x70,0x21,0x42,0x43,0x3C,0x0C,0x20,0x00,0x4C,0x83,0x12,0x67,0xF0,0x8F,0x36,0x60,0x3C,0x86,0x24,0x06,0x80,0x20,0x54,0x22,0x9C,0x07,0x2A,0x00,0x8C,0x0F,0x7A,0x25,0x50,0x88,0x50,0x5F,0x8C,0xAB,0x0A,0x7A,0xCC,0x10,0xC4,0x25,0x10,0xB3,0xCE,0x5F,0x40,0xA1,0x8A,0x05,0xD0,0x90,0x14,0x7E,0x00,0x09,0xCA,0x7F,0xA0,0x1B,0xDE,0x00,0x70,0x12,0x14,0x7D,0x50,0x2A,0xC0,0x7D,0x20,0x14,0x30,0x04,0x4C,0x3C,0xF0,0x02,0xEC,0x28,0x60,0x45,0xA0,0x04,0x04,0x47,0x1C,0x22,0x70,0x02,0xE0,0x26,0xF4,0x41,0xFC,0x04,0x84,0x04,0x9C,0x0A,0xB0,0x41,0x40,0x25,0x0C,0xBF,0x9C,0x2F,0x3C,0xF8,0x5C,0x0A,0x18,0x4A,0xC0,0x21,0x00,0xB2,0x80,0x58,0x9C,0x8A,0x00,0x79,0xBC,0x7D,0x00,0x10,0x28,0x3E,0x3C,0x46,0x94,0x7D,0xB8,0x21,0x20,0x42,0x04,0x77,0xB4,0xB7,0x84,0x53,0x94,0x03,0xA0,0x20,0x08,0xF4,0x00,0x47,0x34,0xF7,0x60,0x63,0x3C,0x01,0xC0,0x24,0x08,0xF3,0xA0,0x11,0xA0,0xF3,0x60,0x68,0x48,0x08,0xB8,0x7D,0xE8,0x0D,0xF8,0x14,0xE0,0x83,0xC0,0x48,0x00,0x8E,0xB8,0x91,0xC8,0x05,0x40,0xD8,0xC8,0x8B,0xF8,0xC9,0x00,0x0D,0x38,0x04,0x68,0x86,0x80,0x9A,0x11,0x7B,0xB8,0x9F,0x79,0xF8,0x38,0x05,0x38,0x99,0x80,0xD2,0x01,0x69,0x80,0x24,0x71,0x14,0x80,0xF6,0x30,0xFE,0x80,0x72,0x41,0xE9,0x00,0x01,0x19,0x17,0x80,0xE6,0x81,0xEA,0x40,0x67,0xD8,0xFD,0xC0,0x81,0x48,0x1E,0xF0,0x34,0x81,0x13,0x30,0x09,0x19,0x8D,0xC8,0xBD,0x88,0x84,0xF8,0x9C,0x90,0x1C,0x00,0x00,0x41,0x8C,0x78,0x39,0xA9,0x12,0x30,0x19,0xF8,0x87,0x48 00070 // actual data 0x18,0x00,0x00,0x00,0x1C,0x44,0x10,0x04,0x01,0xE0,0x44,0x10,0x04,0x01,0xE0,0x44,0x10,0x04,0x01,0xE0,0x44,0x10,0x04,0x01,0xE0,0x44,0x10,0x04,0x01,0xE0,0x44,0x10,0x40,0x00,0x00,0x00,0x00,0x01,0x40,0x82,0x41,0x20,0x10,0x08,0x04,0x02,0x01,0xE4,0x3A,0x28,0x22,0x3A,0x28,0x22,0x3A,0x28,0x22,0x41,0x10,0x04,0x01,0xE4,0x40,0x20,0x10,0x08,0x04,0x01,0xE4,0x41,0x10,0x04,0x01,0xE4,0x41,0x10,0x04,0x01,0xE4,0x41,0x10,0x04,0x01,0xE4,0x41,0x10,0x04,0x01,0xE4,0x41,0x10,0x04,0x01,0xE4,0x41,0x10,0x40,0x00,0x00,0x00,0x00,0x01,0x48,0x82,0x41,0x20,0x10,0x08,0x04,0x02,0x01,0xE8,0x04,0x28,0x22,0x04,0x28,0x22,0x04,0x28,0x22,0x42,0x10,0x04,0x01,0xE8,0x40,0x20,0x10,0x08,0x04,0x01,0x00,0x00, 00071 //const unsigned char S_frame[] = {0x46,0x9D,0xFB,0xF0,0xD2,0xBA,0x89,0xE4,0x46,0x9D,0xFB,0xF0,0xD2,0xBA,0x89,0xE4,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}; 00072 //const unsigned char EoS[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x1A,0x77,0xEF,0xC3,0x4A,0xEA,0x27,0x91,0x1A,0x77,0xEF,0xC3,0x4A,0xEA,0x27,0x90,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x1A,0x77,0xEF,0xC3,0x4A,0xEA,0x27,0x91,0x1A,0x77,0xEF,0xC3,0x4A,0xEA,0x27,0x90,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}; 00073 uint16_t counter=0; 00074 unsigned char call_sign_buffer[318]={0x0A,0x3F,0x46,0xB4,0x00,0x38,0x90,0x7B,0x40,0x01,0x56,0x45,0xE0,0x3C,0xA0,0x7A,0x90,0x3D,0xE6,0x3E,0x70,0x21,0x42,0x43,0x3C,0x0C,0x20,0x00,0x4C,0x83,0x12,0x67,0xF0,0x8F,0x36,0x60,0x3C,0x86,0x24,0x06,0x80,0x20,0x54,0x22,0x9C,0x07,0x2A,0x00,0x8C,0x0F,0x7A,0x25,0x50,0x88,0x50,0x5F,0x8C,0xAB,0x0A,0x7A,0xCC,0x10,0xC4,0x25,0x10,0xB3,0xCE,0x5F,0x40,0xA1,0x8A,0x05,0xD0,0x90,0x14,0x7E,0x00,0x09,0xCA,0x7F,0xA0,0x1B,0xDE,0x00,0x70,0x12,0x14,0x7D,0x50,0x2A,0xC0,0x7D,0x20,0x14,0x30,0x04,0x4C,0x3C,0xF0,0x02,0xEC,0x28,0x60,0x45,0xA0,0x04,0x04,0x47,0x1C,0x22,0x70,0x02,0xE0,0x26,0xF4,0x41,0xFC,0x04,0x84,0x04,0x9C,0x0A,0xB0,0x41,0x40,0x25,0x0C,0xBF,0x9C,0x2F,0x3C,0xF8,0x5C,0x0A,0x18,0x4A,0xC0,0x21,0x00,0xB2,0x80,0x58,0x9C,0x8A,0x00,0x79,0xBC,0x7D,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x0A,0x3F,0x46,0xB4,0x00,0x10,0x28,0x3E,0x3C,0x46,0x94,0x7D,0xB8,0x21,0x20,0x42,0x04,0x77,0xB4,0xB7,0x84,0x53,0x94,0x03,0xA0,0x20,0x08,0xF4,0x00,0x47,0x34,0xF7,0x60,0x63,0x3C,0x01,0xC0,0x24,0x08,0xF3,0xA0,0x11,0xA0,0xF3,0x60,0x68,0x48,0x08,0xB8,0x7D,0xE8,0x0D,0xF8,0x14,0xE0,0x83,0xC0,0x48,0x00,0x8E,0xB8,0x91,0xC8,0x05,0x40,0xD8,0xC8,0x8B,0xF8,0xC9,0x00,0x0D,0x38,0x04,0x68,0x86,0x80,0x9A,0x11,0x7B,0xB8,0x9F,0x79,0xF8,0x38,0x05,0x38,0x99,0x80,0xD2,0x01,0x69,0x80,0x24,0x71,0x14,0x80,0xF6,0x30,0xFE,0x80,0x72,0x41,0xE9,0x00,0x01,0x19,0x17,0x80,0xE6,0x81,0xEA,0x40,0x67,0xD8,0xFD,0xC0,0x81,0x48,0x1E,0xF0,0x34,0x81,0x13,0x30,0x09,0x19,0x8D,0xC8,0xBD,0x88,0x84,0xF8,0x9C,0x90,0x1C,0x00,0x00,0x41,0x8C,0x78,0x39,0xA9,0x12,0x30,0x19,0xF8,0x87,0x48,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}; 00075 //0x00,0x0A,0x3F,0x46,0xB4,0x00,0x38,0x90,0x7B,0x40,0x01,0x56,0x45,0xE0,0x3C,0xA0,0x7A,0x90,0x3D,0xE6,0x3E,0x70,0x21,0x42,0x43,0x3C,0x0C,0x20,0x00,0x4C,0x83,0x12,0x67,0xF0,0x8F,0x36,0x60,0x3C,0x86,0x24,0x06,0x80,0x20,0x54,0x22,0x9C,0x07,0x2A,0x00,0x8C,0x0F,0x7A,0x25,0x50,0x88,0x50,0x5F,0x8C,0xAB,0x0A,0x7A,0xCC,0x10,0xC4,0x25,0x10,0xB3,0xCE,0x5F,0x40,0xA1,0x8A,0x05,0xD0,0x90,0x14,0x7E,0x00,0x09,0xCA,0x7F,0xA0,0x1B,0xDE,0x00,0x70,0x12,0x14,0x7D,0x50,0x2A,0xC0,0x7D,0x20,0x14,0x30,0x04,0x4C,0x3C,0xF0,0x02,0xEC,0x28,0x60,0x45,0xA0,0x04,0x04,0x47,0x1C,0x22,0x70,0x02,0xE0,0x26,0xF4,0x41,0xFC,0x04,0x84,0x04,0x9C,0x0A,0xB0,0x41,0x40,0x25,0x0C,0xBF,0x9C,0x2F,0x3C,0xF8,0x5C,0x0A,0x18,0x4A,0xC0,0x21,0x00,0xB2,0x80,0x58,0x9C,0x8A,0x00,0x79,0xBC,0x7D,0x00,0x10,0x28,0x3E,0x3C,0x46,0x94,0x7D,0xB8,0x21,0x20,0x42,0x04,0x77,0xB4,0xB7,0x84,0x53,0x94,0x03,0xA0,0x20,0x08,0xF4,0x00,0x47,0x34,0xF7,0x60,0x63,0x3C,0x01,0xC0,0x24,0x08,0xF3,0xA0,0x11,0xA0,0xF3,0x60,0x68,0x48,0x08,0xB8,0x7D,0xE8,0x0D,0xF8,0x14,0xE0,0x83,0xC0,0x48,0x00,0x8E,0xB8,0x91,0xC8,0x05,0x40,0xD8,0xC8,0x8B,0xF8,0xC9,0x00,0x0D,0x38,0x04,0x68,0x86,0x80,0x9A,0x11,0x7B,0xB8,0x9F,0x79,0xF8,0x38,0x05,0x38,0x99,0x80,0xD2,0x01,0x69,0x80,0x24,0x71,0x14,0x80,0xF6,0x30,0xFE,0x80,0x72,0x41,0xE9,0x00,0x01,0x19,0x17,0x80,0xE6,0x81,0xEA,0x40,0x67,0xD8,0xFD,0xC0,0x81,0x48,0x1E,0xF0,0x34,0x81,0x13,0x30,0x09,0x19,0x8D,0xC8,0xBD,0x88,0x84,0xF8,0x9C,0x90,0x1C,0x00,0x00,0x41,0x8C,0x78,0x39,0xA9,0x12,0x30,0x19,0xF8,0x87,0x48,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}; 00076 uint8_t buffer_512[512]; 00077 unsigned char Ack_andcallsign[318]={0x0A,0x3F,0x46,0xB4,0x00,0x38,0x90,0x7B,0x40,0x01,0x56,0x45,0xE0,0x3C,0xA0,0x7A,0x90,0x3D,0xE6,0x3E,0x70,0x21,0x42,0x43,0x3C,0x0C,0x20,0x00,0x4C,0x83,0x12,0x67,0xF0,0x8F,0x36,0x60,0x3C,0x86,0x24,0x06,0x80,0x20,0x54,0x22,0x9C,0x07,0x2A,0x00,0x8C,0x0F,0x7A,0x25,0x50,0x88,0x50,0x5F,0x8C,0xAB,0x0A,0x7A,0xCC,0x10,0xC4,0x25,0x10,0xB3,0xCE,0x5F,0x40,0xA1,0x8A,0x05,0xD0,0x90,0x14,0x7E,0x00,0x09,0xCA,0x7F,0xA0,0x1B,0xDE,0x00,0x70,0x12,0x14,0x7D,0x50,0x2A,0xC0,0x7D,0x20,0x14,0x30,0x04,0x4C,0x3C,0xF0,0x02,0xEC,0x28,0x60,0x45,0xA0,0x04,0x04,0x47,0x1C,0x22,0x70,0x02,0xE0,0x26,0xF4,0x41,0xFC,0x04,0x84,0x04,0x9C,0x0A,0xB0,0x41,0x40,0x25,0x0C,0xBF,0x9C,0x2F,0x3C,0xF8,0x5C,0x0A,0x18,0x4A,0xC0,0x21,0x00,0xB2,0x80,0x58,0x9C,0x8A,0x00,0x79,0xBC,0x7D,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x0A,0x3F,0x46,0xB4,0x00,0x10,0x28,0x3E,0x3C,0x46,0x94,0x7D,0xB8,0x21,0x20,0x42,0x04,0x77,0xB4,0xB7,0x84,0x53,0x94,0x03,0xA0,0x20,0x08,0xF4,0x00,0x47,0x34,0xF7,0x60,0x63,0x3C,0x01,0xC0,0x24,0x08,0xF3,0xA0,0x11,0xA0,0xF3,0x60,0x68,0x48,0x08,0xB8,0x7D,0xE8,0x0D,0xF8,0x14,0xE0,0x83,0xC0,0x48,0x00,0x8E,0xB8,0x91,0xC8,0x05,0x40,0xD8,0xC8,0x8B,0xF8,0xC9,0x00,0x0D,0x38,0x04,0x68,0x86,0x80,0x9A,0x11,0x7B,0xB8,0x9F,0x79,0xF8,0x38,0x05,0x38,0x99,0x80,0xD2,0x01,0x69,0x80,0x24,0x71,0x14,0x80,0xF6,0x30,0xFE,0x80,0x72,0x41,0xE9,0x00,0x01,0x19,0x17,0x80,0xE6,0x81,0xEA,0x40,0x67,0xD8,0xFD,0xC0,0x81,0x48,0x1E,0xF0,0x34,0x81,0x13,0x30,0x09,0x19,0x8D,0xC8,0xBD,0x88,0x84,0xF8,0x9C,0x90,0x1C,0x00,0x00,0x41,0x8C,0x78,0x39,0xA9,0x12,0x30,0x19,0xF8,0x87,0x48,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}; 00078 uint32_t list_of_FSC[43]={0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x10,0x11,0x12,0x13,0x14,0x15,0x16,0x17,0x18,0x19,0x20,0x21,0x22,0x23,0x24,0x25,0x26,0x27,0x28,0x29,0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37,0x38,0x39,0x40,0x41,0x42,0x43}; 00079 uint8_t write_buffer[512] = {0x38,0x90,0x7B,0x40,0x01,0x56,0x45,0xE0,0x3C,0xA0,0x7A,0x90,0x3D,0xE6,0x3E,0x70,0x21,0x42,0x43,0x3C,0x0C,0x20,0x00,0x4C,0x83,0x12,0x67,0xF0,0x8F,0x36,0x60,0x3C,0x86,0x24,0x06,0x80,0x20,0x54,0x22,0x9C,0x07,0x2A,0x00,0x8C,0x0F,0x7A,0x25,0x50,0x88,0x50,0x5F,0x8C,0xAB,0x0A,0x7A,0xCC,0x10,0xC4,0x25,0x10,0xB3,0xCE,0x5F,0x40,0xA1,0x8A,0x05,0xD0,0x90,0x14,0x7E,0x00,0x09,0xCA,0x7F,0xA0,0x1B,0xDE,0x00,0x70,0x12,0x14,0x7D,0x50,0x2A,0xC0,0x7D,0x20,0x14,0x30,0x04,0x4C,0x3C,0xF0,0x02,0xEC,0x28,0x60,0x45,0xA0,0x04,0x04,0x47,0x1C,0x22,0x70,0x02,0xE0,0x26,0xF4,0x41,0xFC,0x04,0x84,0x04,0x9C,0x0A,0xB0,0x41,0x40,0x25,0x0C,0xBF,0x9C,0x2F,0x3C,0xF8,0x5C,0x0A,0x18,0x4A,0xC0,0x21,0x00,0xB2,0x80,0x58,0x9C,0x8A,0x00,0x79,0xBC,0x7D,0x00,0x10,0x28,0x3E,0x3C,0x46,0x94,0x7D,0xB8,0x21,0x20,0x42,0x04,0x77,0xB4,0xB7,0x84,0x53,0x94,0x03,0xA0,0x20,0x08,0xF4,0x00,0x47,0x34,0xF7,0x60,0x63,0x3C,0x01,0xC0,0x24,0x08,0xF3,0xA0,0x11,0xA0,0xF3,0x60,0x68,0x48,0x08,0xB8,0x7D,0xE8,0x0D,0xF8,0x14,0xE0,0x83,0xC0,0x48,0x00,0x8E,0xB8,0x91,0xC8,0x05,0x40,0xD8,0xC8,0x8B,0xF8,0xC9,0x00,0x0D,0x38,0x04,0x68,0x86,0x80,0x9A,0x11,0x7B,0xB8,0x9F,0x79,0xF8,0x38,0x05,0x38,0x99,0x80,0xD2,0x01,0x69,0x80,0x24,0x71,0x14,0x80,0xF6,0x30,0xFE,0x80,0x72,0x41,0xE9,0x00,0x01,0x19,0x17,0x80,0xE6,0x81,0xEA,0x40,0x67,0xD8,0xFD,0xC0,0x81,0x48,0x1E,0xF0,0x34,0x81,0x13,0x30,0x09,0x19,0x8D,0xC8,0xBD,0x88,0x84,0xF8,0x9C,0x90,0x1C,0x00,0x00,0x41,0x8C,0x78,0x39,0xA9,0x12,0x30,0x19,0xF8,0x87,0x48,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}; 00080 //const unsigned char EXOR_SEQ[] = {0x55,0xF1,0x51,0x3D,0xA7,0x42,0xAE,0x2E,0x2E,0x28,0x76,0x80,0x62,0x41,0xC4,0x75,0x4D,0x87,0xDB,0xE1,0x02,0x61,0x60,0x96,0x9C,0xCB,0x8A,0xBD,0x37,0xE4,0x72,0x5D,0xF2,0x19,0x62,0x06,0x9A,0xF9,0x38,0xB0,0x49,0x75,0xD0,0x17,0x1B,0xCC,0x0B,0xEB,0x1B,0x50,0xA2,0x2A,0x8E,0xFA,0x4D,0x6F,0x1B,0xF8,0x0F,0x97,0x39,0x25,0x60,0x55,0x9A,0xDF,0x1D,0x10,0x7F,0xBD,0x3E,0xBF,0xE5,0x68,0x02,0xD1,0x99,0x0D,0xDF,0x84,0x2E,0x15,0xE3,0x08,0xD7,0x44,0x10,0x41,0xCE,0x93,0xF6,0x59,0x71,0xD2,0xF7,0x1C,0x4A,0x44,0x2D,0xA9,0x44,0x98,0x3A,0x00,0x71,0xCC,0x2A,0x35,0xC1,0x81,0xCF,0x44,0xF7,0x6A,0x0E,0xE4,0xF2,0xFC,0xD6,0x0B,0xA8,0x95,0x7B,0x86,0xB5,0xF8,0x33,0xE9,0xBF,0x6A,0x0E,0xE6,0x53,0x82}; 00081 //const unsigned char FCCH80[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}; 00082 //const unsigned char SCH40[] = {0x0a,0x3f,0x46,0xb4,0x00}; 00083 00084 00085 00086 00087 #define create_Ack_L234 {\ 00088 Base_tm *ackl234new = new Short_tm;\ 00089 ackl234new->next_TM = NULL;\ 00090 /*return telemetry pointer here*/\ 00091 uint8_t temp8;\ 00092 temp8 = SHORT_TM_CODE;\ 00093 PUTshort_or_long_tm(ackl234new->fields, temp8);\ 00094 temp8 = TMID_ACK_L234;\ 00095 PUTtmid((ackl234new->fields), temp8);\ 00096 ackl234new->TM_string[0] = TMID_ACK_L234 << 4;\ 00097 ackl234new->TM_string[1] = 0x12;\ 00098 ackl234new->TM_string[2] = ack_code; /* Ack code ....to be chnaged accordind to situation */\ 00099 for(int i = 3; i < 11; ++i){\ 00100 ackl234new->TM_string[i] = 0x00;\ 00101 }\ 00102 uint16_t crc = crc16_gen(ackl234new->TM_string, TM_SHORT_SIZE-2);\ 00103 ackl234new->TM_string[11] = (crc & 0xFF00) >> 8;\ 00104 ackl234new->TM_string[12] = crc & 0x00FF; \ 00105 } 00106 00107 #define make_T_frame_Ack_andcallsign {\ 00108 } 00109 00110 void restart_adf(){ 00111 00112 } 00113 00114 int diff_prev; 00115 void differential_encode(unsigned char* ptr, int length){ 00116 for(int i=0; i<length;i++){ 00117 unsigned char s = ptr[i] , t; 00118 t = s ^ (s >> 1); 00119 (diff_prev == 0) ? t=t^0x00 : t=t^0x80 ; 00120 diff_prev = int(s & 0x01); 00121 ptr[i] = t; 00122 } 00123 } 00124 00125 #define check_PA_temp {\ 00126 /* return 0 or 1*/\ 00127 PA_HOT=0;\ 00128 } 00129 00130 int get_Ack_L1(){ 00131 for(int i=0;i<288;i++){ 00132 // Ack_andcallsign[i] = 0xff; 00133 } 00134 //cout<<"in side get_Ack_L1"<<endl<<"\r"; 00135 return 1; 00136 } 00137 00138 #define send_Ack_andcallsign{\ 00139 if(T_frames_sent < T_frames_in_segment){\ 00140 buffer_112[counter_buffer_112] = Ack_andcallsign[counter_Ack_andcallsign++]; /* to be changed sukhdeep should write in buffer_112*/\ 00141 if(counter_Ack_andcallsign == 318){\ 00142 counter_Ack_andcallsign = 0;\ 00143 T_frames_sent = T_frames_sent +2;\ 00144 if(repeat_last_2T_frames){\ 00145 /*cout<<"repeated last two T frames"<<" ";*/\ 00146 /*cout<<"T_frames_sent = "<<T_frames_sent<<ENDL;*/\ 00147 }\ 00148 else{\ 00149 /*cout<<"Ackandcallsign sent"<<" ";*/\ 00150 /*cout<<"T_frames_sent = "<<T_frames_sent<<ENDL;*/\ 00151 T_frame_Ack_andcallsign_sent = T_frame_Ack_andcallsign_sent + 2;\ 00152 if(T_frame_Ack_andcallsign_sent == T_frame_in_Ackandcallsign ){\ 00153 repeat_last_2T_frames = true;\ 00154 }\ 00155 else if(T_frame_Ack_andcallsign_sent < T_frame_in_Ackandcallsign){\ 00156 make_T_frame_Ack_andcallsign;\ 00157 }\ 00158 else{\ 00159 /*cout<<"error in send_Ack_andcallsign if T_frames_sent < T_frames_in_segment"<<ENDL;*/\ 00160 }\ 00161 }\ 00162 if(T_frames_sent == T_frames_in_segment){\ 00163 if(T_frame_Ack_andcallsign_sent < T_frame_in_Ackandcallsign){\ 00164 if(segments_sent + 1>= max_segments){\ 00165 adf_limit = true;\ 00166 segments_sent = 0;\ 00167 /*cout<<"adf limit reached"<<ENDL;*/\ 00168 }\ 00169 else{\ 00170 enable_new_segment = true;\ 00171 /*cout<<"new segment"<<ENDL;*/\ 00172 }\ 00173 }\ 00174 else{\ 00175 send_EoS_and_stop = true; \ 00176 } \ 00177 }\ 00178 }\ 00179 }\ 00180 else if(send_EoS_and_stop){\ 00181 buffer_112[counter_buffer_112] = EoS[counter_EoS++];\ 00182 if(counter_EoS == 120){\ 00183 /*cout<<"segments_sent = "<<segments_sent<<ENDL;*/\ 00184 /*cout<<"EoS sent"<<ENDL;*/\ 00185 counter_EoS = 0;\ 00186 enable_ackandcallsign = false;\ 00187 stop =true;\ 00188 last_buffer = true;\ 00189 }\ 00190 }\ 00191 else if(adf_limit){\ 00192 buffer_112[counter_buffer_112] = EoS[counter_EoS++];\ 00193 if(counter_EoS == 120){\ 00194 counter_EoS = 0;\ 00195 /*cout<<"EoS sent"<<ENDL;*/\ 00196 restart_adf();\ 00197 enable_new_segment = true;\ 00198 /*cout<<"new session"<<ENDL;*/\ 00199 /*cout<<"new segment"<<ENDL;*/\ 00200 T_frames_sent = 0;\ 00201 segments_sent = 0; \ 00202 adf_limit = false;\ 00203 }\ 00204 }\ 00205 else{\ 00206 gPC.printf("error in send_Ack_andcallsign()");\ 00207 }\ 00208 } 00209 #define send_S_frame {\ 00210 buffer_112[counter_buffer_112] = S_frame[counter_S_frame++];\ 00211 if(counter_S_frame == 48){\ 00212 enable_new_segment=false;\ 00213 counter_S_frame = 0;\ 00214 /*cout<<"S_frame_sent"<<ENDL;*/\ 00215 if(new_OBSRS_TC){\ 00216 enable_call_sign = true;\ 00217 new_OBSRS_TC = false;\ 00218 }\ 00219 else{\ 00220 enable_read_block = true;\ 00221 }\ 00222 }\ 00223 } 00224 00225 #define send_call_sign {\ 00226 buffer_112[counter_buffer_112] = call_sign_buffer[counter_call_sign_buffer++];\ 00227 if(counter_call_sign_buffer == 318){\ 00228 counter_call_sign_buffer = 0;\ 00229 enable_call_sign = false;\ 00230 new_session =false;\ 00231 /*cout<<"call_sign_sent"<<" ";*/\ 00232 T_frames_sent = T_frames_sent+2;\ 00233 if(SID==0x0 || SID==0x2 || SID==0x3 || SID==0x4 || SID==0x5){\ 00234 valid_SID=true;\ 00235 /*cout<<"valid SID"<<ENDL;*/\ 00236 }\ 00237 else{\ 00238 valid_SID=false;\ 00239 gPC.printf("invalid SID");\ 00240 enable_ackandcallsign = true;\ 00241 create_Ack_andcallsign = true;\ 00242 ack_code = 0x02;\ 00243 }\ 00244 check_PA_temp;\ 00245 /*cout<<"pa_hot = "<<PA_HOT<<ENDL;*/\ 00246 if(PA_HOT){\ 00247 enable_ackandcallsign = true;\ 00248 create_Ack_andcallsign = true;\ 00249 enable_read_block = false;\ 00250 }\ 00251 else{\ 00252 enable_read_block = true;\ 00253 enable_ackandcallsign = false;\ 00254 }\ 00255 }\ 00256 } 00257 00258 //uint16_t SD_READ(uint64_t block_to_read){ 00259 // for(int i=0;i<318;i++){ 00260 // buffer_512[counter_buffer_512++] = 0xff; 00261 // } 00262 // for(int i=319;i<512;i++){ 00263 // buffer_512[counter_buffer_512++] = 0x00; 00264 // } 00265 // counter_buffer_512 = 0; 00266 // return 0xA0; // if success 00267 //// return 0x85; // Hardware failure 00268 // // return 0x86; // invalid TC 00269 //} 00270 00271 void send_tm_from_SD_card(){ 00272 for(counter_buffer_112=0;counter_buffer_112<112;counter_buffer_112++){ 00273 if(enable_new_segment){ // starting new segment 00274 send_S_frame; 00275 T_frames_sent=0; 00276 } 00277 else if(enable_call_sign){ // sending call sign 00278 send_call_sign ; 00279 } 00280 else if(enable_T_frame){ 00281 if(read_success == 0){ 00282 if(T_frames_sent < T_frames_in_segment){ 00283 if (enable_SCH) 00284 { 00285 buffer_112[counter_buffer_112] = SCH40[counter_SCH40++]; 00286 if (counter_SCH40 == 5) 00287 { 00288 // cout<<"sch sent"<<ENDL; 00289 counter_SCH40 = 0; 00290 enable_SCH = false; 00291 enable_DS = true; 00292 } 00293 } 00294 else if (enable_DS) 00295 { 00296 buffer_112[counter_buffer_112] = buffer_512[counter_buffer_512++]; 00297 if ((counter_buffer_512 == 288) || (counter_buffer_512 == 144)) 00298 { 00299 // cout<<"ds sent"<<ENDL; 00300 // counter_buffer_512 = 0; 00301 enable_DS = false; 00302 enable_FCCH = true; 00303 } 00304 } 00305 else if (enable_FCCH) 00306 { 00307 buffer_112[counter_buffer_112] = FCCH80[counter_FCCH80++]; 00308 if (counter_FCCH80 == 10) 00309 { 00310 // cout<<"fcch sent"<<ENDL; 00311 enable_FCCH = false; 00312 if(counter_buffer_512 == 144){ 00313 enable_SCH = true; 00314 counter_FCCH80 = 0; 00315 } 00316 else{ 00317 00318 } 00319 } 00320 } 00321 if((counter_FCCH80 == 10)&&(counter_buffer_512 == 288)){ 00322 counter_FCCH80 = 0; 00323 counter_buffer_512 = 0; 00324 T_frames_sent = T_frames_sent+2; 00325 // cout<<"T_frames_sent "<<T_frames_sent<<ENDL; 00326 if(last_block){ 00327 // cout<<"last block"<<endl<<"\r"; 00328 enable_read_block = false; 00329 enable_T_frame = false; 00330 enable_ackandcallsign = true; 00331 create_Ack_andcallsign = true; 00332 if(T_frames_sent == T_frames_in_segment){ 00333 if(segments_sent + 1>= max_segments){ 00334 adf_limit = true; 00335 segments_sent = 0; 00336 gPC.printf("adf limit reached here"); 00337 } 00338 else{ 00339 enable_new_segment = true; 00340 // cout<<"new segment"<<ENDL; 00341 } 00342 } 00343 continue; 00344 } 00345 else{ 00346 check_PA_temp; 00347 // cout<<"pa_hot = "<<PA_HOT<<" "; 00348 if(PA_HOT){ 00349 enable_T_frame = false; 00350 enable_read_block = false; 00351 enable_ackandcallsign = true; 00352 create_Ack_andcallsign = true; 00353 } 00354 else{ 00355 enable_read_block = true; 00356 } 00357 } 00358 if(T_frames_sent == T_frames_in_segment){ 00359 enable_read_block = false; 00360 enable_T_frame = false; 00361 if((segments_sent + 1) >= max_segments){ 00362 adf_limit = true; 00363 segments_sent++; 00364 // gPC.printf("segments_sent = "<<segments_sent<<ENDL; 00365 gPC.printf("in for adf limit reached"); 00366 } 00367 else{ 00368 enable_new_segment = true; 00369 gPC.printf("data in next segment"); 00370 segments_sent++; 00371 // cout<<"segments_sent = "<<segments_sent<<ENDL; 00372 } 00373 } 00374 else if(T_frames_sent > T_frames_in_segment){ 00375 gPC.printf("error in enable T_frame"); 00376 } 00377 } 00378 } 00379 else if(T_frames_sent > T_frames_in_segment){ 00380 gPC.printf("error in if(read_success)"); 00381 } 00382 } 00383 else{ 00384 gPC.printf("error in enable T_frame"); 00385 } 00386 } 00387 else if(adf_limit){ 00388 buffer_112[counter_buffer_112] = EoS[counter_EoS++]; 00389 if(counter_EoS == 120){ 00390 // cout<<"EoS sent"<<ENDL; 00391 restart_adf(); 00392 enable_new_segment = true; 00393 counter_EoS = 0; 00394 // cout<<"new session"<<ENDL; 00395 // cout<<"new segment"<<ENDL; 00396 T_frames_sent = 0; 00397 segments_sent = 0; 00398 adf_limit = false; 00399 } 00400 } 00401 else if(stop){ 00402 // cout<<"Done bro"<<ENDL; 00403 break; 00404 } 00405 else if(enable_ackandcallsign){ 00406 if(create_Ack_andcallsign){ 00407 create_Ack_L234; 00408 Ack_L1 = get_Ack_L1(); 00409 make_T_frame_Ack_andcallsign; 00410 create_Ack_andcallsign = false; 00411 } 00412 send_Ack_andcallsign; 00413 } 00414 00415 else if(enable_EoS){ 00416 // send_EoS(); 00417 buffer_112[counter_buffer_112] = EoS[counter_EoS++]; 00418 if(counter_EoS == 120){ 00419 // cout<<"segments_sent = "<<segments_sent<<ENDL; 00420 // cout<<"EoS sent"<<ENDL; 00421 counter_EoS = 0; 00422 enable_EoS=false; 00423 enable_new_segment = true; 00424 break; 00425 } 00426 else{ 00427 gPC.printf("Error in enable EoS"); 00428 } 00429 } 00430 else{ 00431 gPC.printf("error in for loop"); 00432 } 00433 if(enable_read_block && (!last_block)){ 00434 if(short_TC){ 00435 /*cout<<"reading"<<int(FSC)<<" "<<int(SID)<<ENDL;*/ 00436 // for(int i=0;i<512;i++){ 00437 // printf("0x%02X,",write_buffer[i]); 00438 // } 00439 int write_success = SD_WRITE(write_buffer,FSC + block_counter,SID); 00440 // wait_ms(8); 00441 read_success = SD_READ(buffer_512, FSC + block_counter,SID); 00442 // wait_ms(8); 00443 // cout<<"read_success = "<<read_success<<ENDL<<"\r\n"; 00444 // cout<<"write_success = "<<write_success<<ENDL; 00445 // for(int i=0;i<512;i++){ 00446 // printf("0x%02X,",buffer_512[i]); 00447 // } 00448 } 00449 else{ 00450 read_success = SD_READ(buffer_512, list_of_FSC[block_counter],SID); 00451 } 00452 ack_code = read_success; 00453 block_counter++; 00454 if(block_counter == no_of_frames){ 00455 last_block=true; 00456 } 00457 enable_read_block = false; 00458 if(read_success == 0){ 00459 // cout<<"read one block successfully"<<" "; 00460 enable_T_frame = true; 00461 enable_SCH = true; 00462 } 00463 else if(ack_code == 0x85){ 00464 gPC.printf("Hardware failure"); 00465 enable_T_frame = false; 00466 } 00467 else if(ack_code == 0x86){ 00468 gPC.printf("Invalid FSC"); 00469 enable_T_frame = false; 00470 } 00471 else{ 00472 gPC.printf("error Invalid ack code"); 00473 enable_T_frame = false; 00474 stop = true; 00475 } 00476 } 00477 if((PA_HOT || (!valid_SID)|| (read_success != 0))&&(!enable_ackandcallsign)){ 00478 enable_ackandcallsign = true; 00479 create_Ack_andcallsign = true; 00480 enable_T_frame = false; 00481 } 00482 } 00483 // for(int i=0;i<112;i++){ 00484 // printf("0x%02X,",buffer_112[i]); 00485 // } 00486 differential_encode(buffer_112, 112); 00487 if(last_buffer ==true){ 00488 diff_prev=0; 00489 } 00490 } 00491 00492 void execute_OBSRS_TC(Base_tc *tcp){ 00493 short_TC = true; 00494 pc.printf("WELCOME\n\r"); 00495 FCTN_CDMS_SD_INIT();/* sd card initialization*/ 00496 // SID = 0x0; 00497 // FSC =10; 00498 // no_of_frames =1; 00499 // short_TC = true; 00500 // adf_SND_SDCard; 00501 00502 if( GETshort_or_long_tc(tcp) == SHORT_TC_CODE ){ 00503 short_TC = true; 00504 } 00505 else{ 00506 short_TC = false; 00507 } 00508 /* reading SID from TC */ 00509 SID = (tcp->TC_string[2]) & 0x0f; 00510 /* reading FSC and no. of frames from TC */ 00511 if(short_TC){ 00512 FSC = tcp->TC_string[3] << 24; 00513 FSC += tcp->TC_string[4] << 16; 00514 FSC += tcp->TC_string[5] << 8; 00515 FSC += tcp->TC_string[6]; 00516 no_of_frames = tcp->TC_string[7] << 8; 00517 no_of_frames += tcp->TC_string[8]; 00518 } 00519 else{ 00520 no_of_frames = tcp->TC_string[3]; 00521 for(int i=0 ;i<no_of_frames ; i++){ 00522 list_of_FSC[i] = tcp->TC_string[4+i]; 00523 } 00524 } 00525 gPC.printf("sid = %u \r\n",SID); 00526 gPC.printf("FSC = %u\r\n",FSC); 00527 // cout<<"max_segments = "<<max_segments<<ENDL; 00528 //while(0){ 00529 // while(!stop){ 00530 // // send_call_sign(); 00531 // if(short_TC){ 00532 // send_tm_from_SD_card(); 00533 // } 00534 // else{ 00535 // send_tm_from_SD_card(); 00536 // } 00537 // } 00538 }
Generated on Tue Jul 12 2022 10:59:22 by 1.7.2