ar629_aperiodic_mode.cs

/*****************************************************************************
//
//     File:
//        ar629_aperiodic_mode.cs
//
//       Copyright (c) MAX Technologies Inc. 1988-2019, All Rights Reserved.        
//             CONFIDENTIAL AND PROPRIETARY INFORMATION WHICH IS THE 
//                         PROPERTY OF MAX TECHNOLOGIES INC. 
//
//      This example demonstrates the aperiodic mode functionnality.
//
//      This mode allows to transmit A629 message without a major frame.
//      There is some limitation of using this mode:
//          - Only first RT channel can be used
//          - No major frame can be used
//          - This RT channel should be the only transmitter on the bus, otherwise
//            collision could happen since no A629 timers (TI, SG and TG) are used
//
//       Hardware requirements:
//          - MAXT FlexMulti-629.
//
*****************************************************************************/

#define TTL
//#define LOCAL

using System;
using static MAXT.MXFoundation.mxf;
using System.Runtime.InteropServices;
using System.Text;
using System.IO;

namespace ar629_example
{
    class ar629_aperiodic_mode
    {
        const int MAX_RX_RECORDS_TO_RECEIVE = 1000;
        const int MAX_TX_RECORDS_TO_TRANSMIT = 2;


        static void Main(string[] args)
        {
            int RX_BUFFER_SIZE = MAX_RX_RECORDS_TO_RECEIVE * Marshal.SizeOf(typeof(MXF_A629_DATAREC));
            int TX_BUFFER_SIZE = MAX_TX_RECORDS_TO_TRANSMIT * Marshal.SizeOf(typeof(MXF_A629_DATAREC));

            IntPtr recPtr = IntPtr.Zero;
            IntPtr hostBuffer = IntPtr.Zero;
            UInt64 server = 0;
            UInt64 device = 0;
            var module = new UInt64[1];
            UInt64 count = 0;
            var rxChannel = new UInt64[1];
            var txChannel = new UInt64[1];
            UInt64 rxBuffer = 0;
            UInt64 txBuffer = 0;
            UInt32 rc;
            UInt64 status, msgsCount, bytesCount;
            UInt32 length;
            int i;
            MXF_A629_DATAREC aRec629 = new MXF_A629_DATAREC()
            {
                data = new UInt16[258]
            };

            // Connects to services and initialize environment
#if LOCAL
            rc = mxfServerConnect("0.0.0.0", "", "", Convert.ToUInt64(false), out server);
#else
            rc = mxfServerConnect("192.168.0.1", "admin", "admin", Convert.ToUInt64(false), out server);
#endif

            // Initializes MX Foundation library
            if (rc == MAXT_SUCCESS)
            {
                Console.WriteLine("Starting ...");
                rc = mxfSystemInit(server);
            }

            // Gets the first device handle
            if (rc == MAXT_SUCCESS)
                rc = mxfSystemDeviceGet(server, 0, out device);

            if (rc == MAXT_SUCCESS)
                rc = mxfDeviceModuleAllGet(device, MXF_MODULE_A629MRT_EH, 1, out count, module);

            // Obtains the first ARINC 629 Protocol RX channel (RX logical #0)
            if ((rc == MAXT_SUCCESS) && (count != 0))
                rc = mxfModuleChannelAllGet(module[0], MXF_CLASS_A629, MXF_SCLASS_RX_CHANNEL, 1, out count, rxChannel);

            // Obtains the first ARINC 629 Protocol TX channel (TX logical #0)
            if ((rc == MAXT_SUCCESS) && (count != 0))
                rc = mxfModuleChannelAllGet(module[0], MXF_CLASS_A629, MXF_SCLASS_TX_CHANNEL, 1, out count, txChannel);

            // If module or channel not found, returns an error
            if ((rc == MAXT_SUCCESS) && (count == 0))
                rc = MAXT_ERROR_NOT_FOUND;

            // Sets timebase to 64-bit nanoseconds
            if (rc == MAXT_SUCCESS)
                rc = mxfSystemTimeBaseSet(server, MXF_TIMEBASE_DEVICE_NSEC);

            // Sets interface to SIM or TTL
#if TTL
            if (rc == MAXT_SUCCESS)
                rc = mxfAttributeUint64Set(module[0], KMXF_A629_MODULE_INTERFACE, VMXF_A629_MODULE_INTERFACE_TTL);
#else
            if (rc == MAXT_SUCCESS)
                rc = mxfAttributeUint64Set(module[0], KMXF_A629_MODULE_INTERFACE, VMXF_A629_MODULE_INTERFACE_SIM);
#endif

            // Enable Aperiodic mode
            if (rc == MAXT_SUCCESS)
                rc = mxfAttributeUint64Set(module[0], KMXF_A629_MODULE_APERIODIC_MODE, VMXF_ENABLE);

            // Allocates RX acquisition buffer
            if (rc == MAXT_SUCCESS)
                rc = mxfRxAcqBufferAlloc(rxChannel[0], (UInt64)RX_BUFFER_SIZE, out rxBuffer, IntPtr.Zero);

            // Allocates one TX Aperiodic buffer
            if (rc == MAXT_SUCCESS)
                rc = mxfTxAperiodicBufferAlloc(txChannel[0], MXF_TXAPERIODIC_PRIORITY_HIGH, (UInt64)TX_BUFFER_SIZE, out txBuffer, IntPtr.Zero);

            // Allocates host buffer
            if (rc == MAXT_SUCCESS)
            {
                try
                {
                    hostBuffer = Marshal.AllocHGlobal(Math.Max(RX_BUFFER_SIZE, TX_BUFFER_SIZE));
                }
                catch (OutOfMemoryException)
                {
                    rc = MAXT_ERROR_MEM;
                }
            }

            // Start the acquisition process
            if (rc == MAXT_SUCCESS)
                rc = mxfRxAcqModeSet(rxBuffer, MXF_RXACQ_MODE_LINEAR);
            if (rc == MAXT_SUCCESS)
            {
                rc = mxfRxAcqStart(rxBuffer, MXF_RXACQ_FLAG_DEFAULT, 0, 0);
                if (rc == MAXT_SUCCESS)
                {
                    Console.WriteLine();
                    Console.WriteLine("Acquisition started");
                }
            }

            // Transmits one message with two wordstrings. Label and CID are set in data[0]
            if (rc == MAXT_SUCCESS)
            {
                recPtr = hostBuffer;

                //Sets the lentgh of this label/CID
                length = 8; //8 bytes (label + 3 data word)

                aRec629.control = MXF_A629_TX_REC_CTRL_PPSYNC | MXF_A629_TX_REC_CTRL_PSYNC; // First wordstring of message must have PPSYNC and PSYNC set
                aRec629.repeatCount = 1;
                aRec629.dataSize = length;
                aRec629.data[0] = 0x001 | (0x2 << 12); // label 1, CID 2
                aRec629.data[1] = 0x1104;
                aRec629.data[2] = 0x1105;
                aRec629.data[3] = 0x1106;

                Marshal.StructureToPtr(aRec629, recPtr, false);
                rc = mxfA629NextDataRecordPtrGet(recPtr, out recPtr);

                //Set the lentgh of this label/CID
                length = 120; //120 bytes (label + 59 data words)

                aRec629.control = MXF_A629_TX_REC_CTRL_CRC; // MXF_A629_TX_REC_CTRL_CRC specifies to compute and send a CRC. It will be added after the last word.
                aRec629.repeatCount = 1;
                aRec629.dataSize = length;
                aRec629.data[0] = 0x002 | (0x2 << 12); // label 1, CID 2
                aRec629.data[1] = 0x0178;
                for (i = 2; i < (int)length / 2; i++)
                {
                    aRec629.data[i] = (UInt16)i;
                }
                Marshal.StructureToPtr(aRec629, recPtr, false);
                if (rc == MAXT_SUCCESS)
                    rc = mxfTxAperiodicWrite(txBuffer, MXF_TXAPERIODIC_FLAG_DEFAULT, 0, 2, hostBuffer);
            }

            //------------------------------------------------//

            //Waiting 1 second. Allows data to be transmitted.
            mxfSleep(1000);

            // Stop acquisition and read data
            if (rc == MAXT_SUCCESS)
                rc = mxfRxAcqStop(rxBuffer);

            if (rc == MAXT_SUCCESS)
            {
                rc = mxfA629RxAcqRead(rxBuffer, 0, (UInt64)RX_BUFFER_SIZE, out status, out msgsCount, out bytesCount, hostBuffer);

                DisplayDataArray(msgsCount, hostBuffer);
            }

            if (rc != MAXT_SUCCESS)
            {
                StringBuilder buffer = new StringBuilder(256);

                if (mxfSystemErrorStringGet(server, rc, 256, buffer) != MAXT_SUCCESS)
                    buffer.Append(string.Format("ERROR # 0x{0:x8}", rc));

                Console.WriteLine(buffer);
            }

            Console.WriteLine("Terminating ...");

            // Free all buffers and terminate
            if (rxBuffer != 0)
                mxfRxAcqBufferFree(rxBuffer);

            if (txBuffer != 0)
                mxfTxAperiodicBufferFree(txBuffer);

            if (hostBuffer != IntPtr.Zero)
                Marshal.FreeHGlobal(hostBuffer);

            // Unloads MX Foundation library
            mxfSystemTerminate(server);

            // Disconnects from MX Foundation library
            mxfServerDisconnect(server);

            Console.WriteLine();
            Console.WriteLine("Press a key to terminate");
            Console.Read();

            return;
        }

        private static void DisplayDataArray(UInt64 recNum, IntPtr rec)
        {
            UInt64 iRec,
                   iData;
            IntPtr p = rec;
            MXF_A629_DATAREC rec629 = new MXF_A629_DATAREC
            {
                data = new UInt16[258]
            };

            Console.WriteLine();
            for (iRec = 0; iRec < recNum; iRec++)
            {
                rec629 = (MXF_A629_DATAREC)Marshal.PtrToStructure(p, typeof(MXF_A629_DATAREC));
                Console.Write("{0:D3} {1:D10} {2:D2} ", iRec, rec629.timeTag, rec629.dataSize);

                if ((rec629.control & MXF_A629_RX_REC_CTRL_STRING_CRC_ERROR) == MXF_A629_RX_REC_CTRL_STRING_CRC_ERROR)
                    Console.Write(" CRC error");
                if ((rec629.control & MXF_A629_RX_REC_CTRL_STRING_DATA_SYNC_ERROR) == MXF_A629_RX_REC_CTRL_STRING_DATA_SYNC_ERROR)
                    Console.Write(" Data sync error");
                if (((rec629.control & (MXF_A629_RX_REC_CTRL_STRING_LABEL_MANCHESTER_ERROR)) == (MXF_A629_RX_REC_CTRL_STRING_LABEL_MANCHESTER_ERROR)) ||
                ((rec629.control & (MXF_A629_RX_REC_CTRL_STRING_DATA_MANCHESTER_ERROR)) == (MXF_A629_RX_REC_CTRL_STRING_DATA_MANCHESTER_ERROR)))
                    Console.Write(" Manchester error ");
                if (((rec629.control & (MXF_A629_RX_REC_CTRL_STRING_LABEL_PARITY_ERROR)) == (MXF_A629_RX_REC_CTRL_STRING_LABEL_PARITY_ERROR)) ||
                ((rec629.control & (MXF_A629_RX_REC_CTRL_STRING_DATA_PARITY_ERROR)) == (MXF_A629_RX_REC_CTRL_STRING_DATA_PARITY_ERROR)))
                    Console.Write(" Parity error ");
                if ((rec629.control & MXF_A629_RX_REC_CTRL_STRING_EOS_ERROR) == MXF_A629_RX_REC_CTRL_STRING_EOS_ERROR)
                    Console.Write(" End of String error");

                for (iData = 0; iData < rec629.dataSize / 2; iData++)
                {
                    Console.Write("{0:x4} ", rec629.data[iData]);

                    if ((((iData + 1) % 8) == 0) && (iData + 1 < rec629.dataSize / 2))
                        Console.Write("\n                              ");
                }

                Console.WriteLine();

                mxfA629NextDataRecordPtrGet(p, out p);
            }
        }
    }
}