##// END OF EJS Templates
HG_REPOSITORIES » LPP » INSTRUMENTATION » SOLO_LFR » DEV_PLE
RSS

Clone from http://pc-instru.lpp.polytechnique.fr:5000/DEV_PLE

First implementation of the TC checker...
paul@pc-solar1.lab-lpp.local -
r2:a683a5ce5797 default
parent child
Show More
Show file before | Show file after | Hide comments
@@ -7,20 +7,20
7 7 <Option compiler="sparc_rtems_gcc" />
8 8 <Build>
9 9 <Target title="Debug">
10 <Option output="bin\Debug\FSW-rtems" prefix_auto="1" extension_auto="1" />
11 <Option object_output="obj\Debug\" />
10 <Option output="bin/Debug/fsw" prefix_auto="1" extension_auto="1" />
11 <Option object_output="obj/Debug/" />
12 12 <Option type="1" />
13 <Option compiler="sparc_rtems_gcc" />
13 <Option compiler="sparc_rtems_gcc_compiler" />
14 14 <Compiler>
15 15 <Add option="-O3" />
16 16 <Add option="-g" />
17 <Add directory="..\header" />
18 <Add directory="..\src" />
17 <Add directory="../header" />
18 <Add directory="../src" />
19 19 </Compiler>
20 20 </Target>
21 21 <Target title="Release">
22 <Option output="bin\Release\FSW-rtems" prefix_auto="1" extension_auto="1" />
23 <Option object_output="obj\Release\" />
22 <Option output="bin/Release/FSW-rtems" prefix_auto="1" extension_auto="1" />
23 <Option object_output="obj/Release/" />
24 24 <Option type="1" />
25 25 <Option compiler="sparc_rtems_gcc" />
26 26 <Compiler>
@@ -34,11 +34,16
34 34 <Compiler>
35 35 <Add option="-Wall" />
36 36 </Compiler>
37 <Unit filename="..\header\FSW-rtems-processing.h" />
38 <Unit filename="..\src\FSW-rtems-processing.c">
37 <Unit filename="../header/FSW-rtems-processing.h" />
38 <Unit filename="../header/TC_handler.h" />
39 <Unit filename="../header/ccsds_types.h" />
40 <Unit filename="../src/FSW-rtems-processing.c">
39 41 <Option compilerVar="CC" />
40 42 </Unit>
41 <Unit filename="..\src\FSW-rtems.c">
43 <Unit filename="../src/FSW-rtems.c">
44 <Option compilerVar="CC" />
45 </Unit>
46 <Unit filename="../src/TC_handler.c">
42 47 <Option compilerVar="CC" />
43 48 </Unit>
44 49 <Extensions>
Show file before | Show file after | Hide comments
@@ -1,4 +1,4
1 # depslib dependency file v1.0
1 # depslib dependency file v1.0
2 2 1355231335 source:e:\missions\solo\dev_ple\src\fsw-rtems.c
3 3 <rtems.h>
4 4 <bsp.h>
@@ -13,25 +13,67 1355231335 source:e:\missions\solo\dev_p
13 13 <grspw.h>
14 14 <apbuart.h>
15 15 <FSW-rtems-processing.h>
16
16
17 1355231335 -processing.h>
18
17 19 1350983928 source:e:\missions\solo\dev_ple\src\grspw.c
18 20 <..\header\grspw.h>
19 21 <stdio.h>
20
22
23 1354190601
24
21 25 1350983928 e:\missions\solo\dev_ple\header\grspw.h
22
26
23 27 1351173364 source:e:\missions\solo\dev_ple\src\fsw-config.c
24 28 <drvmgr/ambapp_bus.h>
25
29
30 1354190602 bapp_bus.h>
31
26 32 1354190602 e:\missions\solo\dev_ple\src\fsw-config.c
27 33 <drvmgr/ambapp_bus.h>
28
34
29 35 1354190602 source:e:\missions\solo\dev_ple\src\fsw-rtems-processing.c
30 36 <FSW-rtems-processing.h>
31 37 <math.h>
32 38 <stdio.h>
33 39 <leon.h>
34
40
35 41 1354190601 e:\missions\solo\dev_ple\header\fsw-rtems-processing.h
36 42 <rtems.h>
37
43
44 1358144203 source:/opt/DEV_PLE/src/FSW-rtems-processing.c
45 <FSW-rtems-processing.h>
46 <math.h>
47 <stdio.h>
48 <leon.h>
49
50 1358144202 /opt/DEV_PLE/header/FSW-rtems-processing.h
51 <rtems.h>
52
53 1358441917 source:/opt/DEV_PLE/src/FSW-rtems.c
54 <rtems.h>
55 <bsp.h>
56 <rtems/confdefs.h>
57 <drvmgr/drvmgr_confdefs.h>
58 <rtems.h>
59 <errno.h>
60 <fcntl.h>
61 <stdio.h>
62 <stdlib.h>
63 <FSW-config.c>
64 <grspw.h>
65 <apbuart.h>
66 <TC_handler.h>
67 <FSW-rtems-processing.h>
68
69 1358144203 /opt/DEV_PLE/src/FSW-config.c
70 <drvmgr/ambapp_bus.h>
71
72 1358441070 source:/opt/DEV_PLE/src/TC_handler.c
73 <TC_handler.h>
74
75 1358435124 /opt/DEV_PLE/header/TC_handler.h
76 <ccsds_types.h>
77
78 1358440633 /opt/DEV_PLE/header/ccsds_types.h
79
Show file before | Show file after | Hide comments
@@ -1,13 +1,22
1 1 <?xml version="1.0" encoding="UTF-8" standalone="yes" ?>
2 2 <CodeBlocks_layout_file>
3 3 <ActiveTarget name="Debug" />
4 <File name="..\header\FSW-rtems-processing.h" open="1" top="0" tabpos="3">
5 <Cursor position="1016" topLine="1" />
4 <File name="../header/FSW-rtems-processing.h" open="0" top="0" tabpos="3">
5 <Cursor position="82" topLine="0" />
6 </File>
7 <File name="../header/TC_handler.h" open="1" top="0" tabpos="2">
8 <Cursor position="352" topLine="0" />
9 </File>
10 <File name="../header/ccsds_types.h" open="1" top="0" tabpos="3">
11 <Cursor position="1263" topLine="31" />
6 12 </File>
7 <File name="..\src\FSW-rtems-processing.c" open="1" top="0" tabpos="2">
8 <Cursor position="17123" topLine="155" />
13 <File name="../src/FSW-rtems-processing.c" open="0" top="0" tabpos="2">
14 <Cursor position="18" topLine="0" />
9 15 </File>
10 <File name="..\src\FSW-rtems.c" open="1" top="1" tabpos="1">
11 <Cursor position="14203" topLine="83" />
16 <File name="../src/FSW-rtems.c" open="1" top="1" tabpos="1">
17 <Cursor position="91" topLine="0" />
18 </File>
19 <File name="../src/TC_handler.c" open="1" top="0" tabpos="4">
20 <Cursor position="7237" topLine="36" />
12 21 </File>
13 22 </CodeBlocks_layout_file>
Show file before | Show file after | Hide comments
@@ -1,8 +1,22
1 1 #ifndef TC_HANDLER_H_INCLUDED
2 2 #define TC_HANDLER_H_INCLUDED
3 3
4 #include <..\header\ccsds_types.h>
4 #include <ccsds_types.h>
5
6 unsigned char currentTC_LEN_RCV[2]; // SHALL be equal to the current TC packet estimated packet length field
7 unsigned char currentTC_COMPUTED_CRC[2];
8 unsigned int currentTC_LEN_RCV_AsUnsignedInt;
9 unsigned int currentTM_length;
10 ccsdsTelemetryPacket_t currentTM;
11 ccsdsTelecommandPacket_t currentTC;
12 unsigned char currentTC_processedFlag;
13
14 unsigned int lookUpTableForCRC[256];
15 void InitLookUpTableForCRC();
16 void GetCRCAsTwoBytes(unsigned char* data, unsigned char* crcAsTwoBytes, unsigned int sizeOfData);
5 17
6 char TM_checker(ccsdsTelecommandSourcePacketHeader_t * TMPacket);
18 unsigned char TM_checker(ccsdsTelecommandPacket_t * TMPacket);
19 unsigned char TM_acceptance_generator(ccsdsTelecommandPacket_t * TCPacket, unsigned int code, ccsdsTelemetryPacket_t * TMPacket);
20 unsigned char TM_not_implemented_generator(ccsdsTelecommandPacket_t * TCPacket, ccsdsTelemetryPacket_t * TMPacket);
7 21
8 22 #endif // TC_HANDLER_H_INCLUDED
Show file before | Show file after | Hide comments
@@ -1,68 +1,63
1 1 #ifndef CCSDS_H_INCLUDED
2 2 #define CCSDS_H_INCLUDED
3 3
4 #define CCSDS_TELEMETRY_HEADER_LENGTH 16+4
4 #define CCSDS_TELEMETRY_HEADER_LENGTH 16+4
5 #define CCSDS_TM_PKT_MAX_SIZE 4412
5 6 #define CCSDS_TELECOMMAND_HEADER_LENGTH 10+4
6 #define CCSDS_TELECOMMAND_MAX_PACKET_LENGTH 248
7 #define CCSDS_PROCESS_ID 11
8 #define CCSDS_PACKET_CATEGORY 12
9
10 #define CCSDS_ERR_PID -1
11 #define CCSDS_ERR_CAT -2
12 #define CCSDS_ERR_LENGTH -3
13 #define CCSDS_ERR_TYPE -4
14 #define CCSDS_ERR_SUBTYPE -5
15 #define CCSDS_ERR_SRC -6
16 #define CCSDS_ERR_CRC -7
17 #define CCSDS_TM_VALID 1
7 #define CCSDS_TC_PKT_MAX_SIZE 248
8 #define CCSDS_TC_TM_PACKET_OFFSET 7
9 #define CCSDS_PROCESS_ID 76
10 #define CCSDS_PACKET_CATEGORY 12
11 #define CCSDS_DESTINATION_ID 0x21
12
13 #define SIZE_TM_LFR_TC_EXE_NOT_IMPLEMENTED 24
14 #define SIZE_TM_LFR_TC_EXE_CORRUPTED 32
18 15
19 struct ccsdsTelemetrySourcePacketHeader_str
20 {
21 unsigned char targetLogicalAddress;
22 unsigned char protocolIdentifier;
23 unsigned char reserved;
24 unsigned char userApplication;
25 unsigned char packetID[2];
26 unsigned char packetSequenceControl[2];
27 unsigned char packetLength[2];
28 unsigned char dataFieldHeader[10];
29 };
30 typedef struct ccsdsTelemetrySourcePacketHeader_str ccsdsTelemetrySourcePacketHeader_t;
16 #define ILLEGAL_APID 0
17 #define WRONG_LEN_PACKET 1
18 #define INCOR_CHECKSUM 2
19 #define ILL_TYPE 3
20 #define ILL_SUBTYPE 4
21 #define WRONG_APP_DATA 5
22 #define WRONG_CMD_CODE 6
23 #define CCSDS_TM_VALID 7
24 //
25 #define TC_NOT_EXE 40000
26 #define WRONG_SRC_ID 40001
27 #define FUNCT_NOT_IMPL 40002
28 #define FAIL_DETECTED 40003
29 #define NOT_ALLOWED 40004
30 #define CORRUPTED 40005
31 //
32 #define CCSDS_ERR_SRC 8
33 #define CCSDS_ERR_CAT 9
31 34
32 struct ccsdsTelecommandSourcePacketHeader_str
35 struct ccsdsTelemetryPacket_str
33 36 {
34 unsigned char targetLogicalAddress;
35 unsigned char protocolIdentifier;
36 unsigned char reserved;
37 unsigned char userApplication;
38 unsigned char packetID[2];
39 unsigned char packetSequenceControl[2];
40 unsigned char packetLength[2];
41 unsigned char dataFieldHeader[4];
37 volatile unsigned char targetLogicalAddress;
38 volatile unsigned char protocolIdentifier;
39 volatile unsigned char reserved;
40 volatile unsigned char userApplication;
41 volatile unsigned char packetID[2];
42 volatile unsigned char packetSequenceControl[2];
43 volatile unsigned char packetLength[2];
44 volatile unsigned char dataFieldHeader[10];
45 volatile unsigned char data[CCSDS_TM_PKT_MAX_SIZE-16];
42 46 };
43 typedef struct ccsdsTelemetrySourcePacketHeader_str ccsdsTelecommandSourcePacketHeader_t;
47 typedef struct ccsdsTelemetryPacket_str ccsdsTelemetryPacket_t;
44 48
45 // initialize the ccsds telemetry header
46 ccsdsTelemetrySourcePacketHeader_t ccsdsTelemetryHeader;
47 #define INIT_CCSDS_TELEMETRY_HEADER ccsdsTelemetryHeader.targetLogicalAddress = 0x21; \
48 ccsdsTelemetryHeader.protocolIdentifier = 0x02; \
49 ccsdsTelemetryHeader.reserved = 0x00; \
50 ccsdsTelemetryHeader.userApplication = 0x00; \
51 ccsdsTelemetryHeader.packetID[0] = 0x08; \
52 ccsdsTelemetryHeader.packetID[1] = 0xbc; \
53 ccsdsTelemetryHeader.packetSequenceControl[0] = 0xc0; \
54 ccsdsTelemetryHeader.packetSequenceControl[1] = 0x00; \
55 ccsdsTelemetryHeader.packetLength[0] = 0x00; \
56 ccsdsTelemetryHeader.packetLength[1] = 0x00; \
57 ccsdsTelemetryHeader.dataFieldHeader[0] = 0x00; \
58 ccsdsTelemetryHeader.dataFieldHeader[1] = 0x00; \
59 ccsdsTelemetryHeader.dataFieldHeader[2] = 0x00; \
60 ccsdsTelemetryHeader.dataFieldHeader[3] = 0x00; \
61 ccsdsTelemetryHeader.dataFieldHeader[4] = 0x00; \
62 ccsdsTelemetryHeader.dataFieldHeader[5] = 0x00; \
63 ccsdsTelemetryHeader.dataFieldHeader[6] = 0x00; \
64 ccsdsTelemetryHeader.dataFieldHeader[7] = 0x00; \
65 ccsdsTelemetryHeader.dataFieldHeader[8] = 0x00; \
66 ccsdsTelemetryHeader.dataFieldHeader[9] = 0x00;
49 struct ccsdsTelecommandPacket_str
50 {
51 //unsigned char targetLogicalAddress;
52 volatile unsigned char protocolIdentifier;
53 volatile unsigned char reserved;
54 volatile unsigned char userApplication;
55 volatile unsigned char packetID[2];
56 volatile unsigned char packetSequenceControl[2];
57 volatile unsigned char packetLength[2];
58 volatile unsigned char dataFieldHeader[4];
59 volatile unsigned char dataAndCRC[CCSDS_TC_PKT_MAX_SIZE-10];
60 };
61 typedef struct ccsdsTelecommandPacket_str ccsdsTelecommandPacket_t;
67 62
68 63 #endif // CCSDS_H_INCLUDED
Show file before | Show file after | Hide comments
@@ -2,20 +2,18
2 2 // GPL reminder to be added
3 3 //*************************
4 4
5 #define PRINT_MESSAGES_ON_CONSOLE // enable or disable the printf instructions
5 //#define PRINT_MESSAGES_ON_CONSOLE // enable or disable the printf instructions
6 6 #ifdef PRINT_MESSAGES_ON_CONSOLE
7 7 #define PRINTF(x) printf(x);
8 8 #define PRINTF1(x,y) printf(x,y);
9 9 #define PRINTF2(x,y,z) printf(x,y,z);
10 10 #else
11 #define PRINTF(x)
12 #define PRINTF1(x,y)
13 #define PRINTF2(x,y,z)
11 #define PRINTF(x) ;
12 #define PRINTF1(x,y) ;
13 #define PRINTF2(x,y,z) ;
14 14 #endif
15 15
16 #define CCSDS_TC_PKT_MAX_SIZE 500 // 248
17 #define CCSDS_TM_PKT_MAX_SIZE 4412
18 #define OFFSET_COARSE_TIME 4+10-1 // -1 => the receiver suppressed the target logical address
16 #define OFFSET_COARSE_TIME 4+10-1 // -1 => the receiver suppresses the target logical address
19 17 #define OFFSET_FINE_TIME OFFSET_COARSE_TIME+4
20 18 #define TC_FIFO_SIZE 5
21 19
@@ -71,8 +69,23
71 69
72 70 #include <FSW-config.c>
73 71 #include <grspw.h>
74 #include <apbuart.h>
72 #include <apbuart.h>
73 #include <TC_handler.h>
75 74 #include <FSW-rtems-processing.h>
75
76 char *errorCCSDSMsg[8] = { "ILLEGAL_APID 0",
77 "WRONG_LEN_PACKET 1",
78 "INCOR_CHECKSUM 2",
79 "ILL_TYPE 3",
80 "ILL_SUBTYPE 4",
81 "WRONG_APP_DATA 5",
82 "WRONG_CMD_CODE 6",
83 "CCSDS_TM_VALID 7"
84 };
85
86 char *tmGeneratorMsg[2] = { "NOTHING_TO_DO",
87 "TM_GENERATED"
88 };
76 89
77 90 rtems_task Init( rtems_task_argument argument); /* forward declaration needed */
78 91 rtems_task spw_recv_task(rtems_task_argument argument);
@@ -124,8 +137,7 rtems_id sem_tc_fifo_id;
124 137
125 138 rtems_task Init( rtems_task_argument ignored ) {
126 139 rtems_status_code status;
127 struct apbuart_regs_str *apbuart_regs;
128 int i;
140 //struct apbuart_regs_str *apbuart_regs;
129 141 rtems_isr_entry old_isr_handler;
130 142
131 143 Task_name[1] = rtems_build_name( 'R', 'E', 'C', 'V' );
@@ -190,28 +202,19 rtems_task Init( rtems_task_argument ign
190 202
191 203 //********************************************
192 204 // Send the console outputs on the serial port
193 apbuart_regs = (struct apbuart_regs_str *) ADDRESS_APBUART_REGISTERS;
194 apbuart_regs->ctrl = apbuart_regs->ctrl & APBUART_CTRL_REG_MASK_DB;
195 PRINTF("\n\n\n\n\nIn INIT *** Now the console is on port COM1\n")
205 //apbuart_regs = (struct apbuart_regs_str *) ADDRESS_APBUART_REGISTERS;
206 //apbuart_regs->ctrl = apbuart_regs->ctrl & APBUART_CTRL_REG_MASK_DB;
207 //PRINTF("\n\n\n\n\nIn INIT *** Now the console is on port COM1\n")
196 208 //
197 209 //********************************************
198 210
199 211 configure_spw_link();
200 212
201 for (i = 0; i<TC_FIFO_SIZE; i++){
202 if (i==TC_FIFO_SIZE-1) tc_fifo[i].next = &tc_fifo[0];
203 else tc_fifo[i].next = &tc_fifo[i+1];
204 tc_fifo[i].tc_pkt = (unsigned char *) malloc(CCSDS_TC_PKT_MAX_SIZE);
205 tc_fifo[i].tc_pktlength = 0;
206 tc_fifo[i].ready = 0;
207 }
208
209 213 status = rtems_interrupt_catch( spectral_matrices_isr, 0x1c, &old_isr_handler) ; // 0x1c comes from sparcv8.pdf p.76
210 214 if (status==RTEMS_SUCCESSFUL) PRINTF("In INIT *** rtems_interrupt_catch successfullly configured\n")
211 215
212 216 LEON_Unmask_interrupt( IRQ_SPECTRAL_MATRICES );
213 217
214
215 218 status = rtems_task_start( Task_id[2], spw_tcck_task, 1 );
216 219 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_TCCK\n")
217 220
@@ -221,8 +224,8 rtems_task Init( rtems_task_argument ign
221 224 status = rtems_task_start( Task_id[1], spw_recv_task, 1 );
222 225 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_RECV\n")
223 226
224 status = rtems_task_start( Task_id[4], spw_bppr_task_rate_monotonic, 1 );
225 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_BPPR\n")
227 //status = rtems_task_start( Task_id[4], spw_bppr_task_rate_monotonic, 1 );
228 //if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_BPPR\n")
226 229
227 230 status = rtems_task_start( Task_id[5], spw_stat_task, 1 );
228 231 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_STAT\n")
@@ -232,11 +235,13 rtems_task Init( rtems_task_argument ign
232 235
233 236 status = rtems_task_start( Task_id[7], spw_bpf0_task, 1 );
234 237 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_BPF0\n")
238
239 InitLookUpTableForCRC(); // in TC_handler.h
235 240
236 241 status = rtems_task_delete(RTEMS_SELF);
237 242 }
238
239 rtems_task spw_recv_task( rtems_task_argument unused ) {
243
244 rtems_task spw_recv_task_old( rtems_task_argument unused ) {
240 245 rtems_status_code status;
241 246 int len = 0;
242 247 unsigned int i;
@@ -286,29 +291,69 rtems_task spw_recv_task( rtems_task_arg
286 291 }
287 292
288 293 close(fdSPW);
294 }
295
296 rtems_task spw_recv_task( rtems_task_argument unused ) {
297 rtems_status_code status;
298 int len = 0;
299
300 PRINTF("In RECV BIS *** \n")
301
302 currentTC_processedFlag = 1; // reset the flag
303
304 while(1){
305 while(currentTC_processedFlag == 0) sched_yield();
306 len = read(fdSPW, (char*) &currentTC, CCSDS_TC_PKT_MAX_SIZE); // the call to read is blocking
307 if (len == -1){ // error during the read call
308 PRINTF("In RECV *** last read call returned -1\n")
309 if (rtems_event_send( Task_id[3], SPW_LINKERR_EVENT ) != RTEMS_SUCCESSFUL)
310 PRINTF("IN RECV *** Error: rtems_event_send SPW_LINKERR_EVENT\n")
311 if (rtems_task_suspend(RTEMS_SELF) != RTEMS_SUCCESSFUL)
312 PRINTF("In RECV *** Error: rtems_task_suspend(RTEMS_SELF)\n")
313 }
314 else {
315 currentTC_processedFlag = 0;
316 PRINTF1("In RECV *** Got Message of length %d\n", len)
317 currentTC_LEN_RCV[0] = 0x00;
318 currentTC_LEN_RCV[1] = (unsigned char) len - CCSDS_TC_TM_PACKET_OFFSET - 3; // build the corresponding packet size field
319 currentTC_LEN_RCV_AsUnsignedInt = (unsigned int) len - CCSDS_TC_TM_PACKET_OFFSET - 3; // => -3 is for Prot ID, Reserved and User App bytes
320 status = rtems_event_send( Task_id[2], RTEMS_EVENT_0 ); // sending an event to the task TCCK
321 if (status == RTEMS_INVALID_ID) PRINTF("IN TASK RECV *** invalid task id when sending RTEMS_EVENT_0\n")
322 }
323 }
324
325 close(fdSPW);
289 326 }
290 327
291 328 rtems_task spw_tcck_task( rtems_task_argument unused ) {
292 329 rtems_status_code status;
293 rtems_event_set event_out;
330 rtems_event_set event_out;
331 unsigned char result;
332 unsigned int code;
294 333
295 334 PRINTF("In TCCK ***\n")
296 335 while(1){
297 status = rtems_event_receive(RTEMS_EVENT_0, RTEMS_WAIT, RTEMS_NO_TIMEOUT, &event_out);
336 status = rtems_event_receive(RTEMS_EVENT_0, RTEMS_WAIT, RTEMS_NO_TIMEOUT, &event_out); // wait for an event to process a TC packet
298 337 if (status == RTEMS_SUCCESSFUL)
299 {
300 while(tc_being_processed->ready==1){
301 printf("In TCCK *** COARSE TIME 0x%x 0x%x 0x%x 0x%x FINE_TIME 0x%x 0x%x\n",
302 tc_being_processed->tc_pkt[OFFSET_COARSE_TIME],
303 tc_being_processed->tc_pkt[OFFSET_COARSE_TIME+1],
304 tc_being_processed->tc_pkt[OFFSET_COARSE_TIME+2],
305 tc_being_processed->tc_pkt[OFFSET_COARSE_TIME+3],
306 tc_being_processed->tc_pkt[OFFSET_FINE_TIME],
307 tc_being_processed->tc_pkt[OFFSET_FINE_TIME+1]);
308 tc_being_processed->ready = 0;
309 tc_being_processed = tc_being_processed->next;
310 }
311 }
338 {
339 GetCRCAsTwoBytes((unsigned char*)currentTC.packetID, currentTC_COMPUTED_CRC, currentTC_LEN_RCV_AsUnsignedInt + 5);
340 code = TM_checker(&currentTC);
341 PRINTF1(" %s\n", errorCCSDSMsg[code])
342 if (code == 7){ // if the TC is valid, the TM_LFR_TC_EXE_NOT_IMPLEMENTED packet is sent
343 result = TM_not_implemented_generator(&currentTC, &currentTM);
344 PRINTF1(" %s\n", tmGeneratorMsg[result])
345 result = write( fdSPW, (char*)&currentTM, currentTM_length );
346 if (result==-1) printf("IN TCCK *** error sending TM of size: %d\n", currentTM_length);
347 }
348 else{ // if the TC is not valid, the TM_LFR_TC_EXE_CORRUPTED is sent
349 result = TM_acceptance_generator(&currentTC, code, &currentTM);
350 PRINTF1(" %s\n", tmGeneratorMsg[result])
351 result = write( fdSPW, (char*)&currentTM, currentTM_length );
352 if (result==-1) printf("IN TCCK *** error sending TM of size: %d\n", currentTM_length);
353 }
354
355 currentTC_processedFlag = 1;
356 }
312 357 }
313 358 }
314 359
@@ -373,15 +418,23 int configure_spw_link()
373 418
374 419 // sets a few parameters of the link
375 420 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_RMAPEN, 1); // sets the RMAP enable bit
376 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_RMAPEN\n")
377 ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_RXBLOCK, 1); // sets the blocking mode for reception
378 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_RXBLOCK\n")
379 ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_EVENT_ID, Task_id[3]); // sets the task ID to which an event is sent when a
380 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_EVENT_ID\n") // link-error interrupt occurs
381 ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_DISABLE_ERR, 1); // automatic link-disabling due to link-error interrupts
382 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_DISABLE_ERR\n")
383 ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_LINK_ERR_IRQ, 1); // sets the link-error interrupt bit
384 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_LINK_ERR_IRQ\n")
421 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_RMAPEN\n")
422 //
423 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_RXBLOCK, 1); // sets the blocking mode for reception
424 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_RXBLOCK\n")
425 //
426 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_EVENT_ID, Task_id[3]); // sets the task ID to which an event is sent when a
427 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_EVENT_ID\n") // link-error interrupt occurs
428 //
429 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_DISABLE_ERR, 1); // automatic link-disabling due to link-error interrupts
430 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_DISABLE_ERR\n")
431 //
432 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_LINK_ERR_IRQ, 1); // sets the link-error interrupt bit
433 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_LINK_ERR_IRQ\n")
434 //
435 //status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_DESTKEY, CCSDS_DESTINATION_ID); // sets the destinatino key
436 //if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_LINK_ERR_IRQ\n")
437 //
385 438 PRINTF("In configure_spw_link *** "GRSPW_DEVICE_NAME" configured successfully\n")
386 439
387 440 return RTEMS_SUCCESSFUL;
Show file before | Show file after | Hide comments
@@ -1,74 +1,207
1 #include <..\header\TC_handler.h>
2
3 char TM_checker(ccsdsTelecommandSourcePacketHeader_t * TMPacket)
1 #include <TC_handler.h>
2
3 unsigned int Crc_opt( unsigned char D, unsigned int Chk)
4 {
5 return(((Chk << 8) & 0xff00)^lookUpTableForCRC [(((Chk >> 8)^D) & 0x00ff)]);
6 }
7
8 void InitLookUpTableForCRC()
9 {
10 unsigned int i, tmp;
11 for (i=0; i<256; i++)
12 {
13 tmp = 0;
14 if((i & 1) != 0) tmp = tmp ^ 0x1021;
15 if((i & 2) != 0) tmp = tmp ^ 0x2042;
16 if((i & 4) != 0) tmp = tmp ^ 0x4084;
17 if((i & 8) != 0) tmp = tmp ^ 0x8108;
18 if((i & 16) != 0) tmp = tmp ^ 0x1231;
19 if((i & 32) != 0) tmp = tmp ^ 0x2462;
20 if((i & 64) != 0) tmp = tmp ^ 0x48c4;
21 if((i & 128) != 0) tmp = tmp ^ 0x9188;
22 lookUpTableForCRC[i] = tmp;
23 }
24 }
25
26 void GetCRCAsTwoBytes(unsigned char* data, unsigned char* crcAsTwoBytes, unsigned int sizeOfData){
27 unsigned int Chk;
28 int j;
29 Chk = 0xffff; // reset the syndrom to all ones
30 for (j=0; j<sizeOfData; j++) {
31 Chk = Crc_opt(data[j], Chk);
32 }
33 crcAsTwoBytes[0] = (unsigned char) (Chk >> 8);
34 crcAsTwoBytes[1] = (unsigned char) (Chk & 0x00ff);
35 }
36
37 unsigned char TM_checker(ccsdsTelecommandPacket_t * TMPacket)
4 38 {
5 39 unsigned char pid = 0;
6 40 unsigned char category = 0;
7 unsigned int length = 0;
41 unsigned int length = 0;
42 unsigned char packetType = 0;
43 unsigned char packetSubtype = 0;
44 unsigned char * CCSDSContent;
8 45
9 46 // APID check *** APID on 2 bytes
10 47 pid = ((TMPacket->packetID[0] & 0x07)<<4) + ( (TMPacket->packetID[1]>>4) & 0x0f ); // PID = 11 *** 7 bits xxxxx210 7654xxxx
11 48 category = (TMPacket->packetID[1] & 0x0f); // PACKET_CATEGORY = 12 *** 4 bits xxxxxxxx xxxx3210
12 if (pid!=CCSDS_PROCESS_ID) return CCSDS_ERR_PID;
13 if (category!=CCSDS_PACKET_CATEGORY) return CCSDS_ERR_CAT;
49 if (pid!=CCSDS_PROCESS_ID) return ILLEGAL_APID;
50 if (category!=CCSDS_PACKET_CATEGORY) return ILLEGAL_APID;
14 51
15 52 // packet length check
16 length = TMPacket->packetLength[1] + TMPacket->packetLength[0] * 256;
17 if (category<=CCSDS_TELECOMMAND_MAX_PACKET_LENGTH) return CCSDS_ERR_LENGTH; // check that the packet does not exceed the MAX size
18
19 // service type, subtype and packet length check
20 switch(TMPacket->dataFieldHeader[1]) { // service type, authorized values are 181 and 9
21 case 181:
22 switch(TMPacket->dataFieldHeader[2]){ //subtype, autorized values are 3, 20, 21, 24, 27, 28, 30, 40, 50, 60, 61
23 case 3:
24 if (length!=12) return CCSDS_ERR_LENGTH;
25 break;
26 case 20:
27 if (length!=14) return CCSDS_ERR_LENGTH;
28 break;
29 case 21:
30 if (length!=20) return CCSDS_ERR_LENGTH;
31 break;
32 case 24:
33 if (length!=14) return CCSDS_ERR_LENGTH;
34 break;
35 case 27:
36 if (length!=14) return CCSDS_ERR_LENGTH;
37 break;
38 case 28:
39 if (length!=14) return CCSDS_ERR_LENGTH;
40 break;
41 case 30:
42 if (length!=12) return CCSDS_ERR_LENGTH;
43 break;
44 case 40:
45 if (length!=20) return CCSDS_ERR_LENGTH;
46 break;
47 case 50:
48 if (length!=50) return CCSDS_ERR_LENGTH;
49 break;
50 case 60:
51 if (length!=12) return CCSDS_ERR_LENGTH;
52 break;
53 case 61:
54 if (length!=12) return CCSDS_ERR_LENGTH;
55 break;
56 default:
57 return CCSDS_ERR_SUBTYPE;
58 break;
59 }
60 case 9:
61 if (TMPacket->dataFieldHeader[2]==129) return CCSDS_ERR_SUBTYPE;
62 if (length!=18) return CCSDS_ERR_LENGTH;
63 break;
64 default:
65 return CCSDS_ERR_TYPE;
66 break;
67 }
53 length = TMPacket->packetLength[0] * 256 + TMPacket->packetLength[1];
54 if (length != (currentTC_LEN_RCV[0] * 256 + currentTC_LEN_RCV[1]) ) return WRONG_LEN_PACKET; // LEN RCV != SIZE FIELD
55 if (length >= CCSDS_TC_PKT_MAX_SIZE) return WRONG_LEN_PACKET; // check that the packet does not exceed the MAX size
56
57 packetType = TMPacket->dataFieldHeader[1];
58 packetSubtype = TMPacket->dataFieldHeader[2];
59 // service type, subtype and packet length check
60 if (packetType == 181){
61 switch(packetSubtype){ //subtype, autorized values are 3, 20, 21, 24, 27, 28, 30, 40, 50, 60, 61
62 case 3:
63 if (length!=(12-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
64 break;
65 case 20:
66 if (length!=(14-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
67 break;
68 case 21:
69 if (length!=(20-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
70 break;
71 case 24:
72 if (length!=(14-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
73 break;
74 case 27:
75 if (length!=(14-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
76 break;
77 case 28:
78 if (length!=(14-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
79 break;
80 case 30:
81 if (length!=(12-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
82 break;
83 case 40:
84 if (length!=(20-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
85 break;
86 case 50:
87 if (length!=(50-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
88 break;
89 case 60:
90 if (length!=(12-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
91 break;
92 case 61:
93 if (length!=(12-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
94 break;
95 default:
96 return ILL_SUBTYPE;
97 break;
98 }
99 }
100 else if (packetType == 9){
101 if (packetSubtype!=129) return ILL_SUBTYPE;
102 if (length!=(18-CCSDS_TC_TM_PACKET_OFFSET)) return WRONG_LEN_PACKET;
103 }
104 else return ILL_TYPE;
68 105
69 106 // source ID check // Source ID not documented in the ICD
70 107
71 // packet error control, CRC check
108 // packet error control, CRC check
109 CCSDSContent = (unsigned char*) TMPacket->packetID;
110 GetCRCAsTwoBytes(CCSDSContent, currentTC_COMPUTED_CRC, length + CCSDS_TC_TM_PACKET_OFFSET - 2); // 2 CRC bytes removed from the calculation of the CRC
111 if (currentTC_COMPUTED_CRC[0] != CCSDSContent[length + CCSDS_TC_TM_PACKET_OFFSET -2]) return INCOR_CHECKSUM;
112 if (currentTC_COMPUTED_CRC[1] != CCSDSContent[length + CCSDS_TC_TM_PACKET_OFFSET -1]) return INCOR_CHECKSUM;
72 113
73 114 return CCSDS_TM_VALID;
74 115 }
116
117 unsigned char TM_acceptance_generator(ccsdsTelecommandPacket_t * TCPacket, unsigned int code, ccsdsTelemetryPacket_t * TMPacket)
118 {
119 unsigned int packetLength = 0;
120 packetLength = TMPacket->packetLength[0] * 256 + TMPacket->packetLength[1];
121 if ( (code == 0) | (code == 1) | (code == 2)
122 | (code == 3) | (code == 4) | (code == 5) )
123 { // generated TM_LFR_TC_EXE_CORRUPTED
124 TMPacket->targetLogicalAddress = CCSDS_DESTINATION_ID;
125 TMPacket->protocolIdentifier = 0x02;
126 TMPacket->reserved = 0x00;
127 TMPacket->userApplication = 0x00;
128 //
129 TMPacket->packetID[0] = 0x0c;
130 TMPacket->packetID[1] = 0xc1;
131 TMPacket->packetSequenceControl[0] = 0xc0;
132 TMPacket->packetSequenceControl[1] = 0x00;
133 TMPacket->packetLength[0] = 0x00;
134 TMPacket->packetLength[1] = SIZE_TM_LFR_TC_EXE_CORRUPTED-CCSDS_TC_TM_PACKET_OFFSET;
135 //
136 TMPacket->dataFieldHeader[0] = 0x10;
137 TMPacket->dataFieldHeader[1] = 0x01; // service type
138 TMPacket->dataFieldHeader[2] = 0x08; // service subtype
139 TMPacket->dataFieldHeader[3] = CCSDS_DESTINATION_ID;
140 TMPacket->dataFieldHeader[4] = 0x00; // time
141 TMPacket->dataFieldHeader[5] = 0x00; // time
142 TMPacket->dataFieldHeader[6] = 0x00; // time
143 TMPacket->dataFieldHeader[7] = 0x00; // time
144 TMPacket->dataFieldHeader[8] = 0x00; // time
145 TMPacket->dataFieldHeader[9] = 0x00; // time
146 //
147 TMPacket->data[0] = 0x9c; // failure code
148 TMPacket->data[1] = 0x45; // failure code
149 TMPacket->data[2] = TCPacket->packetID[0];
150 TMPacket->data[3] = TCPacket->packetID[1];
151 TMPacket->data[4] = TCPacket->packetSequenceControl[0];
152 TMPacket->data[5] = TCPacket->packetSequenceControl[1];
153 TMPacket->data[6] = TCPacket->dataFieldHeader[1]; // type
154 TMPacket->data[7] = TCPacket->dataFieldHeader[2]; // subtype
155 TMPacket->data[8] = currentTC_LEN_RCV[0];
156 TMPacket->data[9] = currentTC_LEN_RCV[1];
157 TMPacket->data[10] = TCPacket->packetLength[0];
158 TMPacket->data[11] = TCPacket->packetLength[1];
159 TMPacket->data[12] = TCPacket->dataAndCRC[packetLength];
160 TMPacket->data[13] = TCPacket->dataAndCRC[packetLength+1];
161 TMPacket->data[14] = currentTC_COMPUTED_CRC[0];
162 TMPacket->data[15] = currentTC_COMPUTED_CRC[1];
163 //
164 currentTM_length = SIZE_TM_LFR_TC_EXE_CORRUPTED-CCSDS_TC_TM_PACKET_OFFSET;
165 }
166 else return 0;
167 return 1;
168 }
169
170 unsigned char TM_not_implemented_generator(ccsdsTelecommandPacket_t * TCPacket, ccsdsTelemetryPacket_t * TMPacket)
171 {
172 TMPacket->targetLogicalAddress = CCSDS_DESTINATION_ID;
173 TMPacket->protocolIdentifier = 0x02;
174 TMPacket->reserved = 0x00;
175 TMPacket->userApplication = 0x00;
176 //
177 TMPacket->packetID[0] = 0x0c;
178 TMPacket->packetID[1] = 0xc1;
179 TMPacket->packetSequenceControl[0] = 0xc0;
180 TMPacket->packetSequenceControl[1] = 0x00;
181 TMPacket->packetLength[0] = 0x00;
182 TMPacket->packetLength[1] = SIZE_TM_LFR_TC_EXE_NOT_IMPLEMENTED-CCSDS_TC_TM_PACKET_OFFSET;
183 //
184 TMPacket->dataFieldHeader[0] = 0x10;
185 TMPacket->dataFieldHeader[1] = 0x01; // service type
186 TMPacket->dataFieldHeader[2] = 0x08; // service subtype
187 TMPacket->dataFieldHeader[3] = CCSDS_DESTINATION_ID;
188 TMPacket->dataFieldHeader[4] = 0x00; // time
189 TMPacket->dataFieldHeader[5] = 0x00; // time
190 TMPacket->dataFieldHeader[6] = 0x00; // time
191 TMPacket->dataFieldHeader[7] = 0x00; // time
192 TMPacket->dataFieldHeader[8] = 0x00; // time
193 TMPacket->dataFieldHeader[9] = 0x00; // time
194 //
195 TMPacket->data[0] = 0x9c; // failure code
196 TMPacket->data[1] = 0x42; // failure code
197 TMPacket->data[2] = TCPacket->packetID[0];
198 TMPacket->data[3] = TCPacket->packetID[1];
199 TMPacket->data[4] = TCPacket->packetSequenceControl[0];
200 TMPacket->data[5] = TCPacket->packetSequenceControl[1];
201 TMPacket->data[6] = TCPacket->dataFieldHeader[1]; // type
202 TMPacket->data[7] = TCPacket->dataFieldHeader[2]; // subtype
203 //
204 currentTM_length = SIZE_TM_LFR_TC_EXE_NOT_IMPLEMENTED-CCSDS_TC_TM_PACKET_OFFSET;
205
206 return 1;
207 }
General Comments 0
You need to be logged in to leave comments. Login now