PEAK-System Forum

Code: Select all

using System;
using System.Collections.Generic;
using System.Linq;
using System.Reflection;
using System.Runtime.InteropServices;
using System.Text;
using System.Threading;
using System.Threading.Tasks;

namespace PCAN_PassThru
{
    class Program
    {
        public static bool is_run = true;

        public static J2534Err status;
        public static J2534Extended passThru = new J2534Extended();
        public static List<J2534Device> availableJ2534Devices = J2534Detect.ListDevices();
        public static J2534Device j2534Device;
        public static int deviceId = 0;
        public static int channelId = 0;
        public static int filterId = 0;


        static void Main(string[] args)
        {
            // Add CTRL+C signal event handler.
            Console.CancelKeyPress += new ConsoleCancelEventHandler(ExitHandler);

            // Kvaser
            //J2534Device j2534Device = availableJ2534Devices[0];

            // Peak-CAN
            j2534Device = availableJ2534Devices[1];


            Console.WriteLine("Load Library : {0}", j2534Device.FunctionLibrary);
            // We will always choose the first J2534 device in the list, if there are multiple devices
            //   installed, you should do something more intelligent.
            passThru.LoadLibrary(j2534Device);

            Console.WriteLine("Open Device");
            // Attempt to open a communication link with the pass thru device
            
            status = passThru.PassThruOpen(IntPtr.Zero, ref deviceId);

            Console.WriteLine("Open Channel");
            // Open a new channel configured for ISO15765 (CAN)
            status = passThru.PassThruConnect(deviceId, ProtocolID.CAN, ConnectFlag.CAN_ID_BOTH, BaudRate.CAN_250000, ref channelId);

            Console.WriteLine("Apply Filter");
            // Set up a message filter to watch for response messages
           
            PassThruMsg maskMsg = new PassThruMsg(
                ProtocolID.CAN,
                TxFlag.CAN_29BIT_ID,
                new byte[] { 0x00, 0x00, 0x00, 0x00 });

            PassThruMsg patternMsg = new PassThruMsg(
                ProtocolID.CAN,
                TxFlag.CAN_29BIT_ID,
                new byte[] { 0x00, 0x00, 0x00, 0x00 });

            IntPtr maskMsgPtr = maskMsg.ToIntPtr();
            IntPtr patternMsgPtr = patternMsg.ToIntPtr();
            status = passThru.PassThruStartMsgFilter(channelId, FilterType.PASS_FILTER, maskMsgPtr, patternMsgPtr, IntPtr.Zero, ref filterId);

            Console.WriteLine("Clear RX Buffer");
            // Clear out the response buffer so we know we're getting the freshest possible data
            status = passThru.ClearRxBuffer(channelId);

            Console.WriteLine("Send Message");
            // Finally we can send the message!
            PassThruMsg txMsg = new PassThruMsg(
                ProtocolID.CAN,
                TxFlag.NONE,
                new byte[] { 0x00, 0x00, 0x07, 0xDF, 0x01, 0x00, 0x05, 0x06 });

            var txMsgPtr = txMsg.ToIntPtr();
            int numMsgs = 1;
            status = passThru.PassThruWriteMsgs(channelId, txMsgPtr, ref numMsgs, 50);
            //status = passThru.PassThruStartPeriodicMsg(channelId, txMsgPtr, ref numMsgs, 100);


            ThreadStart threadDelegate = new ThreadStart(CANReadThreadFunc);
            Thread m_ReadThread = new Thread(threadDelegate);
            //m_ReadThread.IsBackground = true;
            m_ReadThread.Start();


#if DEBUG
            Console.WriteLine("\n\n\nPress enter to close...");
            Console.ReadLine();
#endif

        }

        static void CANReadThreadFunc()
        {
            Console.WriteLine("Read Messages");
            int numMsgs = 1;
            IntPtr rxMsgs = Marshal.AllocHGlobal(Marshal.SizeOf(typeof(PassThruMsg)) * numMsgs);

            while (is_run)
            {
                status = passThru.PassThruReadMsgs(channelId, rxMsgs, ref numMsgs, 100);

                if (status != J2534Err.ERR_BUFFER_EMPTY && numMsgs > 0)
                {
                    foreach (PassThruMsg msg in rxMsgs.AsList<PassThruMsg>(numMsgs))
                    {
                        Console.WriteLine(msg.ToString());
                    }
                }

                // If we received data, we want to extract the data of interest.  I'm removing the reflection of the transmitted message.
                //if ((J2534Err.ERR_BUFFER_EMPTY == status || J2534Err.ERR_TIMEOUT == status) && numMsgs > 0)
                //{
                //    foreach (PassThruMsg msg in rxMsgs.AsList<PassThruMsg>(numMsgs))
                //    {
                //        Console.WriteLine(msg.ToString());
                //    }
                //}

            }

        }

        protected static void ExitHandler(object sender, ConsoleCancelEventArgs args)
        {
            Console.WriteLine("\n\rExit...", ConsoleColor.Red);
            is_run = false;

            Console.WriteLine("Disconnecting...");
            passThru.PassThruDisconnect(channelId);

            Console.WriteLine("Closing...");
            passThru.PassThruClose(deviceId);
        }
    }
}