sd 32 update

Dependencies:   FreescaleIAP mbed-rtos mbed

Fork of COM_MNG_TMTC_SIMPLE by Shreesha S

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers OBSRS.h Source File

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 }