@@ -503,6 +503,7 int action_dump_par( ccsdsTelecommandPac | |||||
503 | */ |
|
503 | */ | |
504 |
|
504 | |||
505 | int status; |
|
505 | int status; | |
|
506 | int k; | |||
506 |
|
507 | |||
507 | increment_seq_counter_destination_id_dump( parameter_dump_packet.packetSequenceControl, TC->sourceID ); |
|
508 | increment_seq_counter_destination_id_dump( parameter_dump_packet.packetSequenceControl, TC->sourceID ); | |
508 | parameter_dump_packet.destinationID = TC->sourceID; |
|
509 | parameter_dump_packet.destinationID = TC->sourceID; | |
@@ -515,6 +516,25 int action_dump_par( ccsdsTelecommandPac | |||||
515 | parameter_dump_packet.time[4] = (unsigned char) (time_management_regs->fine_time>>8); |
|
516 | parameter_dump_packet.time[4] = (unsigned char) (time_management_regs->fine_time>>8); | |
516 | parameter_dump_packet.time[5] = (unsigned char) (time_management_regs->fine_time); |
|
517 | parameter_dump_packet.time[5] = (unsigned char) (time_management_regs->fine_time); | |
517 | // SEND DATA |
|
518 | // SEND DATA | |
|
519 | printf("f0\n"); | |||
|
520 | for (k = 0; k<16; k++) | |||
|
521 | { | |||
|
522 | printf("%x ", parameter_dump_packet.sy_lfr_rw_mask.fx.f0_word1[k]); | |||
|
523 | } | |||
|
524 | printf("\n"); | |||
|
525 | printf("f1\n"); | |||
|
526 | for (k = 0; k<16; k++) | |||
|
527 | { | |||
|
528 | printf("%x ", parameter_dump_packet.sy_lfr_rw_mask.fx.f1_word1[k]); | |||
|
529 | } | |||
|
530 | printf("\n"); | |||
|
531 | printf("f2\n"); | |||
|
532 | for (k = 0; k<16; k++) | |||
|
533 | { | |||
|
534 | printf("%x ", parameter_dump_packet.sy_lfr_rw_mask.fx.f2_word1[k]); | |||
|
535 | } | |||
|
536 | printf("\n"); | |||
|
537 | ||||
518 | status = rtems_message_queue_send( queue_id, ¶meter_dump_packet, |
|
538 | status = rtems_message_queue_send( queue_id, ¶meter_dump_packet, | |
519 | PACKET_LENGTH_PARAMETER_DUMP + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES); |
|
539 | PACKET_LENGTH_PARAMETER_DUMP + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES); | |
520 | if (status != RTEMS_SUCCESSFUL) { |
|
540 | if (status != RTEMS_SUCCESSFUL) { | |
@@ -1121,50 +1141,11 void build_sy_lfr_rw_mask( unsigned int | |||||
1121 | // update the value of the fbins related to reaction wheels frequency filtering |
|
1141 | // update the value of the fbins related to reaction wheels frequency filtering | |
1122 | if (maskPtr != NULL) |
|
1142 | if (maskPtr != NULL) | |
1123 | { |
|
1143 | { | |
1124 | printf("channel = %d\n", channel); |
|
|||
1125 | for (k = 0; k < 16; k++) |
|
1144 | for (k = 0; k < 16; k++) | |
1126 | { |
|
1145 | { | |
1127 | printf("%x ", local_rw_fbins_mask[k]); |
|
|||
1128 | maskPtr[k] = local_rw_fbins_mask[k]; |
|
1146 | maskPtr[k] = local_rw_fbins_mask[k]; | |
1129 | } |
|
1147 | } | |
1130 | printf("\n", local_rw_fbins_mask[k]); |
|
|||
1131 | } |
|
|||
1132 | } |
|
1148 | } | |
1133 |
|
||||
1134 | void print_sy_lfr_rw_masks( void ) |
|
|||
1135 | { |
|
|||
1136 | int k; |
|
|||
1137 |
|
||||
1138 | printf("cp_rpw_sc_rw1_f1 = %f\n", cp_rpw_sc_rw1_f1); |
|
|||
1139 | printf("cp_rpw_sc_rw1_f2 = %f\n", cp_rpw_sc_rw1_f2); |
|
|||
1140 | printf("cp_rpw_sc_rw2_f1 = %f\n", cp_rpw_sc_rw2_f1); |
|
|||
1141 | printf("cp_rpw_sc_rw2_f2 = %f\n", cp_rpw_sc_rw2_f2); |
|
|||
1142 | printf("cp_rpw_sc_rw3_f1 = %f\n", cp_rpw_sc_rw3_f1); |
|
|||
1143 | printf("cp_rpw_sc_rw3_f2 = %f\n", cp_rpw_sc_rw3_f2); |
|
|||
1144 | printf("cp_rpw_sc_rw4_f1 = %f\n", cp_rpw_sc_rw4_f1); |
|
|||
1145 | printf("cp_rpw_sc_rw4_f2 = %f\n", cp_rpw_sc_rw4_f2); |
|
|||
1146 |
|
||||
1147 | printf("f0\n"); |
|
|||
1148 | for (k = 0; k < 16; k++) |
|
|||
1149 | { |
|
|||
1150 | printf("%x ", parameter_dump_packet.sy_lfr_rw_mask.fx.f0_word1[k] ); |
|
|||
1151 | } |
|
|||
1152 | printf("\n"); |
|
|||
1153 |
|
||||
1154 | printf("f1\n"); |
|
|||
1155 | for (k = 0; k < 16; k++) |
|
|||
1156 | { |
|
|||
1157 | printf("%x ", parameter_dump_packet.sy_lfr_rw_mask.fx.f1_word1[k] ); |
|
|||
1158 | } |
|
|||
1159 | printf("\n"); |
|
|||
1160 |
|
||||
1161 | printf("f2\n"); |
|
|||
1162 | for (k = 0; k < 16; k++) |
|
|||
1163 | { |
|
|||
1164 | printf("%x ", parameter_dump_packet.sy_lfr_rw_mask.fx.f2_word1[k] ); |
|
|||
1165 | } |
|
|||
1166 | printf("\n"); |
|
|||
1167 |
|
||||
1168 | } |
|
1149 | } | |
1169 |
|
1150 | |||
1170 | void build_sy_lfr_rw_masks( void ) |
|
1151 | void build_sy_lfr_rw_masks( void ) | |
@@ -1173,8 +1154,6 void build_sy_lfr_rw_masks( void ) | |||||
1173 | build_sy_lfr_rw_mask( 1 ); |
|
1154 | build_sy_lfr_rw_mask( 1 ); | |
1174 | build_sy_lfr_rw_mask( 2 ); |
|
1155 | build_sy_lfr_rw_mask( 2 ); | |
1175 |
|
1156 | |||
1176 | print_sy_lfr_rw_masks(); |
|
|||
1177 |
|
||||
1178 | merge_fbins_masks(); |
|
1157 | merge_fbins_masks(); | |
1179 | } |
|
1158 | } | |
1180 |
|
1159 |
General Comments 0
You need to be logged in to leave comments.
Login now