I2C code testing

Dependencies:   FreescaleIAP SimpleDMA mbed-rtos mbed

Fork of COM_MNG_TMTC_SIMPLE_pl123 by Siva ram

Committer:
krishanprajapat
Date:
Sat Feb 06 18:57:41 2016 +0000
Revision:
119:2b5632bc78ab
Parent:
118:60c5de4cb8ad
Child:
121:bd7263168ee4
removed dummy ack_l1 function

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ee12b079 86:a26f5f22631d 1 // problem in check pa and valid sid not sending anything in one for loop
ee12b079 86:a26f5f22631d 2
ee12b079 86:a26f5f22631d 3
ee12b079 86:a26f5f22631d 4
ee12b079 86:a26f5f22631d 5 // no error case 2 ackl234new->TM_string[2] = (101_0000) = 0x_0; spare = 0 10100000 = 0xA0
ee12b079 86:a26f5f22631d 6 // Hardware failure Case 4 ackl234new->TM_string[2] = (100_0101) = 0x_5; spare = 0 10000101 = 0x85 comes from cdms ask pradeep
ee12b079 86:a26f5f22631d 7 // Invalid FSC Case 4 ackl234new->TM_string[2] = (100_0110) = 0x_6; spare = 0 10000110 = 0x86 Invalid FSC
ee12b079 86:a26f5f22631d 8 // Illegal TC Case 3 ackl234new->TM_string[2] = (000_0010) = 0x_2; spare = 0 00000010 = 0x02 invalid SID
ee12b079 86:a26f5f22631d 9
ee12b079 86:a26f5f22631d 10
ee12b079 86:a26f5f22631d 11
ee12b079 86:a26f5f22631d 12 #define TMID_ACK_L234 0xB
ee12b079 113:b8991d9e3b6c 13 #define T_frames_in_segment 40
ee12b079 86:a26f5f22631d 14
ee12b079 86:a26f5f22631d 15 using namespace std;
ee12b079 86:a26f5f22631d 16
ee12b079 86:a26f5f22631d 17 bool send_EoS_and_stop = false;
ee12b079 86:a26f5f22631d 18 bool adf_limit = false;
ee12b079 86:a26f5f22631d 19 bool stop = false;
ee12b079 86:a26f5f22631d 20 bool PA_HOT=0;
ee12b079 86:a26f5f22631d 21 bool short_TC;
ee12b079 86:a26f5f22631d 22 bool valid_SID = true;
ee12b079 86:a26f5f22631d 23 bool enable_call_sign = true;
ee12b079 86:a26f5f22631d 24 bool enable_new_segment=true;
ee12b079 86:a26f5f22631d 25 bool enable_S_frame = true;
ee12b079 86:a26f5f22631d 26 bool enable_read_block = false;
ee12b079 86:a26f5f22631d 27 bool enable_T_frame = false;
ee12b079 86:a26f5f22631d 28 bool enable_Ack_andcallsign = false;
ee12b079 86:a26f5f22631d 29 bool enable_ackandcallsign = false;
ee12b079 86:a26f5f22631d 30 bool new_session =true;
ee12b079 86:a26f5f22631d 31 bool enable_EoS=false;
ee12b079 86:a26f5f22631d 32 bool create_Ack_andcallsign = true;
ee12b079 86:a26f5f22631d 33 bool Ack_andcallsign_over = false;
ee12b079 86:a26f5f22631d 34 bool repeat_last_2T_frames = false;
ee12b079 86:a26f5f22631d 35 bool last_block = false;
ee12b079 86:a26f5f22631d 36 bool last_buffer = false;
ee12b079 86:a26f5f22631d 37 bool new_OBSRS_TC = true;
ee12b079 86:a26f5f22631d 38 bool enable_SCH = true;
ee12b079 86:a26f5f22631d 39 bool enable_FCCH = false;
ee12b079 86:a26f5f22631d 40 bool enable_DS = false;
krishanprajapat 119:2b5632bc78ab 41 bool half_buffer = 0;
ee12b079 86:a26f5f22631d 42
ee12b079 86:a26f5f22631d 43 uint8_t SID ;
ee12b079 86:a26f5f22631d 44 unsigned char buffer_112[112];
ee12b079 92:bce22b38c440 45 uint32_t FSC;
ee12b079 86:a26f5f22631d 46 uint16_t read_success = false;
ee12b079 86:a26f5f22631d 47 uint16_t counter_buffer_112=0, counter_EoS=0,T_frames_sent=0;
ee12b079 86:a26f5f22631d 48 uint16_t counter_call_sign_buffer=0;
ee12b079 86:a26f5f22631d 49 uint16_t counter_buffer_512=0;
ee12b079 86:a26f5f22631d 50 uint16_t counter_Ack_andcallsign = 0;
ee12b079 86:a26f5f22631d 51 uint16_t max_segments = 65415/(48+T_frames_in_segment*159);
ee12b079 86:a26f5f22631d 52 uint16_t ack_code = 0xA0;
ee12b079 86:a26f5f22631d 53 uint16_t segments_sent = 0;
ee12b079 86:a26f5f22631d 54 uint8_t counter_SCH40 = 0;
ee12b079 86:a26f5f22631d 55 uint8_t counter_FCCH80 = 0;
ee12b079 86:a26f5f22631d 56 uint8_t counter_S_frame = 0;
ee12b079 86:a26f5f22631d 57 uint16_t T_frame_Ack_andcallsign_sent = 0;
ee12b079 86:a26f5f22631d 58 uint16_t T_frame_in_Ackandcallsign = 4; // needs to get from sukhdeep depends on size of Ack_L1
ee12b079 86:a26f5f22631d 59 uint64_t start_block_num ;
ee12b079 88:b9beee1a7a3e 60 uint8_t block_counter = 0;
ee12b079 88:b9beee1a7a3e 61 uint8_t no_of_frames =0;
ee12b079 86:a26f5f22631d 62 int Ack_L1; // should be always even
ee12b079 86:a26f5f22631d 63
ee12b079 86:a26f5f22631d 64 //#define max_segments = 65415/(48+T_frames_in_segment*159)
ee12b079 86:a26f5f22631d 65 // 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
ee12b079 86:a26f5f22631d 66 // 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,
ee12b079 86:a26f5f22631d 67 //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};
ee12b079 86:a26f5f22631d 68 //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};
krishanprajapat 119:2b5632bc78ab 69 //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};
ee12b079 86:a26f5f22631d 70 //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};
ee12b079 86:a26f5f22631d 71 uint8_t buffer_512[512];
ee12b079 86:a26f5f22631d 72 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};
ee12b079 86:a26f5f22631d 73 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};
krishanprajapat 119:2b5632bc78ab 74 //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};
ee12b079 86:a26f5f22631d 75 //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};
ee12b079 86:a26f5f22631d 76 //const unsigned char FCCH80[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
ee12b079 86:a26f5f22631d 77 //const unsigned char SCH40[] = {0x0a,0x3f,0x46,0xb4,0x00};
ee12b079 86:a26f5f22631d 78
ee12b079 86:a26f5f22631d 79
ee12b079 86:a26f5f22631d 80
ee12b079 86:a26f5f22631d 81
ee12b079 86:a26f5f22631d 82 #define create_Ack_L234 {\
ee12b079 86:a26f5f22631d 83 Base_tm *ackl234new = new Short_tm;\
ee12b079 86:a26f5f22631d 84 ackl234new->next_TM = NULL;\
ee12b079 86:a26f5f22631d 85 /*return telemetry pointer here*/\
ee12b079 86:a26f5f22631d 86 ackl234new->TM_string[0] = TMID_ACK_L234 << 4;\
ee12b079 86:a26f5f22631d 87 ackl234new->TM_string[1] = 0x12;\
ee12b079 86:a26f5f22631d 88 ackl234new->TM_string[2] = ack_code; /* Ack code ....to be chnaged accordind to situation */\
ee12b079 86:a26f5f22631d 89 for(int i = 3; i < 11; ++i){\
ee12b079 86:a26f5f22631d 90 ackl234new->TM_string[i] = 0x00;\
ee12b079 86:a26f5f22631d 91 }\
ee12b079 86:a26f5f22631d 92 uint16_t crc = crc16_gen(ackl234new->TM_string, TM_SHORT_SIZE-2);\
ee12b079 86:a26f5f22631d 93 ackl234new->TM_string[11] = (crc & 0xFF00) >> 8;\
ee12b079 86:a26f5f22631d 94 ackl234new->TM_string[12] = crc & 0x00FF; \
ee12b079 86:a26f5f22631d 95 }
ee12b079 86:a26f5f22631d 96
ee12b079 86:a26f5f22631d 97 #define make_T_frame_Ack_andcallsign {\
ee12b079 86:a26f5f22631d 98 }
ee12b079 86:a26f5f22631d 99
ee12b079 86:a26f5f22631d 100 void restart_adf(){
ee12b079 86:a26f5f22631d 101
ee12b079 86:a26f5f22631d 102 }
ee12b079 86:a26f5f22631d 103
ee12b079 86:a26f5f22631d 104 int diff_prev;
ee12b079 86:a26f5f22631d 105 void differential_encode(unsigned char* ptr, int length){
ee12b079 86:a26f5f22631d 106 for(int i=0; i<length;i++){
ee12b079 86:a26f5f22631d 107 unsigned char s = ptr[i] , t;
ee12b079 86:a26f5f22631d 108 t = s ^ (s >> 1);
ee12b079 86:a26f5f22631d 109 (diff_prev == 0) ? t=t^0x00 : t=t^0x80 ;
ee12b079 86:a26f5f22631d 110 diff_prev = int(s & 0x01);
ee12b079 86:a26f5f22631d 111 ptr[i] = t;
ee12b079 86:a26f5f22631d 112 }
ee12b079 86:a26f5f22631d 113 }
ee12b079 86:a26f5f22631d 114
ee12b079 86:a26f5f22631d 115 #define check_PA_temp {\
ee12b079 86:a26f5f22631d 116 /* return 0 or 1*/\
ee12b079 86:a26f5f22631d 117 PA_HOT=0;\
ee12b079 86:a26f5f22631d 118 }
ee12b079 86:a26f5f22631d 119
ee12b079 86:a26f5f22631d 120 int get_Ack_L1(){
ee12b079 86:a26f5f22631d 121 for(int i=0;i<288;i++){
ee12b079 86:a26f5f22631d 122 // Ack_andcallsign[i] = 0xff;
ee12b079 86:a26f5f22631d 123 }
ee12b079 86:a26f5f22631d 124 //cout<<"in side get_Ack_L1"<<endl<<"\r";
ee12b079 86:a26f5f22631d 125 return 1;
ee12b079 86:a26f5f22631d 126 }
ee12b079 86:a26f5f22631d 127
ee12b079 86:a26f5f22631d 128 #define send_Ack_andcallsign{\
ee12b079 86:a26f5f22631d 129 if(T_frames_sent < T_frames_in_segment){\
ee12b079 86:a26f5f22631d 130 buffer_112[counter_buffer_112] = Ack_andcallsign[counter_Ack_andcallsign++]; /* to be changed sukhdeep should write in buffer_112*/\
ee12b079 86:a26f5f22631d 131 if(counter_Ack_andcallsign == 318){\
ee12b079 86:a26f5f22631d 132 counter_Ack_andcallsign = 0;\
ee12b079 86:a26f5f22631d 133 T_frames_sent = T_frames_sent +2;\
ee12b079 86:a26f5f22631d 134 if(repeat_last_2T_frames){\
ee12b079 86:a26f5f22631d 135 /*cout<<"repeated last two T frames"<<" ";*/\
ee12b079 86:a26f5f22631d 136 /*cout<<"T_frames_sent = "<<T_frames_sent<<ENDL;*/\
ee12b079 86:a26f5f22631d 137 }\
ee12b079 86:a26f5f22631d 138 else{\
ee12b079 86:a26f5f22631d 139 /*cout<<"Ackandcallsign sent"<<" ";*/\
ee12b079 86:a26f5f22631d 140 /*cout<<"T_frames_sent = "<<T_frames_sent<<ENDL;*/\
ee12b079 86:a26f5f22631d 141 T_frame_Ack_andcallsign_sent = T_frame_Ack_andcallsign_sent + 2;\
ee12b079 86:a26f5f22631d 142 if(T_frame_Ack_andcallsign_sent == T_frame_in_Ackandcallsign ){\
ee12b079 86:a26f5f22631d 143 repeat_last_2T_frames = true;\
ee12b079 86:a26f5f22631d 144 }\
ee12b079 86:a26f5f22631d 145 else if(T_frame_Ack_andcallsign_sent < T_frame_in_Ackandcallsign){\
ee12b079 86:a26f5f22631d 146 make_T_frame_Ack_andcallsign;\
ee12b079 86:a26f5f22631d 147 }\
ee12b079 86:a26f5f22631d 148 else{\
ee12b079 86:a26f5f22631d 149 /*cout<<"error in send_Ack_andcallsign if T_frames_sent < T_frames_in_segment"<<ENDL;*/\
ee12b079 86:a26f5f22631d 150 }\
ee12b079 86:a26f5f22631d 151 }\
ee12b079 86:a26f5f22631d 152 if(T_frames_sent == T_frames_in_segment){\
ee12b079 86:a26f5f22631d 153 if(T_frame_Ack_andcallsign_sent < T_frame_in_Ackandcallsign){\
ee12b079 86:a26f5f22631d 154 if(segments_sent + 1>= max_segments){\
ee12b079 86:a26f5f22631d 155 adf_limit = true;\
ee12b079 86:a26f5f22631d 156 segments_sent = 0;\
ee12b079 86:a26f5f22631d 157 /*cout<<"adf limit reached"<<ENDL;*/\
ee12b079 86:a26f5f22631d 158 }\
ee12b079 86:a26f5f22631d 159 else{\
ee12b079 86:a26f5f22631d 160 enable_new_segment = true;\
ee12b079 86:a26f5f22631d 161 /*cout<<"new segment"<<ENDL;*/\
ee12b079 86:a26f5f22631d 162 }\
ee12b079 86:a26f5f22631d 163 }\
ee12b079 86:a26f5f22631d 164 else{\
ee12b079 86:a26f5f22631d 165 send_EoS_and_stop = true; \
ee12b079 86:a26f5f22631d 166 } \
ee12b079 86:a26f5f22631d 167 }\
ee12b079 86:a26f5f22631d 168 }\
ee12b079 86:a26f5f22631d 169 }\
ee12b079 86:a26f5f22631d 170 else if(send_EoS_and_stop){\
ee12b079 86:a26f5f22631d 171 buffer_112[counter_buffer_112] = EoS[counter_EoS++];\
ee12b079 86:a26f5f22631d 172 if(counter_EoS == 120){\
ee12b079 86:a26f5f22631d 173 /*cout<<"segments_sent = "<<segments_sent<<ENDL;*/\
ee12b079 86:a26f5f22631d 174 /*cout<<"EoS sent"<<ENDL;*/\
ee12b079 86:a26f5f22631d 175 counter_EoS = 0;\
ee12b079 86:a26f5f22631d 176 enable_ackandcallsign = false;\
ee12b079 86:a26f5f22631d 177 stop =true;\
ee12b079 86:a26f5f22631d 178 last_buffer = true;\
ee12b079 86:a26f5f22631d 179 }\
ee12b079 86:a26f5f22631d 180 }\
ee12b079 86:a26f5f22631d 181 else if(adf_limit){\
ee12b079 86:a26f5f22631d 182 buffer_112[counter_buffer_112] = EoS[counter_EoS++];\
ee12b079 86:a26f5f22631d 183 if(counter_EoS == 120){\
ee12b079 86:a26f5f22631d 184 counter_EoS = 0;\
ee12b079 86:a26f5f22631d 185 /*cout<<"EoS sent"<<ENDL;*/\
ee12b079 86:a26f5f22631d 186 restart_adf();\
ee12b079 86:a26f5f22631d 187 enable_new_segment = true;\
ee12b079 86:a26f5f22631d 188 /*cout<<"new session"<<ENDL;*/\
ee12b079 86:a26f5f22631d 189 /*cout<<"new segment"<<ENDL;*/\
ee12b079 86:a26f5f22631d 190 T_frames_sent = 0;\
ee12b079 86:a26f5f22631d 191 segments_sent = 0; \
ee12b079 86:a26f5f22631d 192 adf_limit = false;\
ee12b079 86:a26f5f22631d 193 }\
ee12b079 86:a26f5f22631d 194 }\
ee12b079 86:a26f5f22631d 195 else{\
ee12b079 86:a26f5f22631d 196 gPC.printf("error in send_Ack_andcallsign()");\
ee12b079 86:a26f5f22631d 197 }\
ee12b079 86:a26f5f22631d 198 }
ee12b079 86:a26f5f22631d 199 #define send_S_frame {\
ee12b079 86:a26f5f22631d 200 buffer_112[counter_buffer_112] = S_frame[counter_S_frame++];\
ee12b079 86:a26f5f22631d 201 if(counter_S_frame == 48){\
ee12b079 86:a26f5f22631d 202 enable_new_segment=false;\
ee12b079 86:a26f5f22631d 203 counter_S_frame = 0;\
ee12b079 86:a26f5f22631d 204 /*cout<<"S_frame_sent"<<ENDL;*/\
ee12b079 86:a26f5f22631d 205 if(new_OBSRS_TC){\
ee12b079 86:a26f5f22631d 206 enable_call_sign = true;\
ee12b079 86:a26f5f22631d 207 new_OBSRS_TC = false;\
krishanprajapat 118:60c5de4cb8ad 208 Base_tm *callsign = NULL;\
krishanprajapat 118:60c5de4cb8ad 209 get_call_sign(callsign);\
krishanprajapat 119:2b5632bc78ab 210 snd_tm.head_pointer(callsign);\
krishanprajapat 119:2b5632bc78ab 211 int temp = snd_tm.make_shor_tm();\
ee12b079 86:a26f5f22631d 212 }\
ee12b079 86:a26f5f22631d 213 else{\
ee12b079 86:a26f5f22631d 214 enable_read_block = true;\
ee12b079 86:a26f5f22631d 215 }\
ee12b079 86:a26f5f22631d 216 }\
ee12b079 86:a26f5f22631d 217 }
ee12b079 86:a26f5f22631d 218
ee12b079 86:a26f5f22631d 219 #define send_call_sign {\
krishanprajapat 119:2b5632bc78ab 220 if (enable_SCH)\
krishanprajapat 119:2b5632bc78ab 221 {\
krishanprajapat 119:2b5632bc78ab 222 buffer_112[counter_buffer_112] = SCH40[counter_SCH40++];\
krishanprajapat 119:2b5632bc78ab 223 if (counter_SCH40 == 5)\
krishanprajapat 119:2b5632bc78ab 224 { \
krishanprajapat 119:2b5632bc78ab 225 counter_SCH40 = 0;\
krishanprajapat 119:2b5632bc78ab 226 enable_SCH = false;\
krishanprajapat 119:2b5632bc78ab 227 enable_DS = true;\
krishanprajapat 119:2b5632bc78ab 228 }\
krishanprajapat 119:2b5632bc78ab 229 }\
krishanprajapat 119:2b5632bc78ab 230 else if (enable_DS)\
krishanprajapat 119:2b5632bc78ab 231 {\
krishanprajapat 119:2b5632bc78ab 232 buffer_112[counter_buffer_112] = interleave_data[half_buffer][counter_call_sign_buffer++];\
krishanprajapat 119:2b5632bc78ab 233 if (counter_call_sign_buffer == 144)\
krishanprajapat 119:2b5632bc78ab 234 { \
krishanprajapat 119:2b5632bc78ab 235 enable_DS = false;\
krishanprajapat 119:2b5632bc78ab 236 enable_FCCH = true;\
krishanprajapat 119:2b5632bc78ab 237 }\
krishanprajapat 119:2b5632bc78ab 238 }\
krishanprajapat 119:2b5632bc78ab 239 else if (enable_FCCH)\
krishanprajapat 119:2b5632bc78ab 240 {\
krishanprajapat 119:2b5632bc78ab 241 buffer_112[counter_buffer_112] = FCCH80[counter_FCCH80++];\
krishanprajapat 119:2b5632bc78ab 242 if (counter_FCCH80 == 10)\
krishanprajapat 119:2b5632bc78ab 243 {\
krishanprajapat 119:2b5632bc78ab 244 enable_FCCH = false;\
krishanprajapat 119:2b5632bc78ab 245 if(half_buffer == 0){\
krishanprajapat 119:2b5632bc78ab 246 enable_SCH = true;\
krishanprajapat 119:2b5632bc78ab 247 half_buffer = 1;\
krishanprajapat 119:2b5632bc78ab 248 counter_FCCH80 = 0;\
krishanprajapat 119:2b5632bc78ab 249 }\
krishanprajapat 119:2b5632bc78ab 250 }\
krishanprajapat 119:2b5632bc78ab 251 }\
krishanprajapat 119:2b5632bc78ab 252 if((counter_call_sign_buffer == 144) && (half_buffer ==1)){\
ee12b079 86:a26f5f22631d 253 counter_call_sign_buffer = 0;\
krishanprajapat 119:2b5632bc78ab 254 half_buffer =0;\
ee12b079 86:a26f5f22631d 255 enable_call_sign = false;\
ee12b079 86:a26f5f22631d 256 new_session =false;\
ee12b079 86:a26f5f22631d 257 /*cout<<"call_sign_sent"<<" ";*/\
ee12b079 86:a26f5f22631d 258 T_frames_sent = T_frames_sent+2;\
krishanprajapat 119:2b5632bc78ab 259 if(SID==0x1 || SID==0x2 || SID==0x3 || SID==0x4 || SID==0x5){\
ee12b079 86:a26f5f22631d 260 valid_SID=true;\
ee12b079 86:a26f5f22631d 261 /*cout<<"valid SID"<<ENDL;*/\
ee12b079 86:a26f5f22631d 262 }\
ee12b079 86:a26f5f22631d 263 else{\
ee12b079 86:a26f5f22631d 264 valid_SID=false;\
ee12b079 92:bce22b38c440 265 /*gPC.printf("invalid SID");*/\
ee12b079 86:a26f5f22631d 266 enable_ackandcallsign = true;\
ee12b079 86:a26f5f22631d 267 create_Ack_andcallsign = true;\
ee12b079 86:a26f5f22631d 268 ack_code = 0x02;\
ee12b079 86:a26f5f22631d 269 }\
ee12b079 86:a26f5f22631d 270 check_PA_temp;\
ee12b079 86:a26f5f22631d 271 /*cout<<"pa_hot = "<<PA_HOT<<ENDL;*/\
ee12b079 86:a26f5f22631d 272 if(PA_HOT){\
ee12b079 86:a26f5f22631d 273 enable_ackandcallsign = true;\
ee12b079 86:a26f5f22631d 274 create_Ack_andcallsign = true;\
ee12b079 86:a26f5f22631d 275 enable_read_block = false;\
ee12b079 86:a26f5f22631d 276 }\
ee12b079 86:a26f5f22631d 277 else{\
ee12b079 86:a26f5f22631d 278 enable_read_block = true;\
ee12b079 86:a26f5f22631d 279 enable_ackandcallsign = false;\
ee12b079 86:a26f5f22631d 280 }\
ee12b079 86:a26f5f22631d 281 }\
ee12b079 86:a26f5f22631d 282 }
ee12b079 86:a26f5f22631d 283
ee12b079 86:a26f5f22631d 284 //uint16_t SD_READ(uint64_t block_to_read){
ee12b079 86:a26f5f22631d 285 // for(int i=0;i<318;i++){
ee12b079 86:a26f5f22631d 286 // buffer_512[counter_buffer_512++] = 0xff;
ee12b079 86:a26f5f22631d 287 // }
ee12b079 86:a26f5f22631d 288 // for(int i=319;i<512;i++){
ee12b079 86:a26f5f22631d 289 // buffer_512[counter_buffer_512++] = 0x00;
ee12b079 86:a26f5f22631d 290 // }
ee12b079 86:a26f5f22631d 291 // counter_buffer_512 = 0;
ee12b079 86:a26f5f22631d 292 // return 0xA0; // if success
ee12b079 86:a26f5f22631d 293 //// return 0x85; // Hardware failure
ee12b079 86:a26f5f22631d 294 // // return 0x86; // invalid TC
ee12b079 86:a26f5f22631d 295 //}
ee12b079 86:a26f5f22631d 296
ee12b079 95:42d6747900cb 297 void send_tm_from_SD_card_fun(){
ee12b079 86:a26f5f22631d 298 for(counter_buffer_112=0;counter_buffer_112<112;counter_buffer_112++){
ee12b079 86:a26f5f22631d 299 if(enable_new_segment){ // starting new segment
ee12b079 86:a26f5f22631d 300 send_S_frame;
ee12b079 86:a26f5f22631d 301 T_frames_sent=0;
ee12b079 86:a26f5f22631d 302 }
ee12b079 86:a26f5f22631d 303 else if(enable_call_sign){ // sending call sign
ee12b079 86:a26f5f22631d 304 send_call_sign ;
ee12b079 86:a26f5f22631d 305 }
ee12b079 86:a26f5f22631d 306 else if(enable_T_frame){
ee12b079 86:a26f5f22631d 307 if(read_success == 0){
ee12b079 86:a26f5f22631d 308 if(T_frames_sent < T_frames_in_segment){
ee12b079 86:a26f5f22631d 309 if (enable_SCH)
ee12b079 86:a26f5f22631d 310 {
ee12b079 86:a26f5f22631d 311 buffer_112[counter_buffer_112] = SCH40[counter_SCH40++];
ee12b079 86:a26f5f22631d 312 if (counter_SCH40 == 5)
ee12b079 86:a26f5f22631d 313 {
ee12b079 86:a26f5f22631d 314 // cout<<"sch sent"<<ENDL;
ee12b079 86:a26f5f22631d 315 counter_SCH40 = 0;
ee12b079 86:a26f5f22631d 316 enable_SCH = false;
ee12b079 86:a26f5f22631d 317 enable_DS = true;
ee12b079 86:a26f5f22631d 318 }
ee12b079 86:a26f5f22631d 319 }
ee12b079 86:a26f5f22631d 320 else if (enable_DS)
ee12b079 86:a26f5f22631d 321 {
ee12b079 86:a26f5f22631d 322 buffer_112[counter_buffer_112] = buffer_512[counter_buffer_512++];
ee12b079 86:a26f5f22631d 323 if ((counter_buffer_512 == 288) || (counter_buffer_512 == 144))
ee12b079 86:a26f5f22631d 324 {
ee12b079 86:a26f5f22631d 325 // cout<<"ds sent"<<ENDL;
ee12b079 86:a26f5f22631d 326 // counter_buffer_512 = 0;
ee12b079 86:a26f5f22631d 327 enable_DS = false;
ee12b079 86:a26f5f22631d 328 enable_FCCH = true;
ee12b079 86:a26f5f22631d 329 }
ee12b079 86:a26f5f22631d 330 }
ee12b079 86:a26f5f22631d 331 else if (enable_FCCH)
ee12b079 86:a26f5f22631d 332 {
ee12b079 86:a26f5f22631d 333 buffer_112[counter_buffer_112] = FCCH80[counter_FCCH80++];
ee12b079 86:a26f5f22631d 334 if (counter_FCCH80 == 10)
ee12b079 86:a26f5f22631d 335 {
ee12b079 86:a26f5f22631d 336 // cout<<"fcch sent"<<ENDL;
ee12b079 86:a26f5f22631d 337 enable_FCCH = false;
ee12b079 86:a26f5f22631d 338 if(counter_buffer_512 == 144){
ee12b079 86:a26f5f22631d 339 enable_SCH = true;
ee12b079 86:a26f5f22631d 340 counter_FCCH80 = 0;
ee12b079 86:a26f5f22631d 341 }
ee12b079 86:a26f5f22631d 342 else{
ee12b079 86:a26f5f22631d 343
ee12b079 86:a26f5f22631d 344 }
ee12b079 86:a26f5f22631d 345 }
ee12b079 86:a26f5f22631d 346 }
ee12b079 86:a26f5f22631d 347 if((counter_FCCH80 == 10)&&(counter_buffer_512 == 288)){
ee12b079 86:a26f5f22631d 348 counter_FCCH80 = 0;
ee12b079 86:a26f5f22631d 349 counter_buffer_512 = 0;
ee12b079 86:a26f5f22631d 350 T_frames_sent = T_frames_sent+2;
ee12b079 86:a26f5f22631d 351 // cout<<"T_frames_sent "<<T_frames_sent<<ENDL;
ee12b079 86:a26f5f22631d 352 if(last_block){
ee12b079 86:a26f5f22631d 353 // cout<<"last block"<<endl<<"\r";
ee12b079 86:a26f5f22631d 354 enable_read_block = false;
ee12b079 86:a26f5f22631d 355 enable_T_frame = false;
ee12b079 86:a26f5f22631d 356 enable_ackandcallsign = true;
ee12b079 86:a26f5f22631d 357 create_Ack_andcallsign = true;
ee12b079 86:a26f5f22631d 358 if(T_frames_sent == T_frames_in_segment){
ee12b079 86:a26f5f22631d 359 if(segments_sent + 1>= max_segments){
ee12b079 86:a26f5f22631d 360 adf_limit = true;
ee12b079 86:a26f5f22631d 361 segments_sent = 0;
ee12b079 92:bce22b38c440 362 // gPC.printf("adf limit reached here");
ee12b079 86:a26f5f22631d 363 }
ee12b079 86:a26f5f22631d 364 else{
ee12b079 86:a26f5f22631d 365 enable_new_segment = true;
ee12b079 86:a26f5f22631d 366 // cout<<"new segment"<<ENDL;
ee12b079 86:a26f5f22631d 367 }
ee12b079 86:a26f5f22631d 368 }
ee12b079 86:a26f5f22631d 369 continue;
ee12b079 86:a26f5f22631d 370 }
ee12b079 86:a26f5f22631d 371 else{
ee12b079 86:a26f5f22631d 372 check_PA_temp;
ee12b079 86:a26f5f22631d 373 // cout<<"pa_hot = "<<PA_HOT<<" ";
ee12b079 86:a26f5f22631d 374 if(PA_HOT){
ee12b079 86:a26f5f22631d 375 enable_T_frame = false;
ee12b079 86:a26f5f22631d 376 enable_read_block = false;
ee12b079 86:a26f5f22631d 377 enable_ackandcallsign = true;
ee12b079 86:a26f5f22631d 378 create_Ack_andcallsign = true;
ee12b079 86:a26f5f22631d 379 }
ee12b079 86:a26f5f22631d 380 else{
ee12b079 86:a26f5f22631d 381 enable_read_block = true;
ee12b079 86:a26f5f22631d 382 }
ee12b079 86:a26f5f22631d 383 }
ee12b079 86:a26f5f22631d 384 if(T_frames_sent == T_frames_in_segment){
ee12b079 86:a26f5f22631d 385 enable_read_block = false;
ee12b079 86:a26f5f22631d 386 enable_T_frame = false;
ee12b079 86:a26f5f22631d 387 if((segments_sent + 1) >= max_segments){
ee12b079 86:a26f5f22631d 388 adf_limit = true;
ee12b079 86:a26f5f22631d 389 segments_sent++;
ee12b079 86:a26f5f22631d 390 // gPC.printf("segments_sent = "<<segments_sent<<ENDL;
ee12b079 92:bce22b38c440 391 // gPC.printf("in for adf limit reached");
ee12b079 86:a26f5f22631d 392 }
ee12b079 86:a26f5f22631d 393 else{
ee12b079 86:a26f5f22631d 394 enable_new_segment = true;
ee12b079 92:bce22b38c440 395 // gPC.printf("data in next segment");
ee12b079 86:a26f5f22631d 396 segments_sent++;
ee12b079 86:a26f5f22631d 397 // cout<<"segments_sent = "<<segments_sent<<ENDL;
ee12b079 86:a26f5f22631d 398 }
ee12b079 86:a26f5f22631d 399 }
ee12b079 86:a26f5f22631d 400 else if(T_frames_sent > T_frames_in_segment){
ee12b079 86:a26f5f22631d 401 gPC.printf("error in enable T_frame");
ee12b079 86:a26f5f22631d 402 }
ee12b079 86:a26f5f22631d 403 }
ee12b079 86:a26f5f22631d 404 }
ee12b079 86:a26f5f22631d 405 else if(T_frames_sent > T_frames_in_segment){
ee12b079 86:a26f5f22631d 406 gPC.printf("error in if(read_success)");
ee12b079 86:a26f5f22631d 407 }
ee12b079 86:a26f5f22631d 408 }
ee12b079 86:a26f5f22631d 409 else{
ee12b079 86:a26f5f22631d 410 gPC.printf("error in enable T_frame");
ee12b079 86:a26f5f22631d 411 }
ee12b079 86:a26f5f22631d 412 }
ee12b079 86:a26f5f22631d 413 else if(adf_limit){
ee12b079 86:a26f5f22631d 414 buffer_112[counter_buffer_112] = EoS[counter_EoS++];
ee12b079 86:a26f5f22631d 415 if(counter_EoS == 120){
ee12b079 86:a26f5f22631d 416 // cout<<"EoS sent"<<ENDL;
ee12b079 86:a26f5f22631d 417 restart_adf();
ee12b079 86:a26f5f22631d 418 enable_new_segment = true;
ee12b079 86:a26f5f22631d 419 counter_EoS = 0;
ee12b079 86:a26f5f22631d 420 // cout<<"new session"<<ENDL;
ee12b079 86:a26f5f22631d 421 // cout<<"new segment"<<ENDL;
ee12b079 86:a26f5f22631d 422 T_frames_sent = 0;
ee12b079 86:a26f5f22631d 423 segments_sent = 0;
ee12b079 86:a26f5f22631d 424 adf_limit = false;
ee12b079 86:a26f5f22631d 425 }
ee12b079 86:a26f5f22631d 426 }
ee12b079 86:a26f5f22631d 427 else if(stop){
ee12b079 86:a26f5f22631d 428 // cout<<"Done bro"<<ENDL;
ee12b079 86:a26f5f22631d 429 break;
ee12b079 86:a26f5f22631d 430 }
ee12b079 86:a26f5f22631d 431 else if(enable_ackandcallsign){
ee12b079 86:a26f5f22631d 432 if(create_Ack_andcallsign){
ee12b079 86:a26f5f22631d 433 create_Ack_L234;
ee12b079 86:a26f5f22631d 434 Ack_L1 = get_Ack_L1();
ee12b079 86:a26f5f22631d 435 make_T_frame_Ack_andcallsign;
ee12b079 86:a26f5f22631d 436 create_Ack_andcallsign = false;
ee12b079 86:a26f5f22631d 437 }
ee12b079 86:a26f5f22631d 438 send_Ack_andcallsign;
ee12b079 86:a26f5f22631d 439 }
ee12b079 86:a26f5f22631d 440
ee12b079 86:a26f5f22631d 441 else if(enable_EoS){
ee12b079 86:a26f5f22631d 442 // send_EoS();
ee12b079 86:a26f5f22631d 443 buffer_112[counter_buffer_112] = EoS[counter_EoS++];
ee12b079 86:a26f5f22631d 444 if(counter_EoS == 120){
ee12b079 86:a26f5f22631d 445 // cout<<"segments_sent = "<<segments_sent<<ENDL;
ee12b079 86:a26f5f22631d 446 // cout<<"EoS sent"<<ENDL;
ee12b079 86:a26f5f22631d 447 counter_EoS = 0;
ee12b079 86:a26f5f22631d 448 enable_EoS=false;
ee12b079 86:a26f5f22631d 449 enable_new_segment = true;
ee12b079 86:a26f5f22631d 450 break;
ee12b079 86:a26f5f22631d 451 }
ee12b079 86:a26f5f22631d 452 else{
ee12b079 86:a26f5f22631d 453 gPC.printf("Error in enable EoS");
ee12b079 86:a26f5f22631d 454 }
ee12b079 86:a26f5f22631d 455 }
ee12b079 86:a26f5f22631d 456 else{
ee12b079 86:a26f5f22631d 457 gPC.printf("error in for loop");
ee12b079 86:a26f5f22631d 458 }
ee12b079 86:a26f5f22631d 459 if(enable_read_block && (!last_block)){
ee12b079 86:a26f5f22631d 460 if(short_TC){
ee12b079 86:a26f5f22631d 461 /*cout<<"reading"<<int(FSC)<<" "<<int(SID)<<ENDL;*/
ee12b079 86:a26f5f22631d 462 // for(int i=0;i<512;i++){
ee12b079 86:a26f5f22631d 463 // printf("0x%02X,",write_buffer[i]);
ee12b079 86:a26f5f22631d 464 // }
ee12b079 98:fd99ddc0e0a1 465 //int write_success = SD_WRITE(write_buffer,FSC + block_counter,SID);
ee12b079 86:a26f5f22631d 466 // wait_ms(8);
ee12b079 99:efde3df6cd94 467 read_success = SD_READ(buffer_512, FSC + block_counter,SID);
ee12b079 86:a26f5f22631d 468 // wait_ms(8);
ee12b079 86:a26f5f22631d 469 // cout<<"read_success = "<<read_success<<ENDL<<"\r\n";
ee12b079 86:a26f5f22631d 470 // cout<<"write_success = "<<write_success<<ENDL;
ee12b079 86:a26f5f22631d 471 // for(int i=0;i<512;i++){
ee12b079 86:a26f5f22631d 472 // printf("0x%02X,",buffer_512[i]);
ee12b079 86:a26f5f22631d 473 // }
ee12b079 86:a26f5f22631d 474 }
ee12b079 86:a26f5f22631d 475 else{
ee12b079 99:efde3df6cd94 476 read_success = SD_READ(buffer_512, list_of_FSC[block_counter],SID);
ee12b079 86:a26f5f22631d 477 }
ee12b079 86:a26f5f22631d 478 ack_code = read_success;
ee12b079 86:a26f5f22631d 479 block_counter++;
ee12b079 86:a26f5f22631d 480 if(block_counter == no_of_frames){
ee12b079 86:a26f5f22631d 481 last_block=true;
ee12b079 86:a26f5f22631d 482 }
ee12b079 86:a26f5f22631d 483 enable_read_block = false;
ee12b079 86:a26f5f22631d 484 if(read_success == 0){
ee12b079 86:a26f5f22631d 485 // cout<<"read one block successfully"<<" ";
ee12b079 86:a26f5f22631d 486 enable_T_frame = true;
ee12b079 86:a26f5f22631d 487 enable_SCH = true;
ee12b079 86:a26f5f22631d 488 }
ee12b079 86:a26f5f22631d 489 else if(ack_code == 0x85){
ee12b079 86:a26f5f22631d 490 gPC.printf("Hardware failure");
ee12b079 86:a26f5f22631d 491 enable_T_frame = false;
ee12b079 86:a26f5f22631d 492 }
ee12b079 86:a26f5f22631d 493 else if(ack_code == 0x86){
ee12b079 86:a26f5f22631d 494 gPC.printf("Invalid FSC");
ee12b079 86:a26f5f22631d 495 enable_T_frame = false;
ee12b079 86:a26f5f22631d 496 }
ee12b079 86:a26f5f22631d 497 else{
ee12b079 86:a26f5f22631d 498 gPC.printf("error Invalid ack code");
ee12b079 86:a26f5f22631d 499 enable_T_frame = false;
ee12b079 86:a26f5f22631d 500 stop = true;
ee12b079 86:a26f5f22631d 501 }
ee12b079 86:a26f5f22631d 502 }
ee12b079 86:a26f5f22631d 503 if((PA_HOT || (!valid_SID)|| (read_success != 0))&&(!enable_ackandcallsign)){
ee12b079 86:a26f5f22631d 504 enable_ackandcallsign = true;
ee12b079 86:a26f5f22631d 505 create_Ack_andcallsign = true;
ee12b079 86:a26f5f22631d 506 enable_T_frame = false;
ee12b079 86:a26f5f22631d 507 }
ee12b079 86:a26f5f22631d 508 }
ee12b079 86:a26f5f22631d 509 // for(int i=0;i<112;i++){
ee12b079 86:a26f5f22631d 510 // printf("0x%02X,",buffer_112[i]);
ee12b079 86:a26f5f22631d 511 // }
ee12b079 86:a26f5f22631d 512 differential_encode(buffer_112, 112);
ee12b079 86:a26f5f22631d 513 if(last_buffer ==true){
ee12b079 86:a26f5f22631d 514 diff_prev=0;
ee12b079 86:a26f5f22631d 515 }
ee12b079 86:a26f5f22631d 516 }
ee12b079 86:a26f5f22631d 517
ee12b079 86:a26f5f22631d 518 void execute_OBSRS_TC(Base_tc *tcp){
ee12b079 95:42d6747900cb 519 sent_tmfrom_SDcard = true;
ee12b079 92:bce22b38c440 520 if( GETshort_or_long_tc(tcp) == SHORT_TC_CODE ){
ee12b079 92:bce22b38c440 521 short_TC = true;
ee12b079 92:bce22b38c440 522 gPC.printf("it is short TC\r\n");
ee12b079 92:bce22b38c440 523 }
ee12b079 92:bce22b38c440 524 else{
ee12b079 92:bce22b38c440 525 gPC.printf("it is long TC\r\n");
ee12b079 92:bce22b38c440 526 short_TC = false;
ee12b079 92:bce22b38c440 527 }
ee12b079 92:bce22b38c440 528 /* reading SID from TC */
ee12b079 92:bce22b38c440 529 SID = (tcp->TC_string[2]) & 0x0f;
ee12b079 92:bce22b38c440 530 /* reading FSC and no. of frames from TC */
ee12b079 92:bce22b38c440 531 if(short_TC){
ee12b079 92:bce22b38c440 532 FSC = tcp->TC_string[3] << 24;
ee12b079 92:bce22b38c440 533 FSC += tcp->TC_string[4] << 16;
ee12b079 92:bce22b38c440 534 FSC += tcp->TC_string[5] << 8;
ee12b079 92:bce22b38c440 535 FSC += tcp->TC_string[6];
ee12b079 92:bce22b38c440 536 no_of_frames = tcp->TC_string[7] << 8;
ee12b079 92:bce22b38c440 537 no_of_frames += tcp->TC_string[8];
ee12b079 92:bce22b38c440 538 }
ee12b079 92:bce22b38c440 539 else{
ee12b079 92:bce22b38c440 540 no_of_frames = tcp->TC_string[3];
ee12b079 92:bce22b38c440 541 for(int i=0 ;i<no_of_frames ; i++){
ee12b079 92:bce22b38c440 542 list_of_FSC[i] = tcp->TC_string[4+i];
ee12b079 92:bce22b38c440 543 }
ee12b079 92:bce22b38c440 544 }
ee12b079 100:484a687431cc 545
ee12b079 99:efde3df6cd94 546 gPC.printf("sid = %u \r\n",SID);
ee12b079 99:efde3df6cd94 547 gPC.printf("FSC = %u\r\n",FSC);
ee12b079 96:4ca92f9775e0 548 gPC.puts("exit_sdcard");
ee12b079 92:bce22b38c440 549 // SID = 0x0;
ee12b079 92:bce22b38c440 550 // FSC = 10;
ee12b079 92:bce22b38c440 551 // no_of_frames = 2;
ee12b079 86:a26f5f22631d 552 // cout<<"max_segments = "<<max_segments<<ENDL;
ee12b079 86:a26f5f22631d 553 //while(0){
ee12b079 86:a26f5f22631d 554 // while(!stop){
ee12b079 86:a26f5f22631d 555 // // send_call_sign();
ee12b079 86:a26f5f22631d 556 // if(short_TC){
ee12b079 86:a26f5f22631d 557 // send_tm_from_SD_card();
ee12b079 86:a26f5f22631d 558 // }
ee12b079 86:a26f5f22631d 559 // else{
ee12b079 86:a26f5f22631d 560 // send_tm_from_SD_card();
ee12b079 86:a26f5f22631d 561 // }
ee12b079 86:a26f5f22631d 562 // }
ee12b079 86:a26f5f22631d 563 }