timegen_misc.c
110 lines
| 3.8 KiB
| text/x-c
|
CLexer
paul
|
r107 | /** 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 "timegen_misc.h" | ||||
| #include <stdio.h> | ||||
| void timegen_timecode_irq_handler( void *pDev, void *regs, int minor, unsigned int tc ) | ||||
| { | ||||
| struct grgpio_regs_str *grgpio_regs = (struct grgpio_regs_str *) REGS_ADDR_GRGPIO; | ||||
| grgpio_regs->io_port_direction_register = | ||||
| grgpio_regs->io_port_direction_register | 0x08; // [0001 1000], 0 = output disabled, 1 = output enabled | ||||
| if ( (grgpio_regs->io_port_output_register & 0x08) == 0x08 ) | ||||
| { | ||||
| grgpio_regs->io_port_output_register = grgpio_regs->io_port_output_register & 0xf7; | ||||
| } | ||||
| else | ||||
| { | ||||
| grgpio_regs->io_port_output_register = grgpio_regs->io_port_output_register | 0x08; | ||||
| } | ||||
| rtems_event_send( rtems_id_updt, RTEMS_EVENT_0 ); | ||||
| } | ||||
| void initCoarseTime() | ||||
| { | ||||
| coarseTime = 0x00; | ||||
| } | ||||
| rtems_task updt_task( rtems_task_argument unused ) | ||||
| { | ||||
| rtems_event_set event_out; | ||||
| rtems_id send_queue_id; | ||||
| get_message_queue_id_send( &send_queue_id ); | ||||
| BOOT_PRINTF("in UPDT *** waiting for SpaceWire ticks\n") | ||||
| while(1) | ||||
| { | ||||
| // wait for an RTEMS_EVENT | ||||
| rtems_event_receive( RTEMS_EVENT_0, | ||||
| RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out); | ||||
| // increment the coarse time | ||||
| coarseTime = coarseTime + 1; | ||||
| PRINTF2("next valid coarseTime = 0x%x *** %d s\n", coarseTime, coarseTime) | ||||
| rtems_task_wake_after(70); // 10 ms * 70 = 700 ms | ||||
| send_tc_lfr_update_time( send_queue_id ); | ||||
| } | ||||
| } | ||||
| int send_tc_lfr_update_time(rtems_id queue_id ) | ||||
| { | ||||
| rtems_status_code status; | ||||
| unsigned char messageSize; | ||||
| Packet_TC_LFR_UPDATE_TIME_WITH_OVERHEAD_t packet; | ||||
| unsigned char crcAsTwoBytes[2]; | ||||
| // OVERHEAD | ||||
| packet.targetLogicalAddress = DESTINATION_ID_LFR; | ||||
| packet.protocolIdentifier = CCSDS_PROTOCOLE_ID; | ||||
| packet.reserved = DEFAULT_RESERVED; | ||||
| packet.userApplication = CCSDS_USER_APP; | ||||
| // TIME PACKET | ||||
| packet.update_time.packetID[0] = (unsigned char) (TC_LFR_PACKET_ID >> 8); | ||||
| packet.update_time.packetID[1] = (unsigned char) (TC_LFR_PACKET_ID ); | ||||
| packet.update_time.packetSequenceControl[0] = (unsigned char) (TC_LFR_PACKET_SEQUENCE_CONTROL >> 8); | ||||
| packet.update_time.packetSequenceControl[1] = (unsigned char) (TC_LFR_PACKET_SEQUENCE_CONTROL ); | ||||
| packet.update_time.packetLength[0] = (unsigned char) (PACKET_LENGTH_TC_LFR_UPDATE_TIME >> 8); | ||||
| packet.update_time.packetLength[1] = (unsigned char) (PACKET_LENGTH_TC_LFR_UPDATE_TIME ); | ||||
| packet.update_time.ccsdsSecHeaderFlag_pusVersion_ack = 0x19; | ||||
| packet.update_time.serviceType = TC_TYPE_LFR_UPDATE_TIME; | ||||
| packet.update_time.serviceSubType = TC_SUBTYPE_UPDATE_TIME; | ||||
| packet.update_time.sourceID = SID_TC_RPW_INTERNAL; | ||||
| packet.update_time.cp_rpw_time[0] = (unsigned char) (coarseTime >> 24); | ||||
| packet.update_time.cp_rpw_time[1] = (unsigned char) (coarseTime >> 16); | ||||
| packet.update_time.cp_rpw_time[2] = (unsigned char) (coarseTime >> 8); | ||||
| packet.update_time.cp_rpw_time[3] = (unsigned char) (coarseTime); | ||||
| packet.update_time.cp_rpw_time[4] = 0; // fine time MSB | ||||
| packet.update_time.cp_rpw_time[5] = 0; // fine time LSB | ||||
| GetCRCAsTwoBytes((unsigned char*) &packet.update_time, crcAsTwoBytes, | ||||
| PACKET_LENGTH_TC_LFR_UPDATE_TIME + CCSDS_TC_TM_PACKET_OFFSET - 2); | ||||
| packet.update_time.crc[0] = crcAsTwoBytes[0]; | ||||
| packet.update_time.crc[1] = crcAsTwoBytes[1]; | ||||
| messageSize = PACKET_LENGTH_TC_LFR_UPDATE_TIME + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES; | ||||
| // SEND DATA | ||||
| status = rtems_message_queue_send( queue_id, &packet, messageSize); | ||||
| if (status != RTEMS_SUCCESSFUL) { | ||||
| PRINTF("in send_tm_lfr_tc_exe_success *** ERR\n") | ||||
| } | ||||
| return status; | ||||
| } | ||||