ar629_alternate.cs

/*****************************************************************************
//
//     File:
//        ar629_alternate.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 use of alternate and synchronized schedules.
//
//       Hardware requirements:
//          - MAXT FlexMulti-629.
//          - Pin IO #0 must be connected to MAFS Pin.
//
*****************************************************************************/

#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_alternate
    {

        const int MAX_RX_RECORDS_TO_RECEIVE = 1000;
        const int MAX_TX_RECORDS_TO_TRANSMIT = 1;

        const int NUM_LABEL = 5;
        const int ALT_LABEL = 4;
        const int NUM_Y = 4;
        const int NUM_X = 2;


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

        public LABEL_INFO[] LABEL = new LABEL_INFO[NUM_LABEL]
        {
            new LABEL_INFO{label = 0xEE1, length = 20, bufferIndex = 0}, new LABEL_INFO{label = 0xEF5, length = 24, bufferIndex = 1},new LABEL_INFO{label = 0xEF6, length = 20, bufferIndex = 2},new LABEL_INFO{label = 0xEF7, length = 20, bufferIndex = 3},new LABEL_INFO{label = 0xEF6, length = 20, bufferIndex = 4}

        };


        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 discreteChannel = 0;
            UInt64 rxBuffer = 0;
            var txBuffer = new UInt64[NUM_LABEL];
            IntPtr hostBuffer = IntPtr.Zero;
            IntPtr txHostBuffer = IntPtr.Zero;
            IntPtr recPtr = IntPtr.Zero;
            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;
            UInt32 minor, label;
            MXF_A629_TXPERIODIC_MJRFRAME_SYNC sync = new MXF_A629_TXPERIODIC_MJRFRAME_SYNC();
            ar629_alternate labelClass = new ar629_alternate();
            MXF_A629_DATAREC rec629 = new MXF_A629_DATAREC()
            {
                data = new UInt16[258]
            };
            MXF_A629_DATAREC txRec629 = new MXF_A629_DATAREC()
            {
                data = new UInt16[258]
            };

            LABEL_INFO[,] majorFrame = new LABEL_INFO[NUM_Y, NUM_X]
            {
                {new LABEL_INFO{label = labelClass.LABEL[1].label, length = labelClass.LABEL[1].length, bufferIndex=labelClass.LABEL[1].bufferIndex } ,new LABEL_INFO{label = labelClass.LABEL[3].label, length = labelClass.LABEL[3].length, bufferIndex=labelClass.LABEL[3].bufferIndex  } },
                {new LABEL_INFO{label = labelClass.LABEL[1].label, length = labelClass.LABEL[1].length, bufferIndex=labelClass.LABEL[1].bufferIndex } ,new LABEL_INFO{label = labelClass.LABEL[0].label, length = labelClass.LABEL[0].length, bufferIndex=labelClass.LABEL[0].bufferIndex  } },
                {new LABEL_INFO{label = labelClass.LABEL[1].label, length = labelClass.LABEL[1].length, bufferIndex=labelClass.LABEL[1].bufferIndex } ,new LABEL_INFO{label = labelClass.LABEL[3].label, length = labelClass.LABEL[3].length, bufferIndex=labelClass.LABEL[3].bufferIndex } },
                {new LABEL_INFO{label = labelClass.LABEL[1].label, length = labelClass.LABEL[1].length, bufferIndex=labelClass.LABEL[1].bufferIndex } ,new LABEL_INFO{label = labelClass.LABEL[2].label, length = labelClass.LABEL[2].length, bufferIndex=labelClass.LABEL[2].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("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;

            // Get discrete output channel
            if (rc == MAXT_SUCCESS)
                rc = mxfChannelGet(server, MXF_CLASS_DISCRETE, MXF_SCLASS_TX_CHANNEL, MXF_MODULE_ALL, 0, out discreteChannel);

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

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

            //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++)
                {
                    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 = MXF_A629_TXPERIODIC_MJRFRAME_MSG_OPT_SYNC;
                }

                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 = 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);
                if (rc == MAXT_SUCCESS)
                {
                    Console.WriteLine("*** Sync cell #0 ***");
                    Console.WriteLine("Alternate index : {0}", sync.altIndex);
                    Console.WriteLine("Sync index      : {0}", sync.syncIndex);
                }
            }

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

            // PIN discrete ouput #0 must be connected to MAFS Pin
            if (rc == MAXT_SUCCESS)
            {
                Console.WriteLine("Press enter key to switch to Alternate schedule");
                Console.Read();
                rc = mxfAttributeUint64Set(txChannel[0], KMXF_A629_RT_ALTERNATE_SCHED, VMXF_ENABLE);
                if (rc == MAXT_SUCCESS)
                    rc = mxfDiscreteChannelWrite(discreteChannel, 0x01, 0x00);
            }

            if (rc == MAXT_SUCCESS)
            {
                Console.WriteLine("Press enter key to switch to Synchronized schedule");
                Console.Read();
                rc = mxfAttributeUint64Set(txChannel[0], KMXF_A629_RT_ALTERNATE_SCHED, VMXF_DISABLE);
            }

            if (rc == MAXT_SUCCESS)
            {
                Console.WriteLine("Press a key to switch back to primary schedule");
                Console.Read();
                rc = mxfDiscreteChannelWrite(discreteChannel, 0x01, 0x01);
            }

            if (rc == MAXT_SUCCESS)
            {
                Console.WriteLine("Press a key to stop");
                Console.Read();
                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
                    recPtr = hostBuffer;
                    for (index = 0; (index < msgsCount) && (rc == MAXT_SUCCESS); index++)
                    {
                        rec629 = (MXF_A629_DATAREC)Marshal.PtrToStructure(recPtr, typeof(MXF_A629_DATAREC));
                        Console.Write("   {0:D3}: Timetag={1:D12}, Size={2} ", index, 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");
                        Console.Write("\n        Data=");

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

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

                        Console.WriteLine();

                        mxfA629NextDataRecordPtrGet(recPtr, out recPtr);
                    }
                }
            }

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