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