@@ -2,7 +2,7 TEMPLATE = app | |||
|
2 | 2 | # CONFIG += console v8 sim |
|
3 | 3 | # CONFIG options = verbose *** boot_messages *** debug_messages *** cpu_usage_report *** stack_report *** vhdl_dev *** debug_tch |
|
4 | 4 | # lpp_dpu_destid |
|
5 | CONFIG += console verbose lpp_dpu_destid cpu_usage_report | |
|
5 | CONFIG += console verbose lpp_dpu_destid cpu_usage_report stack_report | |
|
6 | 6 | CONFIG -= qt |
|
7 | 7 | |
|
8 | 8 | include(./sparc.pri) |
@@ -38,7 +38,7 QMAKE_CFLAGS_RELEASE = | |||
|
38 | 38 | QMAKE_CFLAGS_YACC = |
|
39 | 39 | QMAKE_LFLAGS_EXCEPTIONS_ON = |
|
40 | 40 | QMAKE_LFLAGS_EXCEPTIONS_OFF = |
|
41 | QMAKE_LFLAGS_RELEASE = | |
|
41 | QMAKE_LFLAGS_RELEASE = -Xlinker -Map=output.map | |
|
42 | 42 | QMAKE_LFLAGS_CONSOLE = |
|
43 | 43 | QMAKE_LFLAGS_WINDOWS = |
|
44 | 44 | QMAKE_LFLAGS_DLL = |
@@ -35,7 +35,11 int check_mode_value( unsigned char requ | |||
|
35 | 35 | int check_mode_transition( unsigned char requestedMode ); |
|
36 | 36 | int check_transition_date( unsigned int transitionCoarseTime ); |
|
37 | 37 | int stop_current_mode( void ); |
|
38 | int enter_mode( unsigned char mode , unsigned int transitionCoarseTime ); | |
|
38 | int enter_mode_standby( void ); | |
|
39 | int enter_mode_normal( unsigned int transitionCoarseTime ); | |
|
40 | int enter_mode_burst( unsigned int transitionCoarseTime ); | |
|
41 | int enter_mode_sbm1( unsigned int transitionCoarseTime ); | |
|
42 | int enter_mode_sbm2( unsigned int transitionCoarseTime ); | |
|
39 | 43 | int restart_science_tasks( unsigned char lfrRequestedMode ); |
|
40 | 44 | int suspend_science_tasks(); |
|
41 | 45 | void launch_waveform_picker( unsigned char mode , unsigned int transitionCoarseTime ); |
@@ -89,7 +89,7 rtems_task spiq_task(rtems_task_argument | |||
|
89 | 89 | } |
|
90 | 90 | else // [3.b] the link is not in run state, go in STANDBY mode |
|
91 | 91 | { |
|
92 |
status = enter_mode( |
|
|
92 | status = enter_mode_standby(); | |
|
93 | 93 | if ( status != RTEMS_SUCCESSFUL ) { |
|
94 | 94 | PRINTF1("in SPIQ *** ERR enter_standby_mode *** code %d\n", status) |
|
95 | 95 | } |
@@ -204,7 +204,27 int action_enter_mode(ccsdsTelecommandPa | |||
|
204 | 204 | if ( status == LFR_SUCCESSFUL ) // the date is valid, enter the mode |
|
205 | 205 | { |
|
206 | 206 | PRINTF1("OK *** in action_enter_mode *** enter mode %d\n", requestedMode); |
|
207 | status = enter_mode( requestedMode, transitionCoarseTime ); | |
|
207 | ||
|
208 | switch(requestedMode) | |
|
209 | { | |
|
210 | case LFR_MODE_STANDBY: | |
|
211 | status = enter_mode_standby(); | |
|
212 | break; | |
|
213 | case LFR_MODE_NORMAL: | |
|
214 | status = enter_mode_normal( transitionCoarseTime ); | |
|
215 | break; | |
|
216 | case LFR_MODE_BURST: | |
|
217 | status = enter_mode_burst( transitionCoarseTime ); | |
|
218 | break; | |
|
219 | case LFR_MODE_SBM1: | |
|
220 | status = enter_mode_sbm1( transitionCoarseTime ); | |
|
221 | break; | |
|
222 | case LFR_MODE_SBM2: | |
|
223 | status = enter_mode_sbm2( transitionCoarseTime ); | |
|
224 | break; | |
|
225 | default: | |
|
226 | break; | |
|
227 | } | |
|
208 | 228 | } |
|
209 | 229 | |
|
210 | 230 | return status; |
@@ -514,47 +534,12 int stop_current_mode( void ) | |||
|
514 | 534 | return status; |
|
515 | 535 | } |
|
516 | 536 | |
|
517 | int enter_mode( unsigned char mode, unsigned int transitionCoarseTime ) | |
|
518 | { | |
|
519 | /** This function is launched after a mode transition validation. | |
|
520 | * | |
|
521 | * @param mode is the mode in which LFR will be put. | |
|
522 | * | |
|
523 | * @return RTEMS directive status codes: | |
|
524 | * - RTEMS_SUCCESSFUL - the mode has been entered successfully | |
|
525 | * - RTEMS_NOT_SATISFIED - the mode has not been entered successfully | |
|
526 | * | |
|
527 | */ | |
|
528 | ||
|
529 | rtems_status_code status; | |
|
530 | ||
|
531 | //********************** | |
|
532 | // STOP THE CURRENT MODE | |
|
533 | status = stop_current_mode(); | |
|
534 | if (status != RTEMS_SUCCESSFUL) | |
|
537 | int enter_mode_standby() | |
|
535 | 538 | { |
|
536 | PRINTF1("ERR *** in enter_mode *** stop_current_mode with mode = %d\n", mode) | |
|
537 | } | |
|
539 | int status; | |
|
538 | 540 | |
|
539 | //************************* | |
|
540 | // ENTER THE REQUESTED MODE | |
|
541 | if (status == RTEMS_SUCCESSFUL) // if the current mode has been successfully stopped | |
|
542 | { | |
|
543 | if ( (mode == LFR_MODE_NORMAL) || (mode == LFR_MODE_BURST) | |
|
544 | || (mode == LFR_MODE_SBM1) || (mode == LFR_MODE_SBM2) ) | |
|
545 | { | |
|
546 | #ifdef PRINT_TASK_STATISTICS | |
|
547 | rtems_cpu_usage_reset(); | |
|
548 | #endif | |
|
549 | status = restart_science_tasks( mode ); | |
|
550 | if (status == RTEMS_SUCCESSFUL) | |
|
551 | { | |
|
552 | launch_spectral_matrix( ); | |
|
553 | launch_waveform_picker( mode, transitionCoarseTime ); | |
|
554 | } | |
|
555 | } | |
|
556 | else if ( mode == LFR_MODE_STANDBY ) | |
|
557 | { | |
|
541 | status = stop_current_mode(); // STOP THE CURRENT MODE | |
|
542 | ||
|
558 | 543 | #ifdef PRINT_TASK_STATISTICS |
|
559 | 544 |
|
|
560 | 545 | #endif |
@@ -563,16 +548,173 int enter_mode( unsigned char mode, unsi | |||
|
563 | 548 |
|
|
564 | 549 |
|
|
565 | 550 | #endif |
|
551 | ||
|
552 | return status; | |
|
566 | 553 | } |
|
567 | else | |
|
554 | ||
|
555 | int enter_mode_normal( unsigned int transitionCoarseTime ) | |
|
556 | { | |
|
557 | int status; | |
|
558 | ||
|
559 | #ifdef PRINT_TASK_STATISTICS | |
|
560 | rtems_cpu_usage_reset(); | |
|
561 | #endif | |
|
562 | ||
|
563 | status = RTEMS_UNSATISFIED; | |
|
564 | ||
|
565 | switch( lfrCurrentMode ) | |
|
566 | { | |
|
567 | case LFR_MODE_STANDBY: | |
|
568 | status = restart_science_tasks( LFR_MODE_NORMAL ); // restart science tasks | |
|
569 | if (status == RTEMS_SUCCESSFUL) // relaunch spectral_matrix and waveform_picker modules | |
|
568 | 570 | { |
|
571 | launch_spectral_matrix( ); | |
|
572 | launch_waveform_picker( LFR_MODE_NORMAL, transitionCoarseTime ); | |
|
573 | } | |
|
574 | break; | |
|
575 | case LFR_MODE_BURST: | |
|
576 | status = stop_current_mode(); // stop the current mode | |
|
577 | status = restart_science_tasks( LFR_MODE_NORMAL ); // restart the science tasks | |
|
578 | if (status == RTEMS_SUCCESSFUL) // relaunch spectral_matrix and waveform_picker modules | |
|
579 | { | |
|
580 | launch_spectral_matrix( ); | |
|
581 | launch_waveform_picker( LFR_MODE_NORMAL, transitionCoarseTime ); | |
|
582 | } | |
|
583 | break; | |
|
584 | case LFR_MODE_SBM1: | |
|
585 | status = LFR_SUCCESSFUL; // lfrCurrentMode will be updated after the execution of close_action | |
|
586 | break; | |
|
587 | case LFR_MODE_SBM2: | |
|
588 | status = LFR_SUCCESSFUL; // lfrCurrentMode will be updated after the execution of close_action | |
|
589 | break; | |
|
590 | default: | |
|
591 | break; | |
|
592 | } | |
|
593 | ||
|
594 | if (status != RTEMS_SUCCESSFUL) | |
|
595 | { | |
|
596 | PRINTF1("ERR *** in enter_mode_normal *** status = %d\n", status) | |
|
569 | 597 | status = RTEMS_UNSATISFIED; |
|
570 | 598 |
|
|
599 | ||
|
600 | return status; | |
|
601 | } | |
|
602 | ||
|
603 | int enter_mode_burst( unsigned int transitionCoarseTime ) | |
|
604 | { | |
|
605 | int status; | |
|
606 | ||
|
607 | #ifdef PRINT_TASK_STATISTICS | |
|
608 | rtems_cpu_usage_reset(); | |
|
609 | #endif | |
|
610 | ||
|
611 | status = stop_current_mode(); // stop the current mode | |
|
612 | status = restart_science_tasks( LFR_MODE_BURST ); // restart the science tasks | |
|
613 | if (status == RTEMS_SUCCESSFUL) // relaunch spectral_matrix and waveform_picker modules | |
|
614 | { | |
|
615 | launch_spectral_matrix( ); | |
|
616 | launch_waveform_picker( LFR_MODE_BURST, transitionCoarseTime ); | |
|
571 | 617 | } |
|
572 | 618 | |
|
573 | 619 | if (status != RTEMS_SUCCESSFUL) |
|
574 | 620 | { |
|
575 | PRINTF1("ERR *** in enter_mode *** status = %d\n", status) | |
|
621 | PRINTF1("ERR *** in enter_mode_burst *** status = %d\n", status) | |
|
622 | status = RTEMS_UNSATISFIED; | |
|
623 | } | |
|
624 | ||
|
625 | return status; | |
|
626 | } | |
|
627 | ||
|
628 | int enter_mode_sbm1( unsigned int transitionCoarseTime ) | |
|
629 | { | |
|
630 | int status; | |
|
631 | ||
|
632 | #ifdef PRINT_TASK_STATISTICS | |
|
633 | rtems_cpu_usage_reset(); | |
|
634 | #endif | |
|
635 | ||
|
636 | status = RTEMS_UNSATISFIED; | |
|
637 | ||
|
638 | switch( lfrCurrentMode ) | |
|
639 | { | |
|
640 | case LFR_MODE_STANDBY: | |
|
641 | status = restart_science_tasks( LFR_MODE_SBM1 ); // restart science tasks | |
|
642 | if (status == RTEMS_SUCCESSFUL) // relaunch spectral_matrix and waveform_picker modules | |
|
643 | { | |
|
644 | launch_spectral_matrix( ); | |
|
645 | launch_waveform_picker( LFR_MODE_SBM1, transitionCoarseTime ); | |
|
646 | } | |
|
647 | break; | |
|
648 | case LFR_MODE_NORMAL: // lfrCurrentMode will be updated after the execution of close_action | |
|
649 | status = LFR_SUCCESSFUL; | |
|
650 | break; | |
|
651 | case LFR_MODE_BURST: | |
|
652 | status = stop_current_mode(); // stop the current mode | |
|
653 | status = restart_science_tasks( LFR_MODE_SBM1 ); // restart the science tasks | |
|
654 | if (status == RTEMS_SUCCESSFUL) // relaunch spectral_matrix and waveform_picker modules | |
|
655 | { | |
|
656 | launch_spectral_matrix( ); | |
|
657 | launch_waveform_picker( LFR_MODE_SBM1, transitionCoarseTime ); | |
|
658 | } | |
|
659 | break; | |
|
660 | case LFR_MODE_SBM2: | |
|
661 | status = LFR_SUCCESSFUL; // lfrCurrentMode will be updated after the execution of close_action | |
|
662 | break; | |
|
663 | default: | |
|
664 | break; | |
|
665 | } | |
|
666 | ||
|
667 | if (status != RTEMS_SUCCESSFUL) | |
|
668 | { | |
|
669 | PRINTF1("ERR *** in enter_mode_sbm1 *** status = %d\n", status) | |
|
670 | status = RTEMS_UNSATISFIED; | |
|
671 | } | |
|
672 | ||
|
673 | return status; | |
|
674 | } | |
|
675 | ||
|
676 | int enter_mode_sbm2( unsigned int transitionCoarseTime ) | |
|
677 | { | |
|
678 | int status; | |
|
679 | ||
|
680 | #ifdef PRINT_TASK_STATISTICS | |
|
681 | rtems_cpu_usage_reset(); | |
|
682 | #endif | |
|
683 | ||
|
684 | status = RTEMS_UNSATISFIED; | |
|
685 | ||
|
686 | switch( lfrCurrentMode ) | |
|
687 | { | |
|
688 | case LFR_MODE_STANDBY: | |
|
689 | status = restart_science_tasks( LFR_MODE_SBM2 ); // restart science tasks | |
|
690 | if (status == RTEMS_SUCCESSFUL) // relaunch spectral_matrix and waveform_picker modules | |
|
691 | { | |
|
692 | launch_spectral_matrix( ); | |
|
693 | launch_waveform_picker( LFR_MODE_SBM2, transitionCoarseTime ); | |
|
694 | } | |
|
695 | break; | |
|
696 | case LFR_MODE_NORMAL: | |
|
697 | status = LFR_SUCCESSFUL; // lfrCurrentMode will be updated after the execution of close_action | |
|
698 | break; | |
|
699 | case LFR_MODE_BURST: | |
|
700 | status = stop_current_mode(); // stop the current mode | |
|
701 | status = restart_science_tasks( LFR_MODE_SBM2 ); // restart the science tasks | |
|
702 | if (status == RTEMS_SUCCESSFUL) // relaunch spectral_matrix and waveform_picker modules | |
|
703 | { | |
|
704 | launch_spectral_matrix( ); | |
|
705 | launch_waveform_picker( LFR_MODE_SBM2, transitionCoarseTime ); | |
|
706 | } | |
|
707 | break; | |
|
708 | case LFR_MODE_SBM1: | |
|
709 | status = LFR_SUCCESSFUL; // lfrCurrentMode will be updated after the execution of close_action | |
|
710 | break; | |
|
711 | default: | |
|
712 | break; | |
|
713 | } | |
|
714 | ||
|
715 | if (status != RTEMS_SUCCESSFUL) | |
|
716 | { | |
|
717 | PRINTF1("ERR *** in enter_mode_sbm2 *** status = %d\n", status) | |
|
576 | 718 | status = RTEMS_UNSATISFIED; |
|
577 | 719 | } |
|
578 | 720 |
@@ -1212,12 +1212,11 void set_wfp_burst_enable_register( unsi | |||
|
1212 | 1212 | // the burst bits shall be set first, before the enable bits |
|
1213 | 1213 | switch(mode) { |
|
1214 | 1214 | case(LFR_MODE_NORMAL): |
|
1215 |
waveform_picker_regs->run_burst_enable = 0x |
|
|
1216 |
waveform_picker_regs->run_burst_enable = |
|
|
1215 | waveform_picker_regs->run_burst_enable = 0x60; // [0110 0000] enable f2 AND f1 burst | |
|
1216 | waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x0c; // [1111] enable f3 f2 f1 f0 | |
|
1217 | 1217 | break; |
|
1218 | 1218 | case(LFR_MODE_BURST): |
|
1219 | 1219 | waveform_picker_regs->run_burst_enable = 0x40; // [0100 0000] f2 burst enabled |
|
1220 | // waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x04; // [0100] enable f2 | |
|
1221 | 1220 | waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x0c; // [1100] enable f3 AND f2 |
|
1222 | 1221 | break; |
|
1223 | 1222 | case(LFR_MODE_SBM1): |
General Comments 0
You need to be logged in to leave comments.
Login now