ar629_independent_mode.cs

/*****************************************************************************
//
//     File:
//        ar629_independent_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 demo shows how to set a basic periodic transmission in independent
//    mode and set the ARINC 629 data. The transmission scenario is inspired
//    of SAARU equipment.
//    Acquisition is also performed with CRC verification enabled for labels
//    that have a CRC.
//
//    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_independent_mode
    {
        const int MAX_RX_RECORDS_TO_RECEIVE = 1000;
        const int MAX_TX_RECORDS_TO_TRANSMIT = 1;

        const int NUM_Y = 8;
        const int NUM_X = 2;
        const int ALT_LABEL = 5;
        const int NUM_LABEL = 7;

        [StructLayout(LayoutKind.Sequential)]
        public struct LABEL_INFO
        {
            public UInt16 label;
            public UInt16 length;
            public UInt16 crc;
            public UInt32 fc;
            public UInt32 bufferIndex;
            public UInt32 empty;
        }

        public LABEL_INFO[] LABEL = new LABEL_INFO[NUM_LABEL]
        {
            new LABEL_INFO{label = 0xFE1, length = 8, crc = 1, fc = 1, bufferIndex = 0}, new LABEL_INFO{label = 0xFE2, length = 14, crc = 1, fc = 1, bufferIndex = 1},new LABEL_INFO{label = 0xFE3, length = 14, crc = 1, fc = 1, bufferIndex = 2},
            new LABEL_INFO{label = 0xFE4, length = 14, crc = 1, fc = 1, bufferIndex = 3},new LABEL_INFO{label = 0xFE5, length = 14, crc = 1, fc = 1, bufferIndex = 4},new LABEL_INFO{label = 0xFE6, length = 14, crc = 0, fc = 0, bufferIndex = 5},
            new LABEL_INFO{label = 0xFE7, length = 14, crc = 1, fc = 1, bufferIndex = 6}

        };

        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));

            UInt32 rc;
            UInt64 server;
            UInt64 device = 0;
            var module = new UInt64[1];
            UInt64 count = 0;
            var rxChannel = new UInt64[1];
            var txChannel = new UInt64[1];
            UInt64 rxBuffer = 0;
            var txBuffer = new UInt64[NUM_LABEL];
            IntPtr hostBuffer = IntPtr.Zero;
            IntPtr txHostBuffer = IntPtr.Zero;
            IntPtr rec629 = IntPtr.Zero;
            UInt64 dev, mod, port;
            var minorFrame = new MXF_A629_TXPERIODIC_MJRFRAME_MSG[NUM_X];
            UInt64 index, word;
            MXF_A629_TXPERIODIC_MJRFRAME_PROPERTIES majorProperties = new MXF_A629_TXPERIODIC_MJRFRAME_PROPERTIES();
            UInt64 status, msgsCount, bytesCount;
            MXF_A629_FC fc = new MXF_A629_FC();
            UInt32 minor, label;
            MXF_A629_TXPERIODIC_MJRFRAME_SYNC sync = new MXF_A629_TXPERIODIC_MJRFRAME_SYNC();
            ar629_independent_mode labelClass = new ar629_independent_mode();
            MXF_A629_DATAREC txRec629 = new MXF_A629_DATAREC()
            {
                data = new UInt16[258]
            };
            MXF_A629_DATAREC rxRec629 = new MXF_A629_DATAREC()
            {
                data = new UInt16[258]
            };


            LABEL_INFO[,] majorFrame = new LABEL_INFO[NUM_Y, NUM_X]
            {
                {new LABEL_INFO{label = labelClass.LABEL[6].label, length = labelClass.LABEL[6].length, crc = labelClass.LABEL[6].crc, fc = labelClass.LABEL[6].fc, bufferIndex = labelClass.LABEL[6].bufferIndex} ,new LABEL_INFO{label = labelClass.LABEL[0].label, length = labelClass.LABEL[0].length, crc = labelClass.LABEL[0].crc, fc = labelClass.LABEL[0].fc, bufferIndex = labelClass.LABEL[0].bufferIndex} },
                {new LABEL_INFO{empty = 1} ,new LABEL_INFO{label = labelClass.LABEL[4].label, length = labelClass.LABEL[4].length, crc = labelClass.LABEL[4].crc, fc = labelClass.LABEL[4].fc, bufferIndex = labelClass.LABEL[4].bufferIndex} },
                {new LABEL_INFO{empty = 1} ,new LABEL_INFO{label = labelClass.LABEL[3].label, length = labelClass.LABEL[3].length, crc = labelClass.LABEL[3].crc, fc = labelClass.LABEL[3].fc, bufferIndex = labelClass.LABEL[3].bufferIndex} },
                {new LABEL_INFO{empty = 1} ,new LABEL_INFO{label = labelClass.LABEL[2].label, length = labelClass.LABEL[2].length, crc = labelClass.LABEL[2].crc, fc = labelClass.LABEL[2].fc, bufferIndex = labelClass.LABEL[2].bufferIndex} },
                {new LABEL_INFO{empty = 1} ,new LABEL_INFO{label = labelClass.LABEL[1].label, length = labelClass.LABEL[1].length, crc = labelClass.LABEL[1].crc, fc = labelClass.LABEL[1].fc, bufferIndex = labelClass.LABEL[1].bufferIndex} },
                {new LABEL_INFO{empty = 1} ,new LABEL_INFO{label = labelClass.LABEL[4].label, length = labelClass.LABEL[4].length, crc = labelClass.LABEL[4].crc, fc = labelClass.LABEL[4].fc, bufferIndex = labelClass.LABEL[4].bufferIndex} },
                {new LABEL_INFO{empty = 1} ,new LABEL_INFO{label = labelClass.LABEL[3].label, length = labelClass.LABEL[3].length, crc = labelClass.LABEL[3].crc, fc = labelClass.LABEL[3].fc, bufferIndex = labelClass.LABEL[3].bufferIndex} },
                {new LABEL_INFO{empty = 1} ,new LABEL_INFO{label = labelClass.LABEL[5].label, length = labelClass.LABEL[5].length, crc = labelClass.LABEL[5].crc, fc = labelClass.LABEL[5].fc, bufferIndex = labelClass.LABEL[5].bufferIndex} },
            };

            // 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

            if (rc != MAXT_SUCCESS)
            {
                Console.WriteLine("Failed to connect; rc=0x{0:x8}", rc);
                Console.WriteLine("Press a key to terminate");
                Console.Read();
                return;
            }

            // Initialize the server
            if (rc == MAXT_SUCCESS)
            {
                Console.WriteLine();
                Console.WriteLine("Starting");
                rc = mxfSystemInit(server);
            }

            // Get 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);

            // Obtain 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);

            // Obtain 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, return an error
            if ((rc == MAXT_SUCCESS) && (count == 0))
                rc = MAXT_ERROR_NOT_FOUND;

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

            // Get the physical port location
            if (rc == MAXT_SUCCESS)
            {
                rc = mxfChannelLocationGet(rxChannel[0], out dev, out mod, out port);
                if (rc == MAXT_SUCCESS)
                    Console.WriteLine("Acquisition Channel (RX) location={0}.{1}.{2}", dev, mod, port);
            }

            if (rc == MAXT_SUCCESS)
            {
                rc = mxfChannelLocationGet(txChannel[0], out dev, out mod, out port);
                if (rc == MAXT_SUCCESS)
                    Console.WriteLine("Transmitter Channel (TX) location={0}.{1}.{2}", dev, mod, port);
            }

            // Set 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

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

            // Allocate TX Periodic Update Message buffer
            for (index = 0; (index < NUM_LABEL) && (rc == MAXT_SUCCESS); index++)
                rc = mxfTxPeriodicUpdateMsgBufferAlloc(txChannel[0], index, (UInt64)TX_BUFFER_SIZE, out txBuffer[index], IntPtr.Zero);

            // Allocate host buffer
            if (rc == MAXT_SUCCESS)
            {
                try
                {
                    hostBuffer = Marshal.AllocHGlobal(Math.Max(RX_BUFFER_SIZE, TX_BUFFER_SIZE));
                }
                catch (OutOfMemoryException)
                {
                    rc = MAXT_ERROR_MEM;
                }
                try
                {
                    txHostBuffer = Marshal.AllocHGlobal(Marshal.SizeOf(txRec629) * 10);
                }
                catch (OutOfMemoryException)
                {
                    rc = MAXT_ERROR_MEM;
                }
            }

            // Add CRC verification
            for (index = 0; (index < NUM_LABEL) && (rc == MAXT_SUCCESS); index++)
                rc = mxfA629RxMsgCrcEnableSet(rxChannel[0], labelClass.LABEL[index].label, 0, labelClass.LABEL[index].crc);

            // 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");
                }

            }

            //Disable the CID in XPP
            if (rc == MAXT_SUCCESS)
                rc = mxfAttributeUint64Set(module[0], KMXF_A629_MODULE_XPP_CID_ENABLE, Convert.ToUInt64(false));

            //Set the TI to 5 msec
            if (rc == MAXT_SUCCESS)
                rc = mxfAttributeUint64Set(module[0], KMXF_A629_MODULE_TI, 5000000);

            //Set the SG to 32
            if (rc == MAXT_SUCCESS)
                rc = mxfAttributeUint64Set(module[0], KMXF_A629_MODULE_SG, VMXF_A629_MODULE_SG_32);

            //Set the TG to 20
            if (rc == MAXT_SUCCESS)
                rc = mxfAttributeUint64Set(txChannel[0], KMXF_A629_RT_TG, 20);

            //Set the CID to 0
            if (rc == MAXT_SUCCESS)
                rc = mxfAttributeUint64Set(txChannel[0], KMXF_A629_RT_CID, 0);

            //Clear the major frame
            if (rc == MAXT_SUCCESS)
                rc = mxfTxPeriodicMajorFrameClear(txChannel[0], 0);

            // set 8 minor frames with 2 labels each
            for (minor = 0; (minor < NUM_Y) && (rc == MAXT_SUCCESS); minor++)
            {
                minorFrame = new MXF_A629_TXPERIODIC_MJRFRAME_MSG[NUM_X];

                for (label = 0; (label < NUM_X) && (rc == MAXT_SUCCESS); label++)
                {
                    if (majorFrame[minor,label].empty != 1)
                    {
                        minorFrame[label].buffer = txBuffer[majorFrame[minor,label].bufferIndex];
                        minorFrame[label].label = majorFrame[minor,label].label;
                        minorFrame[label].cid = 0;
                        minorFrame[label].length = majorFrame[minor,label].length;
                        minorFrame[label].options = (majorFrame[minor,label].crc == 1) ? MXF_A629_TXPERIODIC_MJRFRAME_MSG_OPT_CRC_ENABLE : (UInt16)0;
                        minorFrame[label].options |= MXF_A629_TXPERIODIC_MJRFRAME_MSG_OPT_SYNC;
                    }
                    else
                    {
                        minorFrame[label].buffer = 0;
                        minorFrame[label].label = 0;
                        minorFrame[label].cid = 0;
                        minorFrame[label].length = 0;
                        minorFrame[label].options = MXF_A629_TXPERIODIC_MJRFRAME_MSG_OPT_UNUSED;
                    }
                }

                rc = mxfA629TxPeriodicMajorFrameSet(txChannel[0], 0, minor, NUM_X, minorFrame);
            }

            // Add Alternate frame
            if (rc == MAXT_SUCCESS)
            {
                minorFrame[0].buffer = txBuffer[labelClass.LABEL[ALT_LABEL].bufferIndex];
                minorFrame[0].label = labelClass.LABEL[ALT_LABEL].label;
                minorFrame[0].cid = 0;
                minorFrame[0].length = labelClass.LABEL[ALT_LABEL].length;
                minorFrame[0].options = (labelClass.LABEL[ALT_LABEL].crc == 1) ? MXF_A629_TXPERIODIC_MJRFRAME_MSG_OPT_CRC_ENABLE : (UInt16)0;
                minorFrame[0].options |= MXF_A629_TXPERIODIC_MJRFRAME_MSG_OPT_SYNC;

                rc = mxfA629TxPeriodicMajorFrameSet(txChannel[0], 0, 30, 1, minorFrame);
            }

            // set SYNC Frame
            if (rc == MAXT_SUCCESS)
            {
                sync.altIndex = 30;
                sync.syncIndex = 0;
                rc = mxfA629TxPeriodicMajorFrameSyncSet(txChannel[0], 0, 0, ref sync);
            }

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

            // Add FC
            for (index = 0; (index < NUM_LABEL) && (rc == MAXT_SUCCESS); index++)
            {
                fc.enable = labelClass.LABEL[index].fc;
                fc.position = 1;
                fc.mask = 0x00f0;
                fc.modulo = 1;
                rc = mxfA629MsgFreshnessCounterSet(txBuffer[labelClass.LABEL[index].bufferIndex], ref fc);
            }

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

            //--- Set default data ---//

            for (index = 0; (index < NUM_LABEL) && (rc == MAXT_SUCCESS); index++)
            {
                txRec629.control = 0;
                txRec629.repeatCount = 1;
                txRec629.dataSize = 2 + (labelClass.LABEL[index].length * (UInt32)2);
                txRec629.data[0] = 0;
                for (word = 1; word <= labelClass.LABEL[index].length; word++)
                    txRec629.data[word] = (UInt16)(0x1111 * index);
                Marshal.StructureToPtr(txRec629, txHostBuffer, false);
                rc = mxfA629TxPeriodicUpdateMsgWrite(txBuffer[labelClass.LABEL[index].bufferIndex], 1, txHostBuffer);
            }

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

            //Start the major frame in the Independent mode
            if (rc == MAXT_SUCCESS)
            {
                majorProperties.mode = MXF_A629_TXPERIODIC_MJRFRAME_PROPERTIES_MODE_INDEPENDENT;
                majorProperties.reserved = 0;
                rc = mxfA629TxPeriodicMajorFrameStart(txChannel[0], 0, ref majorProperties);
            }

            //Waiting 2 seconds. Allow major frame to run a little bit.
            if (rc == MAXT_SUCCESS)
                mxfSleep(2000);

            //Stop the major frame
            if (rc == MAXT_SUCCESS)
                rc = mxfTxPeriodicMajorFrameStop(txChannel[0], 0, 0);

            // 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);
                if (rc == MAXT_SUCCESS)
                {
                    // Display received messages
                    rec629 = hostBuffer;
                    for (index = 0; (index < msgsCount) && (rc == MAXT_SUCCESS); index++)
                    {
                        rxRec629 = (MXF_A629_DATAREC)Marshal.PtrToStructure(rec629, typeof(MXF_A629_DATAREC));
                        Console.Write("   {0:D3}: Timetag={1:D12}, Size={2}", index, rxRec629.timeTag, rxRec629.dataSize);
                        if ((rxRec629.control & MXF_A629_RX_REC_CTRL_STRING_CRC_ERROR) == MXF_A629_RX_REC_CTRL_STRING_CRC_ERROR)
                            Console.Write(" CRC error");
                        if ((rxRec629.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 (((rxRec629.control & (MXF_A629_RX_REC_CTRL_STRING_LABEL_MANCHESTER_ERROR)) == (MXF_A629_RX_REC_CTRL_STRING_LABEL_MANCHESTER_ERROR)) ||
                        ((rxRec629.control & (MXF_A629_RX_REC_CTRL_STRING_DATA_MANCHESTER_ERROR)) == (MXF_A629_RX_REC_CTRL_STRING_DATA_MANCHESTER_ERROR)))
                            Console.Write(" Manchester error ");
                        if (((rxRec629.control & (MXF_A629_RX_REC_CTRL_STRING_LABEL_PARITY_ERROR)) == (MXF_A629_RX_REC_CTRL_STRING_LABEL_PARITY_ERROR)) ||
                        ((rxRec629.control & (MXF_A629_RX_REC_CTRL_STRING_DATA_PARITY_ERROR)) == (MXF_A629_RX_REC_CTRL_STRING_DATA_PARITY_ERROR)))
                            Console.Write(" Parity error ");
                        if ((rxRec629.control & MXF_A629_RX_REC_CTRL_STRING_EOS_ERROR) == MXF_A629_RX_REC_CTRL_STRING_EOS_ERROR)
                            Console.Write(" End of String error");
                        Console.Write("\n        Data=");
                        for (word = 0; word < rxRec629.dataSize / 2; word++)
                        {
                            Console.Write("{0:X4} ", rxRec629.data[word]);

                            if ((((word + 1) % 8) == 0) && (word + 1 < rxRec629.dataSize / 2))
                                Console.Write("\n             ");
                        }
                        Console.Write("\n");
                        rc = mxfA629NextDataRecordPtrGet(rec629, out rec629);
                    }
                }
            }

            // Catch any previous error
            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();
            Console.WriteLine("Terminating");

            // Free all buffers and terminate
            if (device != 0)
                mxfDeviceBuffersFree(device);

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

            mxfSystemTerminate(server);
            mxfServerDisconnect(server);

            Console.WriteLine();
            Console.WriteLine("Press enter to terminate");
            Console.Read();


            return;
        }
    }
}