mil1553_bc_dual_major_frame.c

/*****************************************************************************
//
##    File:
##       mil1553_bc_dual_major_frame.c
//
//       Copyright (c) MAX Technologies Inc. 1988-2016, All Rights Reserved.
//             CONFIDENTIAL AND PROPRIETARY INFORMATION WHICH IS THE 
//                         PROPERTY OF MAX TECHNOLOGIES INC. 
//
//      This example demonstrates the usage of message conditional branch
//      options using discrete input from MIL-STD-1553 BC channel to simulate
//      a dual major frame.
//
//       Hardware requirements:
//          - MAXT Flex1553-PCIe or FlexMulti.
//          - FLEX discrete output #0 must be connected to discrete input #0
//
*****************************************************************************/

#include "example.h"

#define BUF_SA3_RX 0
#define BUF_SA3_TX 1

#define RT_ADRS 5

#define LOCAL
//#define LOOPBACK

int main(void)
{
uint32 rc;
uint64 deviceCount=0;
uint64 moduleCount=0;
uint64 channelCount=0;
HMXF_SERVER server;
HMXF_DEVICE device=0;
HMXF_MODULE module=0;
HMXF_CHANNEL bc=0;
HMXF_CHANNEL bm=0;
HMXF_CHANNEL discIn=0;
HMXF_CHANNEL discOut=0;
HMXF_BUFFER bcBufferTx[4];
HMXF_BUFFER bmBufferRx=0;
    
MXF_MSGID_MIL1553 bcMsgID[2]={{MXF_MIL1553_MSGTYPE_RX,RT_ADRS,3,0},{MXF_MIL1553_MSGTYPE_TX,RT_ADRS,3,0}};

uint64 txBufferSize;
MXF_MIL1553_DATAREC* txBuffer=NULL;
MXF_MIL1553_DATAREC* txRec1553;

uint64 rxBufferSize=0;
MXF_MIL1553_DATAREC* rxBuffer=NULL;
MXF_MIL1553_DATAREC* rxRec1553;

MXF_MIL1553_TXPERIODIC_MJRFRAME_MSG minorFrame[1];
MXF_MIL1553_TXPERIODIC_MJRFRAME_MINOR_PROPERTIES mfProp;

uint64   rxAcqStatus;
uint64   msgCount;
uint64   byteCount;
uint64   rxRec;
uint32   loop=0;
uint64   address, subAddress, dir, wordCount, indexBuffer;
uint32   data;
uint32   msg;
MXF_MIL1553_MSGINFO msgInfo;
char     errorString[200];

#ifdef LOCAL
   rc = mxfServerConnect("0.0.0.0", "", "", FALSE, &server);
#else
   rc = mxfServerConnect("192.168.0.1", "admin", "admin", FALSE, &server);
#endif

   // Initialize MX Foundation library
   if(!rc)
   {
      printf("Starting ...\n\r");
      rc = mxfSystemInit(server);
   }

   // Get handle of first Flex MIL-STD-1553 Bus controller channel
   if(!rc)
      rc = mxfSystemDeviceAllGet(server, MXF_DEVICE_ALL, 1, &deviceCount, &device);

   if(!rc && deviceCount)
      rc = mxfDeviceModuleAllGet(device, MXF_MODULE_MIL1553MRT_EH, 1, &moduleCount, &module);

   if(!rc && moduleCount)
      rc = mxfModuleChannelAllGet(module, MXF_CLASS_MIL1553, MXF_SCLASS_BC_CHANNEL, 1, &channelCount, &bc);

   if(!rc && !channelCount)
      rc = MAXT_ERROR_NOT_FOUND;

   // Get handle of first Flex MIL-STD-1553 bus monitor channel
   if(!rc)
      rc = mxfModuleChannelGet(module, 0, &bm);

   // Get handle for discrete channels
   if(!rc)
      rc = mxfDeviceModuleAllGet(device, MXF_MODULE_DIOFIFO_EH, 1, &moduleCount, &module);

   if(!rc && moduleCount)
      rc = mxfModuleChannelAllGet(module, MXF_CLASS_DISCRETE, MXF_SCLASS_RX_CHANNEL, 1, &channelCount, &discIn);

   if(!rc && channelCount)
      rc = mxfModuleChannelAllGet(module, MXF_CLASS_DISCRETE, MXF_SCLASS_TX_CHANNEL, 1, &channelCount, &discOut);

   if(!rc && !channelCount)
      rc = MAXT_ERROR_NOT_FOUND;
    
   // Set first pin to 0
   if(!rc)
      rc = mxfDiscreteChannelWrite(discOut, 0x1, 0);

   // Enable internal loopback if no cabling is available
#ifdef LOOPBACK
   if(!rc)
      rc = mxfAttributeUint64Set(discIn, KMXF_DISCRETE_TX_RX_TEST_LB, VMXF_ENABLE);

   if(!rc)
      rc = mxfAttributeUint64Set(bm, KMXF_MIL1553_TX_RX_TEST_LB, VMXF_ENABLE);
#endif

   // Allocate 1KB buffer for tx data
   if(!rc)
   {
      txBufferSize = 1024;

      // Device allocation
      for(msg=0; msg<4 && !rc; msg++)
      {
         rc = mxfTxPeriodicUpdateMsgBufferAlloc(bc, msg, txBufferSize, &bcBufferTx[msg], NULL);
      }

      // Host allocation
      if(!rc)
      {
         txBuffer = (MXF_MIL1553_DATAREC*)malloc((size_t)txBufferSize);
         if(!txBuffer)
            rc = MAXT_ERROR_MEM;
      }
   }

   // Allocate 10KB buffer for rx data
   if(!rc)
   {
      rxBufferSize = 10*1024;

      // Device allocation
      rc = mxfRxAcqBufferAlloc(bm, rxBufferSize, &bmBufferRx, NULL);

      // Host allocation
      if(!rc)
      {
         rxBuffer = (MXF_MIL1553_DATAREC*)malloc((size_t)rxBufferSize);
         if(!rxBuffer)
            rc = MAXT_ERROR_MEM;
      }
   }

   // Set timebase to RTC nsec
   if(!rc)
      rc = mxfSystemTimeBaseSet(server, MXF_TIMEBASE_DEVICE_NSEC);

   // Set the minor frame #0 using 1 Command
   if(!rc)
   {
      memset(minorFrame, 0, sizeof(minorFrame));
      memset(&mfProp, 0, sizeof(mfProp));
      
      mfProp.options = MXF_MIL1553_TXPERIODIC_MJRFRAME_MINOR_PROPERTIES_OPT_BRANCH_GOTO;
      mfProp.modulo = 1;
      mfProp.repeatCount = 1;
      mfProp.branchIndex = 0;

      // Command #0 : branch to minor frame #1 when pin 0 is 1
      // Command #0 : Address 5, Subaddress 3, RX, 2 words, Modulo 1
      rc = mxfMIL1553CommandCompose(bcMsgID[BUF_SA3_RX].address, bcMsgID[BUF_SA3_RX].subAddress, bcMsgID[BUF_SA3_RX].type, 2, &minorFrame[0].command);
      if(!rc)
      {
         minorFrame[0].buffer = bcBufferTx[BUF_SA3_RX];
         minorFrame[0].modulo = 1;
         minorFrame[0].condMask = 0x0001;
         minorFrame[0].condData = 0x0001;
         minorFrame[0].branchMinorIndex = 1;
         minorFrame[0].branchMsgIndex = 0xFFFF;
         rc = mxfMIL1553ConditionalBranchOnDiscreteCompose(MXF_MIL1553_TXPERIODIC_MJRFRAME_MSG_CONDBRANCH_OPT_EQUAL, &minorFrame[0].condBranch);
         if(!rc)
            rc = mxfMIL1553TxPeriodicMajorFrameSet(bc, 0, 0, 1, minorFrame, &mfProp);
      }
   }

   // Set the minor frame #1 using 1 Command
   if(!rc)
   {
      memset(minorFrame, 0, sizeof(minorFrame));
      memset(&mfProp, 0, sizeof(mfProp));
      
      mfProp.options = MXF_MIL1553_TXPERIODIC_MJRFRAME_MINOR_PROPERTIES_OPT_BRANCH_GOTO;
      mfProp.modulo = 1;
      mfProp.repeatCount = 1;
      mfProp.branchIndex = 1;

      // Command #0 : branch to minor frame #1 when pin 0 is 0
      // Command #0 : Address 5, Subaddress 3, TX, 2 words
      rc = mxfMIL1553CommandCompose(bcMsgID[BUF_SA3_TX].address, bcMsgID[BUF_SA3_TX].subAddress, bcMsgID[BUF_SA3_TX].type, 2, &minorFrame[0].command);
      if(!rc)
      {
         minorFrame[0].buffer = bcBufferTx[BUF_SA3_TX];
         minorFrame[0].modulo = 1;
         minorFrame[0].condMask = 0x0001;
         minorFrame[0].condData = 0x0000;
         minorFrame[0].branchMinorIndex = 0;
         minorFrame[0].branchMsgIndex = 0xFFFF;
         rc = mxfMIL1553ConditionalBranchOnDiscreteCompose(MXF_MIL1553_TXPERIODIC_MJRFRAME_MSG_CONDBRANCH_OPT_EQUAL, &minorFrame[0].condBranch);
         if(!rc)
            rc = mxfMIL1553TxPeriodicMajorFrameSet(bc, 0, 1, 1, minorFrame, &mfProp);
      }
   }

   // Set BC data for address 5, subaddress 3, RX
   if(!rc)
   {
      txRec1553 = (MXF_MIL1553_DATAREC *)txBuffer;
      memset(txRec1553, 0, sizeof(MXF_MIL1553_DATAREC));
      txRec1553->repeatCount = 10; // repeat count of 10
      txRec1553->dataSize    = 6; //6 bytes (command + 2 words)
      txRec1553->data[0]  = 0x0000; //Not used
      txRec1553->data[1]  = 0x0000;
      txRec1553->data[2]  = 0x1111;

      rc = mxfMIL1553TxPeriodicUpdateMsgWrite(bcBufferTx[BUF_SA3_RX], 1, txBuffer);
   }

   // Start BC acquisition
   if(!rc)
      rc = mxfRxAcqStart(bmBufferRx, MXF_RXACQ_FLAG_DEFAULT, 0, 0);

   // Start the major frame with 250 msec rate
   if(!rc)
      rc = mxfTxPeriodicMajorFrameStart(bc, 0, 250000000, NULL);

   // Read and display received messages
   if(!rc)
   {
      do
      {
         rc = mxfMIL1553RxAcqRead(bmBufferRx, 0, rxBufferSize, &rxAcqStatus, &msgCount, &byteCount, rxBuffer);
      
         rxRec1553 = (MXF_MIL1553_DATAREC*)rxBuffer;
         for(rxRec=0; rxRec<msgCount && !rc; rxRec++)
         {
            rc = mxfMIL1553DataRecordDecompose(bc, 1, rxRec1553, &msgInfo);
            if(!rc)
            {
               rc = mxfMIL1553CommandDecompose(rxRec1553->data[0], &address, &subAddress, &dir, &wordCount);
               if(!rc)
               {
                  printf("\n\r%llu:\t", rxRec1553->timeTag);
                  switch(msgInfo.msgType)
                  {
                  case MXF_MIL1553_MSGINFO_TYPE_BCRT:
                     printf("BC to RT%llu SA%llu WC%llu (0x%04x)\n\r", address, subAddress, wordCount, rxRec1553->data[0]);
                     printf("\t\tBC data:");
                     for(data=0; data<msgInfo.dataWordCount; data++)
                     {
                        if(data && !(data%4))
                           printf("\n\r\t\t\t");

                        printf(" 0x%04x", rxRec1553->data[msgInfo.dataIndex + data]);
                     }
                     printf("\n\r");
                     if(msgInfo.statusIndex[0] != 0xffff)
                        printf("\t\tRT status: 0x%04x\n\r", rxRec1553->data[msgInfo.statusIndex[0]]);
                     break;

                  case MXF_MIL1553_MSGINFO_TYPE_RTBC:
                     printf("RT%llu SA%llu WC%llu to BC (0x%04x)\n\r", address, subAddress, wordCount, rxRec1553->data[0]);
                     if(msgInfo.statusIndex[0] != 0xffff)
                     {
                        printf("\t\tRT status: 0x%04x\n\r", rxRec1553->data[msgInfo.statusIndex[0]]);
                        printf("\t\tRT data:");
                        for(data=0; data<msgInfo.dataWordCount; data++)
                        {
                           if(data && !(data%4))
                              printf("\n\r\t\t\t");

                           printf(" 0x%04x", rxRec1553->data[msgInfo.dataIndex + data]);
                        }
                        printf("\n\r");
                     }
                     break;

                  case MXF_MIL1553_MSGINFO_TYPE_MODECODE_TXDATA:
                     printf("BC Mode Command %llu to RT%llu SA%llu (0x%04x)\n\r", wordCount, address, subAddress, rxRec1553->data[0]);
                     if(msgInfo.statusIndex[0] != 0xffff)
                     {
                        printf("\t\tRT status: 0x%04x\n\r", rxRec1553->data[msgInfo.statusIndex[0]]);
                        printf("\t\tRT data: 0x%04x\n\r", rxRec1553->data[msgInfo.dataIndex]);
                     }
                     break;
                  }
               }
            }
            // Get next msg
            rc = mxfMIL1553NextDataRecordPtrGet(rxRec1553, &rxRec1553);
         }
         mxfSleep(500);
         loop++;
         if(!rc)
         {
            if((loop % 2) == 1)
            {
               // switch to minor frame 1
               rc = mxfDiscreteChannelWrite(discOut, 0x1, 0x1);
            }
            else
            {
               // switch to minor frame 0
               rc = mxfDiscreteChannelWrite(discOut, 0x1, 0x0);
            }
         }
      }while(loop < 10);
   }

   // Stop acquisition
   if(!rc)
      rc = mxfRxAcqStop(bmBufferRx);

   // Clear acquisition
   if(!rc)
      rc = mxfRxAcqClear(bmBufferRx);

   // Stop the major frame
   if(!rc)
      rc = mxfTxPeriodicMajorFrameStop(bc, 0, 0);

   printf("Terminating\n");
   
   // free buffers
   if(txBuffer)
      free(txBuffer);
   if(rxBuffer)
      free(rxBuffer);

   if(rc)
   {
      if(mxfSystemErrorStringGet(server, rc, sizeof(errorString), errorString))
         sprintf (errorString,"ERROR # 0x%08X", rc);

      printf("%s\n\r", errorString);
   }

   // Free all buffers and terminate
   for(indexBuffer = 0; indexBuffer < 4; indexBuffer++)
   {
      if (bcBufferTx[indexBuffer])
      {
         rc = mxfTxPeriodicUpdateMsgBufferFree(bcBufferTx[indexBuffer]);
         if (rc)
            printf("Free buffer failed !\n\r");
      }
   }
   if(bmBufferRx)
   {
      rc = mxfRxAcqBufferFree(bmBufferRx);
      if (rc)
         printf("Free buffer failed !\n\r");
   }
   
   // Unload MX Foundation library
   mxfSystemTerminate(server);
   mxfServerDisconnect(server);
   
   printf("\n\rPress enter to terminate\n\r");
   getchar();
   
   return 0;
}