tc_handler.c
768 lines
| 24.0 KiB
| text/x-c
|
CLexer
/ src / tc_handler.c
paul
|
r40 | /** Functions and tasks related to TeleCommand handling. | |
| * | |||
| * @file | |||
| * @author P. LEROY | |||
| * | |||
| * A group of functions to handle TeleCommands:\n | |||
| * action launching\n | |||
| * TC parsing\n | |||
| * ... | |||
| * | |||
| */ | |||
| #include "tc_handler.h" | |||
paul@pc-solar1.lab-lpp.local
|
r5 | ||
|
paul@pc-solar1.lab-lpp.local
|
r7 | //*********** | |
| // RTEMS TASK | |||
|
paul@pc-solar1.lab-lpp.local
|
r5 | ||
|
paul@pc-solar1.lab-lpp.local
|
r9 | rtems_task actn_task( rtems_task_argument unused ) | |
| { | |||
|
paul
|
r40 | /** This RTEMS task is responsible for launching actions upton the reception of valid TeleCommands. | |
| * | |||
| * @param unused is the starting argument of the RTEMS task | |||
| * | |||
| * The ACTN task waits for data coming from an RTEMS msesage queue. When data arrives, it launches specific actions depending | |||
| * on the incoming TeleCommand. | |||
| * | |||
| */ | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | int result; | |
| rtems_status_code status; // RTEMS status code | |||
| ccsdsTelecommandPacket_t TC; // TC sent to the ACTN task | |||
| size_t size; // size of the incoming TC packet | |||
| unsigned char subtype; // subtype of the current TC packet | |||
|
paul
|
r35 | rtems_id queue_rcv_id; | |
| rtems_id queue_snd_id; | |||
|
paul
|
r42 | status = rtems_message_queue_ident( misc_name[QUEUE_RECV], 0, &queue_rcv_id ); | |
|
paul
|
r35 | if (status != RTEMS_SUCCESSFUL) | |
| { | |||
| PRINTF1("in ACTN *** ERR getting queue_rcv_id %d\n", status) | |||
| } | |||
|
paul
|
r42 | status = rtems_message_queue_ident( misc_name[QUEUE_SEND], 0, &queue_snd_id ); | |
|
paul
|
r35 | if (status != RTEMS_SUCCESSFUL) | |
| { | |||
| PRINTF1("in ACTN *** ERR getting queue_snd_id %d\n", status) | |||
| } | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | ||
| result = LFR_SUCCESSFUL; | |||
| subtype = 0; // subtype of the current TC packet | |||
|
paul@pc-solar1.lab-lpp.local
|
r5 | ||
|
paul
|
r35 | BOOT_PRINTF("in ACTN *** \n") | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | ||
|
paul@pc-solar1.lab-lpp.local
|
r9 | while(1) | |
| { | |||
|
paul
|
r35 | status = rtems_message_queue_receive( queue_rcv_id, (char*) &TC, &size, | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | RTEMS_WAIT, RTEMS_NO_TIMEOUT); | |
|
paul@pc-solar1.lab-lpp.local
|
r22 | if (status!=RTEMS_SUCCESSFUL) PRINTF1("ERR *** in task ACTN *** error receiving a message, code %d \n", status) | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | else | |
| { | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | subtype = TC.serviceSubType; | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | switch(subtype) | |
| { | |||
| case TC_SUBTYPE_RESET: | |||
|
paul
|
r35 | result = action_reset( &TC, queue_snd_id ); | |
| close_action( &TC, result, queue_snd_id ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
| case TC_SUBTYPE_LOAD_COMM: | |||
|
paul
|
r33 | result = action_load_common_par( &TC ); | |
|
paul
|
r35 | close_action( &TC, result, queue_snd_id ); | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | break; | |
| // | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_LOAD_NORM: | |
|
paul
|
r35 | result = action_load_normal_par( &TC, queue_snd_id ); | |
| close_action( &TC, result, queue_snd_id ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_LOAD_BURST: | |
|
paul
|
r35 | result = action_load_burst_par( &TC, queue_snd_id ); | |
| close_action( &TC, result, queue_snd_id ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_LOAD_SBM1: | |
|
paul
|
r35 | result = action_load_sbm1_par( &TC, queue_snd_id ); | |
| close_action( &TC, result, queue_snd_id ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_LOAD_SBM2: | |
|
paul
|
r35 | result = action_load_sbm2_par( &TC, queue_snd_id ); | |
| close_action( &TC, result, queue_snd_id ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_DUMP: | |
|
paul
|
r40 | result = action_dump_par( queue_snd_id ); | |
|
paul
|
r35 | close_action( &TC, result, queue_snd_id ); | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_ENTER: | |
|
paul
|
r35 | result = action_enter_mode( &TC, queue_snd_id ); | |
| close_action( &TC, result, queue_snd_id ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_UPDT_INFO: | |
|
paul
|
r35 | result = action_update_info( &TC, queue_snd_id ); | |
| close_action( &TC, result, queue_snd_id ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_EN_CAL: | |
|
paul
|
r35 | result = action_enable_calibration( &TC, queue_snd_id ); | |
| close_action( &TC, result, queue_snd_id ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_DIS_CAL: | |
|
paul
|
r35 | result = action_disable_calibration( &TC, queue_snd_id ); | |
| close_action( &TC, result, queue_snd_id ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | case TC_SUBTYPE_UPDT_TIME: | |
|
paul
|
r33 | result = action_update_time( &TC ); | |
|
paul
|
r35 | close_action( &TC, result, queue_snd_id ); | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | break; | |
|
paul@pc-solar1.lab-lpp.local
|
r11 | // | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | default: | |
| break; | |||
| } | |||
| } | |||
| } | |||
| } | |||
| //*********** | |||
| // TC ACTIONS | |||
|
paul@pc-solar1.lab-lpp.local
|
r15 | ||
|
paul
|
r35 | int action_reset(ccsdsTelecommandPacket_t *TC, rtems_id queue_id) | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | { | |
|
paul
|
r40 | /** This function executes specific actions when a TC_LFR_RESET TeleCommand has been received. | |
| * | |||
| * @param TC points to the TeleCommand packet that is being processed | |||
| * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver | |||
| * | |||
| */ | |||
|
paul
|
r35 | send_tm_lfr_tc_exe_not_implemented( TC, queue_id ); | |
|
paul@pc-solar1.lab-lpp.local
|
r21 | return LFR_DEFAULT; | |
|
paul@pc-solar1.lab-lpp.local
|
r9 | } | |
|
paul
|
r35 | int action_enter_mode(ccsdsTelecommandPacket_t *TC, rtems_id queue_id) | |
|
paul
|
r33 | { | |
|
paul
|
r40 | /** This function executes specific actions when a TC_LFR_ENTER_MODE TeleCommand has been received. | |
| * | |||
| * @param TC points to the TeleCommand packet that is being processed | |||
| * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver | |||
| * | |||
| */ | |||
|
paul
|
r33 | rtems_status_code status; | |
| unsigned char requestedMode; | |||
| requestedMode = TC->dataAndCRC[1]; | |||
|
paul
|
r37 | if ( (requestedMode != LFR_MODE_STANDBY) | |
| && (requestedMode != LFR_MODE_NORMAL) && (requestedMode != LFR_MODE_BURST) | |||
| && (requestedMode != LFR_MODE_SBM1) && (requestedMode != LFR_MODE_SBM2) ) | |||
|
paul
|
r33 | { | |
|
paul
|
r37 | status = RTEMS_UNSATISFIED; | |
| send_tm_lfr_tc_exe_inconsistent( TC, queue_id, BYTE_POS_CP_LFR_MODE, requestedMode ); | |||
|
paul
|
r33 | } | |
| else | |||
| { | |||
|
paul
|
r37 | printf("try to enter mode %d\n", requestedMode); | |
| #ifdef PRINT_TASK_STATISTICS | |||
| if (requestedMode != LFR_MODE_STANDBY) | |||
| { | |||
| rtems_cpu_usage_reset(); | |||
| maxCount = 0; | |||
| } | |||
| #endif | |||
| status = transition_validation(requestedMode); | |||
| if ( status == LFR_SUCCESSFUL ) { | |||
| if ( lfrCurrentMode != LFR_MODE_STANDBY) | |||
| { | |||
| status = stop_current_mode(); | |||
| } | |||
| if (status != RTEMS_SUCCESSFUL) | |||
| { | |||
| PRINTF("ERR *** in action_enter *** stop_current_mode\n") | |||
| } | |||
| status = enter_mode(requestedMode, TC); | |||
| } | |||
| else | |||
| { | |||
| PRINTF("ERR *** in action_enter *** transition rejected\n") | |||
| send_tm_lfr_tc_exe_not_executable( TC, queue_id ); | |||
| } | |||
|
paul
|
r33 | } | |
| return status; | |||
| } | |||
|
paul
|
r40 | int action_update_info(ccsdsTelecommandPacket_t *TC, rtems_id queue_id) | |
| { | |||
| /** This function executes specific actions when a TC_LFR_UPDATE_INFO TeleCommand has been received. | |||
| * | |||
| * @param TC points to the TeleCommand packet that is being processed | |||
| * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver | |||
| * | |||
|
paul
|
r46 | * @return LFR directive status code: | |
| * - LFR_DEFAULT | |||
| * - LFR_SUCCESSFUL | |||
| * | |||
|
paul
|
r40 | */ | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | unsigned int val; | |
| int result; | |||
| result = LFR_DEFAULT; | |||
|
paul@pc-solar1.lab-lpp.local
|
r18 | ||
|
paul
|
r46 | val = housekeeping_packet.hk_lfr_update_info_tc_cnt[0] * 256 | |
| + housekeeping_packet.hk_lfr_update_info_tc_cnt[1]; | |||
| val++; | |||
| housekeeping_packet.hk_lfr_update_info_tc_cnt[0] = (unsigned char) (val >> 8); | |||
| housekeeping_packet.hk_lfr_update_info_tc_cnt[1] = (unsigned char) (val); | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | ||
| return result; | |||
| } | |||
|
paul
|
r35 | int action_enable_calibration(ccsdsTelecommandPacket_t *TC, rtems_id queue_id) | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | { | |
|
paul
|
r40 | /** This function executes specific actions when a TC_LFR_ENABLE_CALIBRATION TeleCommand has been received. | |
| * | |||
| * @param TC points to the TeleCommand packet that is being processed | |||
| * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver | |||
| * | |||
| */ | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | int result; | |
| unsigned char lfrMode; | |||
| result = LFR_DEFAULT; | |||
| lfrMode = (housekeeping_packet.lfr_status_word[0] & 0xf0) >> 4; | |||
|
paul
|
r51 | if ( (lfrMode == LFR_MODE_STANDBY) || (lfrMode == LFR_MODE_BURST) || (lfrMode == LFR_MODE_SBM2) ) { | |
|
paul
|
r35 | send_tm_lfr_tc_exe_not_executable( TC, queue_id ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | result = LFR_DEFAULT; | |
| } | |||
| else { | |||
|
paul
|
r35 | send_tm_lfr_tc_exe_not_implemented( TC, queue_id ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | result = LFR_DEFAULT; | |
| } | |||
| return result; | |||
| } | |||
|
paul
|
r35 | int action_disable_calibration(ccsdsTelecommandPacket_t *TC, rtems_id queue_id) | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | { | |
|
paul
|
r40 | /** This function executes specific actions when a TC_LFR_DISABLE_CALIBRATION TeleCommand has been received. | |
| * | |||
| * @param TC points to the TeleCommand packet that is being processed | |||
| * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver | |||
| * | |||
| */ | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | int result; | |
| unsigned char lfrMode; | |||
| result = LFR_DEFAULT; | |||
| lfrMode = (housekeeping_packet.lfr_status_word[0] & 0xf0) >> 4; | |||
|
paul
|
r51 | if ( (lfrMode == LFR_MODE_STANDBY) || (lfrMode == LFR_MODE_BURST) || (lfrMode == LFR_MODE_SBM2) ) { | |
|
paul
|
r35 | send_tm_lfr_tc_exe_not_executable( TC, queue_id ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | result = LFR_DEFAULT; | |
| } | |||
| else { | |||
|
paul
|
r35 | send_tm_lfr_tc_exe_not_implemented( TC, queue_id ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | result = LFR_DEFAULT; | |
| } | |||
| return result; | |||
| } | |||
|
paul
|
r33 | int action_update_time(ccsdsTelecommandPacket_t *TC) | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | { | |
|
paul
|
r40 | /** This function executes specific actions when a TC_LFR_UPDATE_TIME TeleCommand has been received. | |
| * | |||
| * @param TC points to the TeleCommand packet that is being processed | |||
| * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver | |||
| * | |||
|
paul
|
r46 | * @return LFR_SUCCESSFUL | |
| * | |||
|
paul
|
r40 | */ | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | unsigned int val; | |
|
paul@pc-solar1.lab-lpp.local
|
r19 | ||
|
paul@pc-solar1.lab-lpp.local
|
r23 | time_management_regs->coarse_time_load = (TC->dataAndCRC[0] << 24) | |
| + (TC->dataAndCRC[1] << 16) | |||
| + (TC->dataAndCRC[2] << 8) | |||
| + TC->dataAndCRC[3]; | |||
| val = housekeeping_packet.hk_lfr_update_time_tc_cnt[0] * 256 | |||
| + housekeeping_packet.hk_lfr_update_time_tc_cnt[1]; | |||
| val++; | |||
| housekeeping_packet.hk_lfr_update_time_tc_cnt[0] = (unsigned char) (val >> 8); | |||
| housekeeping_packet.hk_lfr_update_time_tc_cnt[1] = (unsigned char) (val); | |||
|
paul
|
r33 | time_management_regs->ctrl = time_management_regs->ctrl | 1; | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | ||
| return LFR_SUCCESSFUL; | |||
| } | |||
| //******************* | |||
| // ENTERING THE MODES | |||
| int transition_validation(unsigned char requestedMode) | |||
| { | |||
| int status; | |||
|
paul@pc-solar1.lab-lpp.local
|
r19 | ||
|
paul@pc-solar1.lab-lpp.local
|
r23 | switch (requestedMode) | |
| { | |||
| case LFR_MODE_STANDBY: | |||
|
paul
|
r33 | if ( lfrCurrentMode == LFR_MODE_STANDBY ) { | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | status = LFR_DEFAULT; | |
| } | |||
| else | |||
| { | |||
| status = LFR_SUCCESSFUL; | |||
| } | |||
| break; | |||
| case LFR_MODE_NORMAL: | |||
|
paul
|
r33 | if ( lfrCurrentMode == LFR_MODE_NORMAL ) { | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | status = LFR_DEFAULT; | |
| } | |||
| else { | |||
| status = LFR_SUCCESSFUL; | |||
| } | |||
| break; | |||
| case LFR_MODE_BURST: | |||
|
paul
|
r33 | if ( lfrCurrentMode == LFR_MODE_BURST ) { | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | status = LFR_DEFAULT; | |
| } | |||
| else { | |||
| status = LFR_SUCCESSFUL; | |||
| } | |||
| break; | |||
| case LFR_MODE_SBM1: | |||
|
paul
|
r33 | if ( lfrCurrentMode == LFR_MODE_SBM1 ) { | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | status = LFR_DEFAULT; | |
| } | |||
| else { | |||
| status = LFR_SUCCESSFUL; | |||
| } | |||
| break; | |||
| case LFR_MODE_SBM2: | |||
|
paul
|
r33 | if ( lfrCurrentMode == LFR_MODE_SBM2 ) { | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | status = LFR_DEFAULT; | |
| } | |||
| else { | |||
| status = LFR_SUCCESSFUL; | |||
| } | |||
| break; | |||
| default: | |||
| status = LFR_DEFAULT; | |||
| break; | |||
| } | |||
|
paul@pc-solar1.lab-lpp.local
|
r19 | ||
|
paul@pc-solar1.lab-lpp.local
|
r21 | return status; | |
admin@pc-p-leroy3.LAB-LPP.LOCAL
|
r10 | } | |
|
paul@pc-solar1.lab-lpp.local
|
r20 | int stop_current_mode() | |
| { | |||
|
paul
|
r40 | /** This function stops the current mode by masking interrupt lines and suspending science tasks. | |
| * | |||
| * @return RTEMS directive status codes: | |||
| * - RTEMS_SUCCESSFUL - task restarted successfully | |||
| * - RTEMS_INVALID_ID - task id invalid | |||
| * - RTEMS_ALREADY_SUSPENDED - task already suspended | |||
| * | |||
| */ | |||
|
paul@pc-solar1.lab-lpp.local
|
r21 | rtems_status_code status; | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | ||
| status = RTEMS_SUCCESSFUL; | |||
|
paul@pc-solar1.lab-lpp.local
|
r22 | ||
|
paul
|
r31 | #ifdef GSA | |
| LEON_Mask_interrupt( IRQ_WF ); // mask waveform interrupt (coming from the timer VHDL IP) | |||
|
paul@pc-solar1.lab-lpp.local
|
r20 | LEON_Clear_interrupt( IRQ_WF ); // clear waveform interrupt (coming from the timer VHDL IP) | |
|
paul
|
r31 | timer_stop( (gptimer_regs_t*) REGS_ADDR_GPTIMER, TIMER_WF_SIMULATOR ); | |
| #else | |||
|
paul
|
r47 | // mask interruptions | |
|
paul
|
r31 | LEON_Mask_interrupt( IRQ_WAVEFORM_PICKER ); // mask waveform picker interrupt | |
|
paul
|
r33 | LEON_Mask_interrupt( IRQ_SPECTRAL_MATRIX ); // mask spectral matrix interrupt | |
|
paul
|
r47 | // reset registers | |
| reset_wfp_burst_enable(); // reset burst and enable bits | |||
| reset_wfp_status(); // reset all the status bits | |||
| // creal interruptions | |||
| LEON_Clear_interrupt( IRQ_WAVEFORM_PICKER ); // clear waveform picker interrupt | |||
| LEON_Clear_interrupt( IRQ_SPECTRAL_MATRIX ); // clear spectarl matrix interrupt | |||
|
paul
|
r31 | #endif | |
|
paul
|
r33 | //********************** | |
|
paul@pc-solar1.lab-lpp.local
|
r20 | // suspend several tasks | |
|
paul
|
r35 | if (lfrCurrentMode != LFR_MODE_STANDBY) { | |
|
paul
|
r40 | status = suspend_science_tasks(); | |
|
paul@pc-solar1.lab-lpp.local
|
r21 | } | |
|
paul@pc-solar1.lab-lpp.local
|
r20 | ||
|
paul@pc-solar1.lab-lpp.local
|
r22 | if (status != RTEMS_SUCCESSFUL) | |
| { | |||
|
paul
|
r40 | PRINTF1("in stop_current_mode *** in suspend_science_tasks *** ERR code: %d\n", status) | |
|
paul@pc-solar1.lab-lpp.local
|
r22 | } | |
|
paul@pc-solar1.lab-lpp.local
|
r21 | return status; | |
|
paul@pc-solar1.lab-lpp.local
|
r20 | } | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | int enter_mode(unsigned char mode, ccsdsTelecommandPacket_t *TC ) | |
|
paul@pc-solar1.lab-lpp.local
|
r20 | { | |
|
paul@pc-solar1.lab-lpp.local
|
r21 | rtems_status_code status; | |
|
paul@pc-solar1.lab-lpp.local
|
r20 | ||
|
paul
|
r33 | status = RTEMS_UNSATISFIED; | |
| housekeeping_packet.lfr_status_word[0] = (unsigned char) ((mode << 4) + 0x0d); | |||
|
paul
|
r51 | updateLFRCurrentMode(); | |
|
paul
|
r33 | ||
|
paul@pc-solar1.lab-lpp.local
|
r23 | switch(mode){ | |
| case LFR_MODE_STANDBY: | |||
|
paul
|
r51 | status = enter_standby_mode( ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | break; | |
| case LFR_MODE_NORMAL: | |||
|
paul
|
r51 | status = enter_normal_mode( ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | break; | |
| case LFR_MODE_BURST: | |||
|
paul
|
r51 | status = enter_burst_mode( ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | break; | |
| case LFR_MODE_SBM1: | |||
|
paul
|
r51 | status = enter_sbm1_mode( ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | break; | |
| case LFR_MODE_SBM2: | |||
|
paul
|
r51 | status = enter_sbm2_mode( ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | break; | |
| default: | |||
| status = RTEMS_UNSATISFIED; | |||
|
paul@pc-solar1.lab-lpp.local
|
r21 | } | |
|
paul@pc-solar1.lab-lpp.local
|
r20 | ||
|
paul
|
r33 | if (status != RTEMS_SUCCESSFUL) | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | { | |
|
paul
|
r33 | PRINTF("in enter_mode *** ERR\n") | |
| status = RTEMS_UNSATISFIED; | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | } | |
|
paul@pc-solar1.lab-lpp.local
|
r21 | ||
| return status; | |||
|
paul@pc-solar1.lab-lpp.local
|
r20 | } | |
|
paul
|
r33 | int enter_standby_mode() | |
|
paul@pc-solar1.lab-lpp.local
|
r20 | { | |
|
paul
|
r34 | PRINTF1("maxCount = %d\n", maxCount) | |
|
paul
|
r33 | #ifdef PRINT_TASK_STATISTICS | |
| rtems_cpu_usage_report(); | |||
| #endif | |||
|
paul
|
r34 | ||
| #ifdef PRINT_STACK_REPORT | |||
| rtems_stack_checker_report_usage(); | |||
| #endif | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | return LFR_SUCCESSFUL; | |
|
paul@pc-solar1.lab-lpp.local
|
r22 | } | |
|
paul
|
r33 | int enter_normal_mode() | |
|
paul@pc-solar1.lab-lpp.local
|
r22 | { | |
| rtems_status_code status; | |||
|
paul
|
r32 | status = restart_science_tasks(); | |
|
paul@pc-solar1.lab-lpp.local
|
r22 | ||
| #ifdef GSA | |||
|
paul
|
r31 | timer_start( (gptimer_regs_t*) REGS_ADDR_GPTIMER, TIMER_WF_SIMULATOR ); | |
| timer_start( (gptimer_regs_t*) REGS_ADDR_GPTIMER, TIMER_SM_SIMULATOR ); | |||
|
paul
|
r30 | LEON_Clear_interrupt( IRQ_WF ); | |
| LEON_Unmask_interrupt( IRQ_WF ); | |||
|
paul
|
r32 | // | |
| set_local_nb_interrupt_f0_MAX(); | |||
|
paul
|
r31 | LEON_Clear_interrupt( IRQ_SM ); // the IRQ_SM seems to be incompatible with the IRQ_WF on the xilinx board | |
| LEON_Unmask_interrupt( IRQ_SM ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r22 | #else | |
|
paul
|
r33 | //**************** | |
|
paul
|
r32 | // waveform picker | |
|
paul
|
r47 | reset_waveform_picker_regs(); | |
| set_wfp_burst_enable_register(LFR_MODE_NORMAL); | |||
|
paul
|
r30 | LEON_Clear_interrupt( IRQ_WAVEFORM_PICKER ); | |
| LEON_Unmask_interrupt( IRQ_WAVEFORM_PICKER ); | |||
|
paul
|
r33 | //**************** | |
|
paul
|
r32 | // spectral matrix | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | #endif | |
| return status; | |||
| } | |||
|
paul
|
r33 | int enter_burst_mode() | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | { | |
| rtems_status_code status; | |||
|
paul
|
r32 | status = restart_science_tasks(); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | ||
| #ifdef GSA | |||
|
paul
|
r33 | LEON_Unmask_interrupt( IRQ_SM ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | #else | |
|
paul
|
r47 | reset_waveform_picker_regs(); | |
| set_wfp_burst_enable_register(LFR_MODE_BURST); | |||
|
paul
|
r33 | LEON_Clear_interrupt( IRQ_WAVEFORM_PICKER ); | |
| LEON_Unmask_interrupt( IRQ_WAVEFORM_PICKER ); | |||
|
paul@pc-solar1.lab-lpp.local
|
r20 | #endif | |
|
paul@pc-solar1.lab-lpp.local
|
r22 | ||
| return status; | |||
| } | |||
|
paul
|
r33 | int enter_sbm1_mode() | |
|
paul@pc-solar1.lab-lpp.local
|
r22 | { | |
| rtems_status_code status; | |||
|
paul
|
r32 | status = restart_science_tasks(); | |
|
paul@pc-solar1.lab-lpp.local
|
r22 | ||
|
paul
|
r32 | set_local_sbm1_nb_cwf_max(); | |
| reset_local_sbm1_nb_cwf_sent(); | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | ||
| #ifdef GSA | |||
|
paul
|
r33 | LEON_Unmask_interrupt( IRQ_SM ); | |
|
paul@pc-solar1.lab-lpp.local
|
r23 | #else | |
|
paul
|
r47 | reset_waveform_picker_regs(); | |
| set_wfp_burst_enable_register(LFR_MODE_SBM1); | |||
|
paul@pc-solar1.lab-lpp.local
|
r23 | LEON_Clear_interrupt( IRQ_WAVEFORM_PICKER ); | |
| LEON_Unmask_interrupt( IRQ_WAVEFORM_PICKER ); | |||
|
paul
|
r34 | // SM simulation |