HG_REPOSITORIES/LPP/INSTRUMENTATION/SOLO_LFR/DEV_PLE Commit - r16:059e0f45d09b

fsw-0-2 delivery to LESIA...

paul@pc-solar1.lab-lpp.local -

r16:059e0f45d09b default

parent child

Context file:

r16:059e0f45d09b

Collapse all files

FSW-rtems/FSW-rtems.layout +12 -12

             <?xml version="1.0" encoding="UTF-8" standalone="yes" ?>
             <CodeBlocks_layout_file>
             	<ActiveTarget name="Debug" />
             	<File name="../header/ccsds_types.h" open="0" top="0" tabpos="3">
-            		<Cursor position="417" topLine="3" />
+            		<Cursor position="384" topLine="87" />
             	</File>
             	<File name="../header/fsw_init.h" open="0" top="0" tabpos="6">
-            		<Cursor position="1629" topLine="27" />
+            		<Cursor position="1133" topLine="22" />
             	</File>
             	<File name="../header/fsw_misc.h" open="0" top="0" tabpos="0">
-            		<Cursor position="114" topLine="0" />
+            		<Cursor position="545" topLine="0" />
             	</File>
             	<File name="../header/fsw_params.h" open="0" top="0" tabpos="2">
-            		<Cursor position="481" topLine="0" />
+            		<Cursor position="1157" topLine="0" />
             	</File>
             	<File name="../header/fsw_processing.h" open="0" top="0" tabpos="0">
             		<Cursor position="628" topLine="7" />
             	</File>
             	<File name="../header/grlib_regs.h" open="0" top="0" tabpos="4">
             		<Cursor position="1153" topLine="16" />
             	</File>
             	<File name="../header/tc_handler.h" open="0" top="0" tabpos="4">
             		<Cursor position="1380" topLine="35" />
             	</File>
             	<File name="../header/wf_handler.h" open="0" top="0" tabpos="0">
             		<Cursor position="341" topLine="0" />
             	</File>
             	<File name="../src/fsw_globals.c" open="0" top="0" tabpos="5">
-            		<Cursor position="99" topLine="0" />
+            		<Cursor position="184" topLine="0" />
             	</File>
             	<File name="../src/fsw_init.c" open="1" top="0" tabpos="1">
-            		<Cursor position="12524" topLine="55" />
+            		<Cursor position="12072" topLine="91" />
             	</File>
-            	<File name="../src/fsw_misc.c" open="0" top="0" tabpos="2">
+            	<File name="../src/fsw_misc.c" open="1" top="1" tabpos="2">
-            		<Cursor position="2621" topLine="0" />
+            		<Cursor position="4309" topLine="44" />
             	</File>
             	<File name="../src/fsw_processing.c" open="0" top="0" tabpos="0">
-            		<Cursor position="1792" topLine="43" />
+            		<Cursor position="20570" topLine="67" />
             	</File>
-            	<File name="../src/tc_handler.c" open="1" top="1" tabpos="2">
+            	<File name="../src/tc_handler.c" open="0" top="0" tabpos="2">
-            		<Cursor position="13883" topLine="80" />
+            		<Cursor position="15292" topLine="0" />
             	</File>
             	<File name="../src/wf_handler.c" open="0" top="0" tabpos="4">
-            		<Cursor position="4576" topLine="83" />
+            		<Cursor position="2540" topLine="42" />
             	</File>
             </CodeBlocks_layout_file>

FSW-rtems/bin/Debug/fsw binary modified 0 0

NO CONTENT: modified file, binary diff hidden

header/fsw_misc.h +1 0

             #ifndef FSW_MISC_H_INCLUDED
             #define FSW_MISC_H_INCLUDED
             #include <rtems.h>
             #include <stdio.h>
             #include <fsw_init.h>
             #include <fsw_params.h>
             #include <grlib_regs.h>
             #include <grspw.h>
             #include <ccsds_types.h>
             int configure_timer(gptimer_regs_t *gptimer_regs, unsigned char timer, unsigned int clock_divider,
                                 unsigned char interrupt_level, rtems_isr (*timer_isr)() );
             void print_statistics(spw_stats *stats);
             int send_console_outputs_on_serial_port();
             rtems_task stat_task(rtems_task_argument argument);
+            rtems_task hous_task(rtems_task_argument argument);
             #endif // FSW_MISC_H_INCLUDED

header/fsw_params.h +8 -1

             #ifndef FSW_RTEMS_CONFIG_H_INCLUDED
             #define FSW_RTEMS_CONFIG_H_INCLUDED
             #define GRSPW_DEVICE_NAME "/dev/grspw0"
             #define UART_DEVICE_NAME "/dev/console"
             //**********
             // LFR MODES
             #define LFR_MODE_STANDBY 0
             #define LFR_MODE_NORMAL 1
             #define LFR_MODE_BURST 2
             #define LFR_MODE_SBM1 3
             #define LFR_MODE_SBM2 4
             //*****************************
             // APB REGISTERS BASE ADDRESSES
             #define REGS_ADDR_APBUART 0x80000100
             #define REGS_ADDR_GPTIMER 0x80000300
             #define REGS_ADDR_GRSPW 0x80000500
             #define REGS_ADDR_TIME_MANAGEMENT 0x80000600
             #define REGS_ADDR_SPECTRAL_MATRICES 0x80000700
             #define APBUART_CTRL_REG_MASK_DB 0xfffff7ff
             //**********
             // IRQ LINES
             #define IRQ_SM 9
             #define IRQ_SPARC_SM 0x19 // see sparcv8.pdf p.76 for interrupt levels
             #define IRQ_WF 10
             #define IRQ_SPARC_WF 0x1a // see sparcv8.pdf p.76 for interrupt levels
             #define IRQ_TIME1 12
             #define IRQ_SPARC_TIME1 0x1c // see sparcv8.pdf p.76 for interrupt levels
             #define IRQ_TIME2 13
             #define IRQ_SPARC_TIME2 0x1d // see sparcv8.pdf p.76 for interrupt levels
+            //*****
+            // TIME
             #define CLKDIV_SM_SIMULATOR 9999
             #define CLKDIV_WF_SIMULATOR 9999999
             #define TIMER_SM_SIMULATOR 1
             #define TIMER_WF_SIMULATOR 2
+            #define HK_PERIOD 100 // 100 * 10ms => 1sec
             //******
             // RTEMS
             #define TASKID_RECV 1
-            #define TASKID_ACTN 1
+            #define TASKID_ACTN 2
             #define TASKID_SPIQ 3
             #define TASKID_SMIQ 4
             #define TASKID_STAT 5
             #define TASKID_AVF0 6
             #define TASKID_BPF0 7
             #define TASKID_WFRM 8
             #define TASKID_DUMB 9
+            #define TASKID_HOUS 10
             #define ACTION_MSG_QUEUE_COUNT 10
+            // LENGTH (BYTES)
+            #define LENGTH_TM_LFR_HK 126
             //*******
             // MACROS
             //#define PRINT_TASK_STATISTICS
             #define PRINT_MESSAGES_ON_CONSOLE // enable or disable the printf instructions
             #ifdef PRINT_MESSAGES_ON_CONSOLE
             #define PRINTF(x) printf(x);
             #define PRINTF1(x,y) printf(x,y);
             #define PRINTF2(x,y,z) printf(x,y,z);
             #else
             #define PRINTF(x) ;
             #define PRINTF1(x,y) ;
             #define PRINTF2(x,y,z) ;
             #endif
             #define NB_SAMPLES_PER_SNAPSHOT 2048
             #define NB_BYTES_SWF_BLK 2 * 6
             struct param_norm_str{
                 unsigned int sy_lfr_n_swf_l; // length of the snapshots
                 unsigned int sy_lfr_n_swf_p; // time between two snapshots
                 unsigned int sy_lfr_n_asm_p; // time between two asm
                 unsigned char sy_lfr_n_bp_p0; // timebetween two products BP1 set
                 unsigned char sy_lfr_n_bp_p1; // time between two products BP2 set
             };
             struct param_burst_str{
                 unsigned char sy_lfr_b_bp_p0; // timebetween two products BP1 set
                 unsigned char sy_lfr_b_bp_p1; // time between two products BP2 set
             };
             struct param_sbm1_str{
                 unsigned char sy_lfr_s1_bp_p0; // timebetween two products BP1 set
                 unsigned char sy_lfr_s1_bp_p1; // time between two products BP2 set
             };
             struct param_sbm2_str{
                 unsigned char sy_lfr_s2_bp_p0; // timebetween two products BP1 set
                 unsigned char sy_lfr_s2_bp_p1; // time between two products BP2 set
             };
             extern volatile int wf_snap_f0[ ]; // 24576 bytes
             extern volatile int wf_snap_f1[ ]; // 24576 bytes
             extern volatile int wf_snap_f2[ ]; // 24576 bytes
             extern volatile int wf_cont_f3[ ]; // 24576 bytes
             #endif // FSW_RTEMS_CONFIG_H_INCLUDED

src/fsw_globals.c +7 -3

             #include <fsw_processing.h>
             #include <rtems.h>
+            #include <ccsds_types.h>
             // RTEMS GLOBAL VARIABLES
             rtems_name misc_name[5];
             rtems_name misc_id[5];
-            rtems_id   Task_id[10];         /* array of task ids */
+            rtems_id   Task_id[15];         /* array of task ids */
-            rtems_name Task_name[10];       /* array of task names */
+            rtems_name Task_name[15];       /* array of task names */
             int fdSPW;
             int fdUART;
             // APB CONFIGURATION REGISTERS
             time_management_regs_t *time_management_regs = (time_management_regs_t*) REGS_ADDR_TIME_MANAGEMENT;
             // WAVEFORMS GLOBAL VARIABLES
             volatile int wf_snap_f0[ NB_SAMPLES_PER_SNAPSHOT * NB_BYTES_SWF_BLK ]; // 24576 bytes
             volatile int wf_snap_f1[ NB_SAMPLES_PER_SNAPSHOT * NB_BYTES_SWF_BLK ]; // 24576 bytes
             volatile int wf_snap_f2[ NB_SAMPLES_PER_SNAPSHOT * NB_BYTES_SWF_BLK ]; // 24576 bytes
             volatile int wf_cont_f3[ NB_SAMPLES_PER_SNAPSHOT * NB_BYTES_SWF_BLK ]; // 24576 bytes
             // SPECTRAL MATRICES GLOBAL VARIABLES
             volatile int spec_mat_f0_a[ TOTAL_SIZE_SPEC_MAT ];
             volatile int spec_mat_f0_b[ TOTAL_SIZE_SPEC_MAT ];
             volatile int spec_mat_f0_c[ TOTAL_SIZE_SPEC_MAT ];
             volatile int spec_mat_f0_d[ TOTAL_SIZE_SPEC_MAT ];
             volatile int spec_mat_f0_e[ TOTAL_SIZE_SPEC_MAT ];
             volatile int spec_mat_f0_f[ TOTAL_SIZE_SPEC_MAT ];
             volatile int spec_mat_f0_g[ TOTAL_SIZE_SPEC_MAT ];
             volatile int spec_mat_f0_h[ TOTAL_SIZE_SPEC_MAT ];
             //
             float averaged_spec_mat_f0[ TOTAL_SIZE_SPEC_MAT ];
             float compressed_spec_mat_f0[ TOTAL_SIZE_COMPRESSED_MATRIX_f0 ];
             // MODE PARAMETERS
             struct param_norm_str param_norm;
             struct param_burst_str param_burst;
             struct param_sbm1_str param_sbm1;
             struct param_sbm2_str param_sbm2;
             unsigned char param_common[2];
+            // HK PACKETS
+            TMHeader_t housekeeping_header;
+            char housekeeping_data[LENGTH_TM_LFR_HK - 10 + 1];
             // BASIC PARAMETERS GLOBAL VARIABLES
             unsigned char LFR_BP1_F0[ NB_BINS_COMPRESSED_MATRIX_f0 * 9 ];
             BP1_t data_BP1[ NB_BINS_COMPRESSED_MATRIX_f0 ];

src/fsw_init.c +58 -42

             //*************************
             // GPL reminder to be added
             //*************************
             #include <rtems.h>
             /* configuration information */
             #define CONFIGURE_INIT
             #include <bsp.h> /* for device driver prototypes */
             /* configuration information */
             #define CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
             #define CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
-            #define CONFIGURE_MAXIMUM_TASKS             10
+            #define CONFIGURE_MAXIMUM_TASKS             15
             #define CONFIGURE_RTEMS_INIT_TASKS_TABLE
             #define CONFIGURE_EXTRA_TASK_STACKS         (3 * RTEMS_MINIMUM_STACK_SIZE)
             #define CONFIGURE_LIBIO_MAXIMUM_FILE_DESCRIPTORS 32
             #define CONFIGURE_INIT_TASK_PRIORITY	100
             #define CONFIGURE_MAXIMUM_DRIVERS 16
             #define CONFIGURE_MAXIMUM_PERIODS 1
             #define CONFIGURE_MAXIMUM_MESSAGE_QUEUES 1
             #include <rtems/confdefs.h>
             /* If --drvmgr was enabled during the configuration of the RTEMS kernel */
             #ifdef RTEMS_DRVMGR_STARTUP
                 #ifdef LEON3
                 /* Add Timer and UART Driver */
                     #ifdef CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
                         #define CONFIGURE_DRIVER_AMBAPP_GAISLER_GPTIMER
                     #endif
                     #ifdef CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
                         #define CONFIGURE_DRIVER_AMBAPP_GAISLER_APBUART
                     #endif
                 #endif
                 #define CONFIGURE_DRIVER_AMBAPP_GAISLER_GRSPW   /* GRSPW Driver */
                 #include <drvmgr/drvmgr_confdefs.h>
             #endif
             #include <fsw_init.h>
             #include <fsw_config.c>
             char *link_status(int status);
             char *lstates[6] = {"Error-reset",
                                 "Error-wait",
                                 "Ready",
                                 "Started",
                                 "Connecting",
                                 "Run"
             };
             rtems_task Init( rtems_task_argument ignored )
             {
                 rtems_status_code status;
                 rtems_isr_entry old_isr_handler;
                 //send_console_outputs_on_serial_port();
                 initLookUpTableForCRC(); // in tc_handler.h
                 init_default_mode_parameters();
                 create_message_queue();
                 create_all_tasks();
                 start_all_tasks();
                 grspw_timecode_callback = &timecode_irq_handler;
                 configure_spw_link();
                 configure_timer((gptimer_regs_t*) REGS_ADDR_GPTIMER, TIMER_SM_SIMULATOR, CLKDIV_SM_SIMULATOR,
                                 IRQ_SPARC_SM, spectral_matrices_isr );
                 configure_timer((gptimer_regs_t*) REGS_ADDR_GPTIMER, TIMER_WF_SIMULATOR, CLKDIV_WF_SIMULATOR,
                                 IRQ_SPARC_WF, waveforms_isr );
                 // irq handling of the time management unit
                 status = rtems_interrupt_catch( commutation_isr1,
                                                IRQ_SPARC_TIME1,
                                                &old_isr_handler) ; // see sparcv8.pdf p.76 for interrupt levels
                 if (status==RTEMS_SUCCESSFUL)
                     PRINTF("commutation_isr1 *** rtems_interrupt_catch successfullly configured\n")
                 status = rtems_interrupt_catch( commutation_isr2,
                                                IRQ_SPARC_TIME2,
                                                &old_isr_handler) ; // see sparcv8.pdf p.76 for interrupt levels
                 if (status==RTEMS_SUCCESSFUL)
                     PRINTF("commutation_isr2 *** rtems_interrupt_catch successfullly configured\n")
                 LEON_Unmask_interrupt( IRQ_TIME1 );
                 LEON_Unmask_interrupt( IRQ_TIME2 );
                 status = rtems_task_delete(RTEMS_SELF);
             }
             rtems_task spiq_task(rtems_task_argument unused)
             {
                 rtems_event_set event_out;
                 struct grspw_regs_str *grspw_regs;
                 grspw_regs = (struct grspw_regs_str *) REGS_ADDR_GRSPW;
                 while(1){
                     PRINTF("In SPIQ *** Waiting for SPW_LINKERR_EVENT\n")
                     rtems_event_receive(SPW_LINKERR_EVENT, RTEMS_WAIT, RTEMS_NO_TIMEOUT, &event_out); // wait for an SPW_LINKERR_EVENT
-                    if (rtems_task_suspend(Task_id[1])!=RTEMS_SUCCESSFUL)   // suspend RECV task
+                    if (rtems_task_suspend(Task_id[TASKID_RECV])!=RTEMS_SUCCESSFUL)   // suspend RECV task
                         PRINTF("In SPIQ *** Error suspending RECV Task\n")
+                    if (rtems_task_suspend(Task_id[TASKID_HOUS])!=RTEMS_SUCCESSFUL)   // suspend HOUS task
+                        PRINTF("In SPIQ *** Error suspending HOUS Task\n")
                     configure_spw_link();
-                    if (rtems_task_restart(Task_id[1], 1)!=RTEMS_SUCCESSFUL) // restart RECV task
+                    if (rtems_task_restart(Task_id[TASKID_RECV], 1)!=RTEMS_SUCCESSFUL) // restart RECV task
                         PRINTF("In SPIQ *** Error resume RECV Task\n")
+                    if (rtems_task_restart(Task_id[TASKID_HOUS], 1)!=RTEMS_SUCCESSFUL) // restart HOUS task
+                        PRINTF("In SPIQ *** Error resume HOUS Task\n")
                 }
             }
             void init_default_mode_parameters()
             {
                 // COMMON PARAMETERS
                 param_common[0] = 0x00;
                 param_common[1] = 0x10;             // default value 0 0 0 1 0 0 0 0
                 // NORMAL MODE
                 param_norm.sy_lfr_n_swf_l = 2048;   // nb sample
                 param_norm.sy_lfr_n_swf_p = 300;    // sec
                 param_norm.sy_lfr_n_asm_p = 3600;   // sec
                 param_norm.sy_lfr_n_bp_p0 = 4;      // sec
                 param_norm.sy_lfr_n_bp_p1 = 20;     // sec
                 // BURST MODE
                 param_burst.sy_lfr_b_bp_p0 = 1;     // sec
                 param_burst.sy_lfr_b_bp_p1 = 5;     // sec
                 // SBM1 MODE
                 param_sbm1.sy_lfr_s1_bp_p0 = 1;     // sec
                 param_sbm1.sy_lfr_s1_bp_p1 = 1;     // sec
                 // SBM2 MODE
                 param_sbm2.sy_lfr_s2_bp_p0 = 1;     // sec
                 param_sbm2.sy_lfr_s2_bp_p0 = 5;     // sec
             }
             int create_all_tasks()
             {
                 rtems_status_code status;
-                Task_name[1] = rtems_build_name( 'R', 'E', 'C', 'V' );
+                Task_name[TASKID_RECV] = rtems_build_name( 'R', 'E', 'C', 'V' );
-                Task_name[2] = rtems_build_name( 'A', 'C', 'T', 'N' );
+                Task_name[TASKID_ACTN] = rtems_build_name( 'A', 'C', 'T', 'N' );
-                Task_name[3] = rtems_build_name( 'S', 'P', 'I', 'Q' );
+                Task_name[TASKID_SPIQ] = rtems_build_name( 'S', 'P', 'I', 'Q' );
-                Task_name[4] = rtems_build_name( 'S', 'M', 'I', 'Q' );
+                Task_name[TASKID_SMIQ] = rtems_build_name( 'S', 'M', 'I', 'Q' );
-                Task_name[5] = rtems_build_name( 'S', 'T', 'A', 'T' );
+                Task_name[TASKID_STAT] = rtems_build_name( 'S', 'T', 'A', 'T' );
-                Task_name[6] = rtems_build_name( 'A', 'V', 'F', '0' );
+                Task_name[TASKID_AVF0] = rtems_build_name( 'A', 'V', 'F', '0' );
-                Task_name[7] = rtems_build_name( 'B', 'P', 'F', '0' );
+                Task_name[TASKID_BPF0] = rtems_build_name( 'B', 'P', 'F', '0' );
-                Task_name[8] = rtems_build_name( 'W', 'F', 'R', 'M' );
+                Task_name[TASKID_WFRM] = rtems_build_name( 'W', 'F', 'R', 'M' );
-                Task_name[9] = rtems_build_name( 'D', 'U', 'M', 'B' );
+                Task_name[TASKID_DUMB] = rtems_build_name( 'D', 'U', 'M', 'B' );
+                Task_name[TASKID_HOUS] = rtems_build_name( 'H', 'O', 'U', 'S' );
                 // RECV
                 status = rtems_task_create(
-                    Task_name[1], 200, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    Task_name[TASKID_RECV], 200, RTEMS_MINIMUM_STACK_SIZE * 2,
                     RTEMS_DEFAULT_MODES,
-                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[1]
+                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_RECV]
                 );
                 // ACTN
                 status = rtems_task_create(
-                    Task_name[2], 50, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    Task_name[TASKID_ACTN], 50, RTEMS_MINIMUM_STACK_SIZE * 2,
                     RTEMS_DEFAULT_MODES,
-                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[2]
+                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_ACTN]
                 );
                 // SPIQ
                 status = rtems_task_create(
-                    Task_name[3], 50, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    Task_name[TASKID_SPIQ], 50, RTEMS_MINIMUM_STACK_SIZE * 2,
                     RTEMS_DEFAULT_MODES,
-                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[3]
+                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_SPIQ]
                 );
                 // SMIQ
                 status = rtems_task_create(
-                    Task_name[4], 10, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    Task_name[TASKID_SMIQ], 10, RTEMS_MINIMUM_STACK_SIZE * 2,
                     RTEMS_DEFAULT_MODES | RTEMS_NO_PREEMPT,
-                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[4]
+                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_SMIQ]
                 );
                 // STAT
                 status = rtems_task_create(
-                    Task_name[5], 150, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    Task_name[TASKID_STAT], 150, RTEMS_MINIMUM_STACK_SIZE * 2,
                     RTEMS_DEFAULT_MODES,
-                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[5]
+                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_STAT]
                 );
                 // AVF0
                 status = rtems_task_create(
-                    Task_name[6], 50, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    Task_name[TASKID_AVF0], 50, RTEMS_MINIMUM_STACK_SIZE * 2,
                     RTEMS_DEFAULT_MODES  | RTEMS_NO_PREEMPT,
-                    RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[6]
+                    RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_AVF0]
                 );
                 // BPF0
                 status = rtems_task_create(
-                    Task_name[7], 50, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    Task_name[TASKID_BPF0], 50, RTEMS_MINIMUM_STACK_SIZE * 2,
                     RTEMS_DEFAULT_MODES,
-                    RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[7]
+                    RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_BPF0]
                 );
                 // WFRM
                 status = rtems_task_create(
-                    Task_name[8], 100, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    Task_name[TASKID_WFRM], 100, RTEMS_MINIMUM_STACK_SIZE * 2,
                     RTEMS_DEFAULT_MODES,
-                    RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[8]
+                    RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_WFRM]
                 );
                 // DUMB
                 status = rtems_task_create(
-                    Task_name[9], 200, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    Task_name[TASKID_DUMB], 200, RTEMS_MINIMUM_STACK_SIZE * 2,
                     RTEMS_DEFAULT_MODES,
-                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[9]
+                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_DUMB]
+                );
+                // HOUS
+                status = rtems_task_create(
+                    Task_name[TASKID_HOUS], 200, RTEMS_MINIMUM_STACK_SIZE * 2,
+                    RTEMS_DEFAULT_MODES,
+                    RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_HOUS]
                 );
                 return 0;
             }
             int start_all_tasks()
             {
                 rtems_status_code status;
-                status = rtems_task_start( Task_id[3], spiq_task, 1 );
+                status = rtems_task_start( Task_id[TASKID_SPIQ], spiq_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_SPIQ\n")
-                status = rtems_task_start( Task_id[1], recv_task, 1 );
+                status = rtems_task_start( Task_id[TASKID_RECV], recv_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_RECV\n")
-                status = rtems_task_start( Task_id[2], actn_task, 1 );
+                status = rtems_task_start( Task_id[TASKID_ACTN], actn_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_ACTN\n")
-                status = rtems_task_start( Task_id[4], smiq_task, 1 );
+                status = rtems_task_start( Task_id[TASKID_SMIQ], smiq_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_BPPR\n")
-                status = rtems_task_start( Task_id[5], stat_task, 1 );
+                status = rtems_task_start( Task_id[TASKID_STAT], stat_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_STAT\n")
-                status = rtems_task_start( Task_id[6], avf0_task, 1 );
+                status = rtems_task_start( Task_id[TASKID_AVF0], avf0_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_AVF0\n")
-                status = rtems_task_start( Task_id[7], bpf0_task, 1 );
+                status = rtems_task_start( Task_id[TASKID_BPF0], bpf0_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_BPF0\n")
-                status = rtems_task_start( Task_id[8], wfrm_task, 1 );
+                status = rtems_task_start( Task_id[TASKID_WFRM], wfrm_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_WFRM\n")
-                status = rtems_task_start( Task_id[9], dumb_task, 1 );
+                status = rtems_task_start( Task_id[TASKID_DUMB], dumb_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_DUMB\n")
+                status = rtems_task_start( Task_id[TASKID_HOUS], hous_task, 1 );
+                if (status!=RTEMS_SUCCESSFUL) PRINTF("In INIT *** Error starting TASK_HOUS\n")
                 return 0;
             }
             int configure_spw_link()
             {
                 rtems_status_code status;
                 close(fdSPW); // close the device if it is already open
                 fdSPW = open(GRSPW_DEVICE_NAME, O_RDWR); // open the device. the open call reset the hardware
                 if (fdSPW<0) PRINTF("In configure_spw_link *** Error opening"GRSPW_DEVICE_NAME"\n")
                 while(ioctl(fdSPW, SPACEWIRE_IOCTRL_START, 0) != RTEMS_SUCCESSFUL){
                     PRINTF("In configure_spw_link *** "GRSPW_DEVICE_NAME" not started, retry\n")
                     close(fdSPW); // close the device
                     fdSPW = open(GRSPW_DEVICE_NAME, O_RDWR); // open the device. the open call reset the hardware
                     if (fdSPW<0) PRINTF("In configure_spw_link *** Error opening"GRSPW_DEVICE_NAME"\n")
                     rtems_task_wake_after(100);
                 }
                 PRINTF("In configure_spw_link *** "GRSPW_DEVICE_NAME" opened and started successfully\n")
                 // sets a few parameters of the link
                 //status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_RMAPEN, 1);      // sets the RMAP enable bit
                 //if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_RMAPEN\n")
                 configure_spacewire_set_NP(1, REGS_ADDR_GRSPW); // No Port force
                 configure_spacewire_set_RE(1, REGS_ADDR_GRSPW); // the dedicated call seems to  break the no port force configuration
                 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_RXBLOCK, 1);              // sets the blocking mode for reception
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_RXBLOCK\n")
                 //
-                status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_EVENT_ID, Task_id[3]);    // sets the task ID to which an event is sent when a
+                status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_EVENT_ID, Task_id[TASKID_SPIQ]); // sets the task ID to which an event is sent when a
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_EVENT_ID\n") // link-error interrupt occurs
                 //
                 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_DISABLE_ERR, 1);          // automatic link-disabling due to link-error interrupts
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_DISABLE_ERR\n")
                 //
                 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_LINK_ERR_IRQ, 1);         // sets the link-error interrupt bit
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_LINK_ERR_IRQ\n")
                 //
                 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_TXBLOCK_ON_FULL, 1);         // sets the link-error interrupt bit
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_TXBLOCK_ON_FULL\n")
                 //
                 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_DESTKEY, CCSDS_DESTINATION_ID);  // sets the destination key
                 PRINTF1("destination address set to: %d\n", CCSDS_DESTINATION_ID)
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_DESTKEY\n")
                 //
                 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_NODEADDR, CCSDS_NODE_ADDRESS);  // sets the node address
                 PRINTF1("node address set to: %d\n", CCSDS_NODE_ADDRESS)
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_NODEADDR\n")
                 //
                 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_SET_TCODE_CTRL, 0x0909);
                 if (status!=RTEMS_SUCCESSFUL) PRINTF("In RECV *** Error SPACEWIRE_IOCTRL_SET_TCODE_CTRL,\n")
                 PRINTF("In configure_spw_link *** "GRSPW_DEVICE_NAME" configured successfully\n")
                 return RTEMS_SUCCESSFUL;
             }
             void configure_spacewire_set_NP(unsigned char val, unsigned int regAddr) // No Port force
             {
                 unsigned int *spwptr;
                 spwptr = (unsigned int*) regAddr;
                 if (val == 1)
                 {
                     *spwptr = *spwptr | 0x00100000; // [NP] set the No port force bit
                 }
                 if (val== 0)
                 {
                     *spwptr = *spwptr & 0xffdfffff;
                 }
             }
             void configure_spacewire_set_RE(unsigned char val, unsigned int regAddr) // RMAP Enable
             {
                 unsigned int *spwptr;
                 spwptr = (unsigned int*) regAddr;
                 if (val == 1)
                 {
                     *spwptr = *spwptr | 0x00010000; // [NP] set the No port force bit
                 }
                 if (val== 0)
                 {
                     *spwptr = *spwptr & 0xfffdffff;
                 }
             }
             char *link_status(int status){
                     return lstates[status];
             }
             rtems_status_code write_spw(spw_ioctl_pkt_send* spw_ioctl_send)
             {
                 rtems_status_code status;
                 status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, spw_ioctl_send );
                 if (status!=RTEMS_SUCCESSFUL) printf("In write_spw *** Error SPACEWIRE_IOCTRL_SEND\n");
                 return status;
             }
             void timecode_irq_handler(void *pDev, void *regs, int minor, unsigned int tc)
             {
                 if (rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                     printf("In timecode_irq_handler *** Error sending event to DUMB\n");
             }

src/fsw_misc.c +63 0

             #include <fsw_misc.h>
             #include <fsw_params.h>
             extern rtems_id Task_id[];         /* array of task ids */
             extern int fdSPW;
+            extern TMHeader_t housekeeping_header;
+            extern char housekeeping_data[];
             int configure_timer(gptimer_regs_t *gptimer_regs, unsigned char timer, unsigned int clock_divider,
                                 unsigned char interrupt_level, rtems_isr (*timer_isr)() )
             { // configure the timer for the waveforms simulation
                 rtems_status_code status;
                 rtems_isr_entry old_isr_handler;
                 status = rtems_interrupt_catch( timer_isr, interrupt_level, &old_isr_handler) ; // see sparcv8.pdf p.76 for interrupt levels
                 //if (status==RTEMS_SUCCESSFUL) PRINTF("In configure_timer_for_wf_simulation *** rtems_interrupt_catch successfullly configured\n")
                 gptimer_regs->timer[timer].reload = clock_divider; // base clock frequency is 1 MHz
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | 0x00000010;  // clear pending IRQ if any
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | 0x00000004;  // LD load value from the reload register
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | 0x00000001;  // EN enable the timer
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | 0x00000002;  // RS restart
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | 0x00000008;  // IE interrupt enable
                 return 1;
             }
             void print_statistics(spw_stats *stats)
             {
                     //printf(" ******** STATISTICS ********  \n");
                     printf("Transmit link errors: %i\n", stats->tx_link_err);
                     printf("Receiver RMAP header CRC errors: %i\n", stats->rx_rmap_header_crc_err);
                     printf("Receiver RMAP data CRC errors: %i\n", stats->rx_rmap_data_crc_err);
                     printf("Receiver EEP errors: %i\n", stats->rx_eep_err);
                     printf("Receiver truncation errors: %i\n", stats->rx_truncated);
                     printf("Parity errors: %i\n", stats->parity_err);
                     printf("Escape errors: %i\n", stats->escape_err);
                     printf("Credit errors: %i\n", stats->credit_err);
                     printf("Disconnect errors: %i\n", stats->disconnect_err);
                     printf("Write synchronization errors: %i\n", stats->write_sync_err);
                     printf("Early EOP/EEP: %i\n", stats->early_ep);
                     printf("Invalid Node Address: %i\n", stats->invalid_address);
                     printf("Packets transmitted: %i\n", stats->packets_sent);
                     printf("Packets received: %i\n", stats->packets_received);
             }
             int send_console_outputs_on_serial_port() // Send the console outputs on the serial port
             {
                 struct apbuart_regs_str *apbuart_regs;
                 apbuart_regs = (struct apbuart_regs_str *) REGS_ADDR_APBUART;
                 apbuart_regs->ctrl = apbuart_regs->ctrl & APBUART_CTRL_REG_MASK_DB;
                 PRINTF("\n\n\n\n\nIn INIT *** Now the console is on port COM1\n")
                 return 0;
             }
             rtems_task stat_task(rtems_task_argument argument)
             {
                 int i;
                 i = 0;
                 PRINTF("In STAT *** \n")
                 while(1){
                     rtems_task_wake_after(1000);
                     PRINTF1("%d\n", i)
                     if (i == 2) {
                         #ifdef PRINT_TASK_STATISTICS
                         rtems_cpu_usage_report();
                         rtems_cpu_usage_reset();
                         #endif
                         i = 0;
                     }
                     else i++;
                 }
             }
+            rtems_task hous_task(rtems_task_argument argument)
+            {
+                rtems_status_code status;
+                spw_ioctl_pkt_send spw_ioctl_send;
+                rtems_name  name;
+                rtems_id    period;
+                name = rtems_build_name( 'H', 'O', 'U', 'S' );
+                status = rtems_rate_monotonic_create( name, &period );
+                if( status != RTEMS_SUCCESSFUL ) {
+                    printf( "rtems_rate_monotonic_create failed with status of %d\n", status );
+                    exit( 1 );
+                }
+                // filling the structure for the spacewire transmission
+                spw_ioctl_send.hlen = TM_HEADER_LEN + 4; // + 4 is for the protocole extra header
+                spw_ioctl_send.hdr = (char*) &housekeeping_header;
+                spw_ioctl_send.dlen = LENGTH_TM_LFR_HK - 10 + 1;
+                spw_ioctl_send.data = housekeeping_data;
+                housekeeping_header.targetLogicalAddress = CCSDS_DESTINATION_ID;
+                housekeeping_header.protocolIdentifier = 0x02;
+                housekeeping_header.reserved = 0x00;
+                housekeeping_header.userApplication = 0x00;
+                housekeeping_header.packetID[0] = 0x0c;
+                housekeeping_header.packetID[1] = 0xc4;
+                housekeeping_header.packetSequenceControl[0] = 0xc0;
+                housekeeping_header.packetSequenceControl[1] = 0x00;
+                housekeeping_header.packetLength[0] = 0x00;
+                housekeeping_header.packetLength[1] = 0x77;
+                housekeeping_header.dataFieldHeader[0] = 0x10;
+                housekeeping_header.dataFieldHeader[1] = 0x03;
+                housekeeping_header.dataFieldHeader[2] = 0x19;
+                housekeeping_header.dataFieldHeader[3] = 0x00;
+                printf("In HOUS ***\n");
+                while(1){ // launch the rate monotonic task
+                    if ( rtems_rate_monotonic_period( period, HK_PERIOD ) == RTEMS_TIMEOUT ){
+                        printf( "ERR *** in hous_task *** RTEMS_TIMEOUT\n" );
+                        break;
+                    }
+                    housekeeping_header.dataFieldHeader[4] = (unsigned char) (time_management_regs->coarse_time>>24);
+                    housekeeping_header.dataFieldHeader[5] = (unsigned char) (time_management_regs->coarse_time>>16);
+                    housekeeping_header.dataFieldHeader[6] = (unsigned char) (time_management_regs->coarse_time>>8);
+                    housekeeping_header.dataFieldHeader[7] = (unsigned char) (time_management_regs->coarse_time);
+                    housekeeping_header.dataFieldHeader[8] = (unsigned char) (time_management_regs->fine_time>>8);
+                    housekeeping_header.dataFieldHeader[9] = (unsigned char) (time_management_regs->fine_time);
+                    status = write_spw(&spw_ioctl_send);
+                }
+                status = rtems_rate_monotonic_delete( period );
+                if ( status != RTEMS_SUCCESSFUL ) {
+                    printf( "rtems_rate_monotonic_delete failed with status of %d.\n", status );
+                    exit( 1 );
+                }
+                status = rtems_task_delete( RTEMS_SELF ); // should not return
+                printf( "rtems_task_delete returned with status of %d.\n", status );
+                exit( 1 );
+            }

General Comments 0

Write
Preview

You need to be logged in to leave comments. Login now

No TODOs yet

	Site-wide shortcuts
/	Use quick search box
g h	Goto home page
g g	Goto my private gists page
g G	Goto my public gists page
g 0-9	Goto bookmarked items from 0-9
n r	New repository page
n g	New gist page

	Repositories
g s	Goto summary page
g c	Goto changelog page
g f	Goto files page
g F	Goto files page with file search activated
g p	Goto pull requests page
g o	Goto repository settings
g O	Goto repository access permissions settings
t s	Toggle sidebar on some pages