Exemple #1
0
 public TrackingStateManager(CommsServer commsServer, NMEAGPSClient.NMEAGPSClient gpsClient)
 {
     mCommsServer = commsServer;
     mNMEAClient  = gpsClient;
     mNMEAClient.RaiseGPSPositionChangedEvent += this.OnGPSPositionChangedEventHandler;
     mNMEAClient.RaiseGPSStatusChangedEvent   += this.OnGPSStateChangedEventHandler;
     // set the initial position
     // initialise the timer
     mTimer = new Timer(new TimerCallback(OnTimedEvent), null, TrackingService.MovingRate * 1000, TrackingService.MovingRate * 1000);
 }
Exemple #2
0
        private void InitialiseCommsServer()
        {
            CommsServer commsServer = new CommsServer(mCommsAddress, mRTTServer, mTxPort, mRxPort);

            if (mCommsServer == null)
            {
                mCommsServer = commsServer;
            }
            else
            {
                Interlocked.Exchange <CommsServer>(ref mCommsServer, commsServer);
            }
            //mCommsServer.Start();
            StartListeningToCommsServer();
            mCommsServer.Start();
        }
Exemple #3
0
        protected void OnDatagramReceivedEventHandler(object sender, DatagramReceivedEventArgs a)
        {
            CANFrame frame = new CANFrame();

            if (a.Datagram.Length < 4)
            {
                ServerMsgLog.WarnFormat("UDP out-of-range, length {0}", a.Datagram.Length);
                return;
            }

            uint msgId = 0;

            try
            {
                // work out what it all meens
                // first assume that the datgram is a CNX CAN message
                if (BitConverter.IsLittleEndian)
                {
                    Array.Reverse(a.Datagram, 0, 4);
                }
                msgId = BitConverter.ToUInt32(a.Datagram, 0);

                switch (msgId)
                {
                case (uint)CNXMsgIds.TripProgress:
                    frame.MailboxId = msgId;
                    frame.DataFromArray(a.Datagram, 4, a.Datagram.Length - 4);
                    TripProgressType msgType;
                    int pathId;
                    int position;
                    int?tripNo;
                    CNXCANMsgHelper.UnpackTripProgress(frame, out msgType, out pathId, out position, out tripNo);
                    object[] args = { msgType, pathId, position, tripNo };
                    ServerMsgLog.WarnFormat("UDP Trip Progress {0}, RouteTag {1}, Progress {2}, tripNo {3}.", args);
                    mCANClient.Send(frame);
                    break;

                case (uint)CNXMsgIds.DeviceCatalogue:
                    ServerMsgLog.WarnFormat("UDP Re-Cataloge message (0x101).");
                    // clear our catalogue
                    mCANServer.ClearDeviceCatalogue();
                    // put our self into the new catalogue
                    AddSelfToCatalogue();
                    // reset catalogues on all equipment.
                    frame.ClearData();
                    frame.MailboxId = (uint)CANLib.CNXMsgIds.DeviceCatalogue;
                    mCANClient.Send(frame);
                    mCANClient.Send(CNXCANMsgHelper.PackIdentifiers(mCommsServer.CommsAddress, mCommsServer.CompanyTag));
                    break;

                case (uint)CNXMsgIds.TripNone:
                case (uint)CNXMsgIds.TripOffRoute:
                    frame.MailboxId = msgId;
                    mCANClient.Send(frame);
                    ServerMsgLog.WarnFormat("UDP {0}.", (CNXMsgIds)msgId);
                    break;

                case (uint)CNXMsgIds.TripOnRoute:
                    frame.MailboxId = msgId;
                    frame.DataFromArray(a.Datagram, 4, a.Datagram.Length - 4);
                    ServerMsgLog.WarnFormat("UDP {0}.", frame.ToString());
                    mCANClient.Send(frame);
                    break;

                case (uint)RTTMesg.RTTInMsgIds.FirmwareBuildNos:
                    ServerMsgLog.WarnFormat("UDP firmware version (0x1001) length {0}\n{1}.", a.Datagram.Length, CommsServer.HexDump(a.Datagram, a.Datagram.Length));
                    if (a.Datagram.Length > 5)
                    {
                        StartFirmwareManagement(a.Datagram, 4);
                    }
                    break;

                case (uint)RTTMesg.RTTInMsgIds.ResourceBuildNos:
                    ServerMsgLog.WarnFormat("UDP configuration message (0x1002) length {0}\n{1}.", a.Datagram.Length, CommsServer.HexDump(a.Datagram, a.Datagram.Length));
                    if (a.Datagram.Length > 5)
                    {
                        byte[] versions = new byte[a.Datagram.Length - 4];
                        Array.Copy(a.Datagram, 4, versions, 0, versions.Length);
                        StartDeviceConfigurationManagement(versions);
                    }
                    break;

                case (uint)RTTMesg.RTTInMsgIds.CompanyTag:
                    mCommsServer.CompanyTag = a.Datagram[4];
                    ServerMsgLog.WarnFormat("UDP CompanyTag {0}", mCommsServer.CompanyTag);
                    mCANClient.Send(CNXCANMsgHelper.PackIdentifiers(mCommsServer.CommsAddress, mCommsServer.CompanyTag));
                    break;

                case (uint)RTTMesg.RTTInMsgIds.DriverLogonOK:
                    ServerMsgLog.WarnFormat("UDP {0}.", (RTTMesg.RTTInMsgIds)msgId);
                    frame.MailboxId = (uint)CNXMsgIds.LogonResult;
                    frame.Data      = new byte[1];
                    frame.Data[0]   = (byte)LogonState.LogonOK;
                    mCANClient.Send(frame);
                    break;

                case (uint)RTTMesg.RTTInMsgIds.DriverLogonFail:
                    ServerMsgLog.WarnFormat("UDP {0}.", (RTTMesg.RTTInMsgIds)msgId);
                    frame.MailboxId = (uint)CNXMsgIds.LogonResult;
                    frame.Data      = new byte[1];
                    frame.Data[0]   = (byte)LogonState.LogonFailed;
                    mCANClient.Send(frame);
                    break;

                case (uint)RTTMesg.RTTInMsgIds.DriverLogoff:
                    ServerMsgLog.WarnFormat("UDP {0}.", (RTTMesg.RTTInMsgIds)msgId);
                    BeginSendTransientBlock(Block.DriverLogon, new byte[] { 0 });
                    break;

                case (uint)RTTMesg.RTTInMsgIds.DriverMesg2:
                    ServerMsgLog.WarnFormat("UDP {0}\n{1}.", (RTTMesg.RTTInMsgIds)msgId, CommsServer.HexDump(a.Datagram, a.Datagram.Length));
                    //TransientBlock block = new TransientBlock(mCANClient, (byte)Block.MessageToDriver);
                    byte[] blockData = new byte[a.Datagram.Length - 4];
                    Array.Copy(a.Datagram, 4, blockData, 0, blockData.Length);
                    //block.Send(blockData, false);
                    BeginSendTransientBlock(Block.MessageToDriver, blockData);
                    break;

                case (uint)RTTMesg.RTTInMsgIds.VehicleInfo:
                    mCommsServer.CompanyTag = a.Datagram[4];
                    mCommsServer.VehicleId  = Encoding.ASCII.GetString(a.Datagram, 5, a.Datagram.Length - 5);
                    ServerMsgLog.WarnFormat("UDP VehicleInfo {0} {1}", mCommsServer.CompanyTag, mCommsServer.VehicleId);
                    mCANClient.Send(CNXCANMsgHelper.PackIdentifiers(mCommsServer.CommsAddress, mCommsServer.CompanyTag));
                    break;

                case (uint)RTTMesg.RTTInMsgIds.FlushData:
                    ServerMsgLog.WarnFormat("UDP Flush APC");
                    frame.MailboxId = (uint)CNXMsgIds.ResetLoading;
                    frame.DataFromArray(a.Datagram, 4, a.Datagram.Length - 4);
                    mApc.FrameReceivedEventHandler(null, new FrameReceivedEventArgs(frame));
                    mCANClient.Send(frame);
                    // force daily restart as requested by Iris
                    //if (mTracker.mIris != null)
                    //	mTracker.mIris.Restart();
                    break;

                default:
                    ServerMsgLog.WarnFormat("UDP Unknown id {0} length {1}\n{2}.", msgId, a.Datagram.Length, CommsServer.HexDump(a.Datagram, a.Datagram.Length));
                    break;
                }
            }
            catch (Exception e)
            {
                ServerMsgLog.ErrorFormat("Datagram {0} Handler Error : {1}", msgId, e.ToString());
            }
        }