/// <summary> /// This method send a request for reading a symbol. /// </summary> /// <param name="a_address">The symbol number to read [0..0xFFFF-1].</param> /// <returns></returns> public bool setSymbolRequest(uint a_symbolNumber) { LogDataString("setSymbolRequest"); KWPReply reply = new KWPReply(); KWPResult result = KWPResult.Timeout; byte[] symbolNumber = new byte[5]; //First two bytes should be zero symbolNumber[0] = 0; symbolNumber[1] = 0; symbolNumber[2] = 0x80; //set symbol number (byte 2 to 3); symbolNumber[3] = (byte)(a_symbolNumber >> 8); symbolNumber[4] = (byte)(a_symbolNumber); //<GS-11022010> // check result .. it should be 2 bytes long int _retryCount = 0; while (_retryCount++ < 3 && result != KWPResult.OK) { //result = sendRequest(new KWPRequest(0x2C, 0xF0, 0x03, symbolNumber), out reply); result = sendRequest(new KWPRequest(0x2C, 0xF0, 0x03, symbolNumber), out reply/*, 2*/); if (reply.getLength() != 2) { result = KWPResult.Timeout; LogDataString("Got wrong response on sendRequest in setSymbolRequest, len = " + reply.getLength().ToString("D2")); Console.WriteLine("Got wrong response on sendRequest in setSymbolRequest, len = " + reply.getLength().ToString("D2")); } } if (result == KWPResult.OK) { return true; } else { LogDataString("setSymbolRequest timed out"); Console.WriteLine("setSymbolRequest timed out"); return false; } }
/// <summary> /// This method sends a KWPRequest and returns a KWPReply. /// </summary> /// <param name="a_request">The request.</param> /// <param name="a_reply">The reply.</param> /// <returns>KWPResult</returns> private KWPResult sendRequest(KWPRequest a_request, out KWPReply a_reply, int expectedLength) { int _maxSendRetries = 3; KWPResult _kwpResult = KWPResult.Timeout; LogDataString("sendRequest"); KWPReply reply = new KWPReply(); RequestResult result; a_reply = new KWPReply(); //<GS-11012010> was allemaal 1000 int keepAliveTimeout = 1000; //Console.WriteLine("Checking KWP device open"); if (!m_kwpDevice.isOpen()) return KWPResult.DeviceNotConnected; // reset the timer for keep alive (set to 1 seconds now) if (stateTimer == null) stateTimer = new System.Threading.Timer(sendKeepAlive, new Object(), keepAliveTimeout, keepAliveTimeout); stateTimer.Change(keepAliveTimeout, keepAliveTimeout); m_requestMutex.WaitOne(); int _retryCount = 0; result = RequestResult.Unknown; // <GS-11022010> while (_retryCount < _maxSendRetries && result != RequestResult.NoError) { LogDataString(a_request.ToString()); result = m_kwpDevice.sendRequest(a_request, out reply); if ((int)reply.getLength() != expectedLength) { result = RequestResult.InvalidLength; } if (result == RequestResult.NoError) { a_reply = reply; LogDataString(reply.ToString()); LogDataString(""); // empty line m_requestMutex.ReleaseMutex(); //return KWPResult.OK; _kwpResult = KWPResult.OK; } else { LogDataString("Timeout in KWPHandler::sendRequest"); m_requestMutex.ReleaseMutex(); //return KWPResult.Timeout; _kwpResult = KWPResult.Timeout; } } return _kwpResult; }