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