PEAK-System Forum

Code: Select all

// Set basic address info
AddressInfo = new TPUDSNetAddrInfo
{
	SA = (byte)TPUDSAddress.PUDS_ISO_15765_4_ADDR_TEST_EQUIPMENT,
	TA = (byte)TPUDSAddress.PUDS_ISO_15765_4_ADDR_ECU_1,
	TA_TYPE = TPUDSAddressingType.PUDS_ADDRESSING_PHYSICAL,
	RA = 0x00,
	PROTOCOL = TPUDSProtocol.PUDS_PROTOCOL_ISO_15765_2_11B
};

// Initialize connection
status = UDSApi.Initialize(Channel, (TPUDSBaudrate)BaudRate.Id);
if (IsError(status))
{
	Trace.TraceError("Initialization failed");
	return false;
}

// Set this device address
uint buffer = AddressInfo.TA;
status = UDSApi.SetValue(Channel, TPUDSParameter.PUDS_PARAM_SERVER_ADDRESS, ref buffer, 1);
if (IsError(status))
{
	Trace.TraceError("Can't set buffer");
	return false;
}

TPCANTPStatus s;
// Define ISO-TP communication from ECU to Client (physical responses)
s = CanTpApi.AddMapping(Channel, 0x780, 0x7E0,
		   TPCANTPIdType.PCANTP_ID_CAN_11BIT,
		   TPCANTPFormatType.PCANTP_FORMAT_NORMAL,
		   TPCANTPMessageType.PCANTP_MESSAGE_DIAGNOSTIC,
		   AddressInfo.SA, AddressInfo.TA,
		   TPCANTPAddressingType.PCANTP_ADDRESSING_PHYSICAL,
		   0x00);

// Define ISO-TP communication from Client to ECU (physical requests)
s = CanTpApi.AddMapping(Channel, 0x7E8, 0x781,
		TPCANTPIdType.PCANTP_ID_CAN_11BIT,
		TPCANTPFormatType.PCANTP_FORMAT_NORMAL,
		TPCANTPMessageType.PCANTP_MESSAGE_DIAGNOSTIC,
		AddressInfo.TA, AddressInfo.SA,
		TPCANTPAddressingType.PCANTP_ADDRESSING_PHYSICAL, 0x00);

Code: Select all

TPUDSStatus status;
TPUDSMsg message = new TPUDSMsg
{
	NETADDRINFO = connection.AddressInfo
};
TPUDSMsg messageResponse = new TPUDSMsg();
TPUDSMsg messageBuffer = new TPUDSMsg();

status = UDSApi.SvcDiagnosticSessionControl(connection.Channel, ref message, UDSApi.TPUDSSvcParamDSC.PUDS_SVC_PARAM_DSC_DS);
if (status == TPUDSStatus.PUDS_ERROR_OK)
	status = UDSApi.WaitForService(connection.Channel, out messageResponse, ref message, out messageBuffer);
connection.Error = status.ToString();

Code: Select all

// Set the PCAN-Channel to use (PCAN-USB Channel 1)
Channel = PUDS_USBBUS2;
// Initializing of the UDS Communication session 
Status = UDS_Initialize(Channel, PUDS_BAUD_500K, 0, 0, 0);
printf("Initialize UDS: %i\n", (int)Status);

// Define Address
iBuffer = PUDS_SERVER_ADDR_TEST_EQUIPMENT;
Status = UDS_SetValue(Channel, PUDS_PARAM_SERVER_ADDRESS, &iBuffer, 1);
printf("  Set ServerAddress: %i (0x%02x)\n", (int)Status, iBuffer);

TPCANTPStatus result;

// Define Network Address Information used for all the tests
N_AI.SA = PUDS_SERVER_ADDR_TEST_EQUIPMENT;
N_AI.TA = PUDS_ISO_15765_4_ADDR_ECU_1;
N_AI.TA_TYPE = PUDS_ADDRESSING_PHYSICAL;
N_AI.RA = 0x00;
N_AI.PROTOCOL = PUDS_PROTOCOL_ISO_15765_2_11B;

// Defines a first mapping to allow communication from App to ECU
result = CANTP_AddMapping(Channel, 0x7E0, 0x780, PCANTP_ID_CAN_11BIT,
	PCANTP_FORMAT_NORMAL, PCANTP_MESSAGE_DIAGNOSTIC, N_AI.SA, N_AI.TA,
	PCANTP_ADDRESSING_PHYSICAL, N_AI.RA);
printf("  set S -> D mapping: %i", (int)result);

// Defines a second mapping to allow communication from ECU to App
result = CANTP_AddMapping(Channel, 0x7E8, 0x781, PCANTP_ID_CAN_11BIT,
	PCANTP_FORMAT_NORMAL, PCANTP_MESSAGE_DIAGNOSTIC, N_AI.TA, N_AI.SA,
	PCANTP_ADDRESSING_PHYSICAL, N_AI.RA);
printf("  set D -> S mapping: %i", (int)result);

Code: Select all

TPCANTPStatus s;
// Sending from Client to ECU (ECU is listening to 0x780)
s = CanTpApi.AddMapping(Channel, 0x780, 0x781,
         TPCANTPIdType.PCANTP_ID_CAN_11BIT,
         TPCANTPFormatType.PCANTP_FORMAT_NORMAL,
         TPCANTPMessageType.PCANTP_MESSAGE_DIAGNOSTIC,
         AddressInfo.SA, AddressInfo.TA,
         TPCANTPAddressingType.PCANTP_ADDRESSING_PHYSICAL,
         0x00);

// Receiving from ECU (ECU is sending using 0x781)
s = CanTpApi.AddMapping(Channel, 0x781, 0x780,
      TPCANTPIdType.PCANTP_ID_CAN_11BIT,
      TPCANTPFormatType.PCANTP_FORMAT_NORMAL,
      TPCANTPMessageType.PCANTP_MESSAGE_DIAGNOSTIC,
      AddressInfo.TA, AddressInfo.SA,
      TPCANTPAddressingType.PCANTP_ADDRESSING_PHYSICAL, 0x00);