override public void handleMessage(CANMessage a_message)
{
if (_queue == null)
{
_queue = new CANMessage[16];
_receiveMessageIndex = 0;
_readMessageIndex = 0;
}
// add the message to a queue for later processing ...
// the queue is a ringbuffer for CANMessage objects.
// X objects are supported
// we need a receive and a read pointer for this to work properly
messageReceived = false;
//_queue[_receiveMessageIndex] = a_message;
_queue[_receiveMessageIndex] = new CANMessage();
_queue[_receiveMessageIndex].setData(a_message.getData());
_queue[_receiveMessageIndex].setID(a_message.getID());
_queue[_receiveMessageIndex].setLength(a_message.getLength());
_receiveMessageIndex++;
if (_receiveMessageIndex > _queue.Length - 1)
{
_receiveMessageIndex = 0; // make it circular
}
//DetermineSize();
/*
* lock (m_canMessage)
* {
* if (a_message.getID() == m_waitMsgID)
* {
* m_canMessage = a_message;
* messageReceived = true;
* }
* }
* if (messageReceived)
* {
* m_resetEvent.Set();
* }*/
}
public override void handleMessage(CANMessage a_message)
{
if (_queue == null)
{
_queue = new CANMessage[16];
_receiveMessageIndex = 0;
_readMessageIndex = 0;
}
// add the message to a queue for later processing ...
// the queue is a ringbuffer for CANMessage objects.
// X objects are supported
// we need a receive and a read pointer for this to work properly
messageReceived = false;
//_queue[_receiveMessageIndex] = a_message;
_queue[_receiveMessageIndex] = new CANMessage();
_queue[_receiveMessageIndex].setData(a_message.getData());
_queue[_receiveMessageIndex].setID(a_message.getID());
_queue[_receiveMessageIndex].setLength(a_message.getLength());
_receiveMessageIndex++;
if(_receiveMessageIndex > _queue.Length - 1) _receiveMessageIndex = 0; // make it circular
//DetermineSize();
/*
lock (m_canMessage)
{
if (a_message.getID() == m_waitMsgID)
{
m_canMessage = a_message;
messageReceived = true;
}
}
if (messageReceived)
{
m_resetEvent.Set();
}*/
}
public override bool sendMessage(CANMessage a_message)
{
string sendString = " ";
for (uint i = 0; i < a_message.getLength(); i++) // leave out the length field, the ELM chip assigns that for us
{
//if (i <= 7)
{
sendString += a_message.getCanData(i).ToString("X2");
}
/*else
* {
* sendString += "00"; // fill with zeros
* }*/
}
sendString += "\r";
if (m_serialPort.IsOpen)
{
m_serialPort.Write(sendString);
//Console.WriteLine("TX: " + sendString);
}
// bitrate = 38400bps -> 3840 bytes per second
// sending each byte will take 0.2 ms approx
Thread.Sleep(a_message.getLength()); // sleep length ms
// Thread.Sleep(10);
//receiveString = "49 01 01 00 00 00 31 \n\r49 02 02 44 34 47 50 \n\r49 02 03 30 30 52 35 \n\r49 02 04 25 42";// m_serialPort.ReadTo(">");
/*receiveString = m_serialPort.ReadTo(">");
* char[] chrArray = receiveString.ToCharArray();
* byte[] reply = new byte[0xFF];
* int insertPos = 1;
* int index = 0;
* string subString = "";
* while (receiveString.Length > 4)
* {
*
* //Remove first three bytes
*
* //TODO. Remove Mode and PIDs
* for (int i = 0; i < 3; i++)
* {
* index = receiveString.IndexOf(" ");
* receiveString = receiveString.Remove(0, index + 1);
* }
* //Read data for the rest of the row.
* for (int i = 0; i < 4; i++)
* {
* index = receiveString.IndexOf(" ");
* if (index == 0) //Last row not 4 bytes of data.
* {
* continue;
* }
* subString = receiveString.Substring(0, index);
* reply[insertPos] = (byte)Convert.ToInt16("0x" + subString, 16);
* insertPos++;
* receiveString = receiveString.Remove(0, index + 1);
* }
*
* }
*
* reply[0] = (byte)insertPos; //Length
*
* r_reply = new KWPReply(reply, a_request.getNrOfPID());
* return RequestResult.NoError;*/
return(true); // remove after implementation
}
public override bool sendMessage(CANMessage a_message)
{
string sendString = " ";
for (uint i = 0; i < a_message.getLength(); i++) // leave out the length field, the ELM chip assigns that for us
{
//if (i <= 7)
{
sendString += a_message.getCanData(i).ToString("X2");
}
/*else
{
sendString += "00"; // fill with zeros
}*/
}
sendString += "\r";
if (m_serialPort.IsOpen)
{
m_serialPort.Write(sendString);
//Console.WriteLine("TX: " + sendString);
}
// bitrate = 38400bps -> 3840 bytes per second
// sending each byte will take 0.2 ms approx
Thread.Sleep(a_message.getLength()); // sleep length ms
// Thread.Sleep(10);
//receiveString = "49 01 01 00 00 00 31 \n\r49 02 02 44 34 47 50 \n\r49 02 03 30 30 52 35 \n\r49 02 04 25 42";// m_serialPort.ReadTo(">");
/*receiveString = m_serialPort.ReadTo(">");
char[] chrArray = receiveString.ToCharArray();
byte[] reply = new byte[0xFF];
int insertPos = 1;
int index = 0;
string subString = "";
while (receiveString.Length > 4)
{
//Remove first three bytes
//TODO. Remove Mode and PIDs
for (int i = 0; i < 3; i++)
{
index = receiveString.IndexOf(" ");
receiveString = receiveString.Remove(0, index + 1);
}
//Read data for the rest of the row.
for (int i = 0; i < 4; i++)
{
index = receiveString.IndexOf(" ");
if (index == 0) //Last row not 4 bytes of data.
{
continue;
}
subString = receiveString.Substring(0, index);
reply[insertPos] = (byte)Convert.ToInt16("0x" + subString, 16);
insertPos++;
receiveString = receiveString.Remove(0, index + 1);
}
}
reply[0] = (byte)insertPos; //Length
r_reply = new KWPReply(reply, a_request.getNrOfPID());
return RequestResult.NoError;*/
return true; // remove after implementation
}
/*private void AddToCanTrace(string line)
{
if (m_EnableCanLog)
{
DateTime dtnow = DateTime.Now;
using (StreamWriter sw = new StreamWriter(System.Windows.Forms.Application.StartupPath + "\\CanTraceCANUSBDevice.txt", true))
{
sw.WriteLine(dtnow.ToString("dd/MM/yyyy HH:mm:ss") + " - " + line);
}
}
}*/
/// <summary>
/// sendMessage send a CANMessage.
/// </summary>
/// <param name="a_message">A CANMessage.</param>
/// <returns>true on success, othewise false.</returns>
public override bool sendMessage(CANMessage a_message)
{
LAWICEL.CANMsg msg = new LAWICEL.CANMsg();
msg.id = a_message.getID();
msg.len = a_message.getLength();
msg.flags = a_message.getFlags();
msg.flags = LAWICEL.CANMSG_EXTENDED; // Test for now
msg.data = a_message.getData();
int writeResult;
//AddToCanTrace("Sending message");
AddToCanTrace("TX: " + msg.id.ToString("X6") + " " + msg.data.ToString("X16"));
writeResult = LAWICEL.canusb_Write(m_deviceHandle, ref msg);
if (writeResult == LAWICEL.ERROR_CANUSB_OK)
{
//AddToCanTrace("Message sent successfully");
txCount++;
bitsPerSecond += 109;
return true;
}
else
{
errCount++;
switch (writeResult)
{
case LAWICEL.ERROR_CANUSB_COMMAND_SUBSYSTEM:
AddToCanTrace("Message failed to send: ERROR_CANUSB_COMMAND_SUBSYSTEM");
break;
case LAWICEL.ERROR_CANUSB_INVALID_PARAM:
AddToCanTrace("Message failed to send: ERROR_CANUSB_INVALID_PARAM");
break;
case LAWICEL.ERROR_CANUSB_NO_MESSAGE:
AddToCanTrace("Message failed to send: ERROR_CANUSB_NO_MESSAGE");
break;
case LAWICEL.ERROR_CANUSB_NOT_OPEN:
AddToCanTrace("Message failed to send: ERROR_CANUSB_NOT_OPEN");
break;
case LAWICEL.ERROR_CANUSB_OPEN_SUBSYSTEM:
AddToCanTrace("Message failed to send: ERROR_CANUSB_OPEN_SUBSYSTEM");
break;
case LAWICEL.ERROR_CANUSB_TX_FIFO_FULL:
AddToCanTrace("Message failed to send: ERROR_CANUSB_TX_FIFO_FULL");
break;
default:
AddToCanTrace("Message failed to send: " + writeResult.ToString());
break;
}
return false;
}
}
//-------------------------------------------------------------------------
//-------------------------------------------------------------------------
/**
Sends a 11 bit CAN data frame.
@param msg CAN message
@return success (true/false)
*/
public override bool sendMessage(CANMessage msg)
{
//Console.WriteLine("TX: " + msg.getID().ToString("X4") + " " + msg.getData().ToString("X16"));
this.AddToCanTrace("Sending message: " + msg.getID().ToString("X4") + " " + msg.getData().ToString("X16") + " " + msg.getLength().ToString("X2"));
try
{
Combi.caCombiAdapter.caCANFrame frame;
frame.id = msg.getID();
frame.length = msg.getLength();
frame.data = msg.getData();
frame.is_extended = 0;
frame.is_remote = 0;
this.combi.CAN_SendMessage(ref frame);
this.AddToCanTrace("Message sent successfully");
return true;
}
catch (Exception e)
{
this.AddToCanTrace("Message failed to send: " + e.Message);
return false;
}
}
