690 lines
24 KiB
C
690 lines
24 KiB
C
/******************************************************************************
|
||
*
|
||
* Freescale Semiconductor Inc.
|
||
* (c) Copyright 2008-2015 Freescale Semiconductor, Inc.
|
||
* ALL RIGHTS RESERVED.
|
||
*
|
||
******************************************************************************/
|
||
/**************************************************************************//**
|
||
* @addtogroup diagnostic_group
|
||
* @{
|
||
******************************************************************************/
|
||
/**************************************************************************//**
|
||
*
|
||
* @file lin_diagnostic_service.c
|
||
*
|
||
* @author FPT Software
|
||
*
|
||
* @brief Diagnostic Service slave functions
|
||
*
|
||
******************************************************************************/
|
||
/******************************************************************************
|
||
*
|
||
* History:
|
||
*
|
||
* 20090718 v1.0 First version
|
||
* 20111005 v1.1 Updated diagnostics service
|
||
*
|
||
*****************************************************************************/
|
||
|
||
#include "lin_commontl_proto.h"
|
||
#include "lin_diagnostic_service.h"
|
||
|
||
/* Define functionality */
|
||
#ifndef MULTI_PDU_SUPPORT
|
||
#define MULTI_PDU_SUPPORT 0 /**< multi PDU support */
|
||
#endif /* End MULTI_PDU_SUPPORT */
|
||
|
||
/********------------- Code supports SINGLE interface ----------------**********/
|
||
#if LIN_MODE == _SLAVE_MODE_
|
||
/*************************** FUNCTIONS *******************/
|
||
/* Unuse for GPIO */
|
||
#if ( _LIN_GPIO_ == 0 ) && !defined(_MC9S08SC4_H) && !defined(MCU_SKEAZN84)
|
||
#if LIN_PROTOCOL == PROTOCOL_21
|
||
|
||
void lin_diagservice_assign_frame_id()
|
||
{
|
||
l_u16 supid, msg_id,pid,current_id;
|
||
lin_tl_pdu_data *lin_tl_pdu;
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
l_u16 length;
|
||
l_u8 data[10];
|
||
/* get pdu from rx queue */
|
||
ld_receive_message(&length, data+2);
|
||
lin_tl_pdu = (lin_tl_pdu_data *)data;
|
||
#else /* Single frame support */
|
||
lin_tl_pdu = tl_current_rx_pdu_ptr;
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
supid = (l_u16)(((*lin_tl_pdu)[4]) << 8);
|
||
supid = supid |(l_u16)((*lin_tl_pdu)[3]);
|
||
//product_id.supplier_id = supid;
|
||
|
||
msg_id = (l_u16)(((*lin_tl_pdu)[6]) << 8);
|
||
msg_id = msg_id |(l_u16)((*lin_tl_pdu)[5]);
|
||
//product_id.function_id = fid;
|
||
|
||
pid = (*lin_tl_pdu)[7];
|
||
current_id = lin_process_parity(pid,CHECK_PARITY);
|
||
|
||
if(supid==0x0B00 || supid==0x7FFF){//iav测试台架发的spid与软件定义spid，高位低位相反，目前直接写死
|
||
if(msg_id==0x5001){
|
||
lin_configuration_RAM[1]= current_id;
|
||
lin_tl_make_slaveres_pdu(SERVICE_ASSIGN_FRAME_ID, POSITIVE, 0);
|
||
}
|
||
else if(msg_id==0x5000){
|
||
lin_configuration_RAM[2]= current_id;
|
||
lin_tl_make_slaveres_pdu(SERVICE_ASSIGN_FRAME_ID, POSITIVE, 0);
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
void lin_diagservice_assign_frame_id_range()
|
||
{
|
||
l_u8 start_index;
|
||
l_s8 j, i = 7;
|
||
lin_tl_pdu_data *lin_tl_pdu;
|
||
/* Multi frame support */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
l_u16 length;
|
||
l_u8 data[10];
|
||
/* get pdu from rx queue */
|
||
ld_receive_message(&length, data+2);
|
||
lin_tl_pdu = (lin_tl_pdu_data *)data;
|
||
#else /* Single frame support */
|
||
lin_tl_pdu = tl_current_rx_pdu_ptr;
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
/* Get start index in request */
|
||
start_index = (*lin_tl_pdu)[3];
|
||
|
||
// for (i = 7, j = start_index+4; j > start_index; i--, j-- )
|
||
// {
|
||
// if ((0xFF != (*lin_tl_pdu)[i]) && (j > LIN_CFG_FRAME_NUM))
|
||
// {
|
||
// lin_tl_make_slaveres_pdu(SERVICE_ASSIGN_FRAME_ID_RANGE, NEGATIVE, GENERAL_REJECT);
|
||
// return;
|
||
// }
|
||
// }
|
||
|
||
// /* Store PIDs */
|
||
// for (i = 4, j = start_index + 1; i < 8; i++, j++)
|
||
// {
|
||
// switch ((*lin_tl_pdu)[i])
|
||
// {
|
||
// case 0x00:
|
||
// /* Unassign frame */
|
||
// lin_configuration_RAM[j] = 0xFF;
|
||
// break;
|
||
|
||
// case 0xFF:
|
||
// /* keep the previous assigned value of this frame */
|
||
// break;
|
||
|
||
// default:
|
||
// /* Calculate frame ID & Assign ID to frame */
|
||
// lin_configuration_RAM[j] = lin_process_parity((*lin_tl_pdu)[i], CHECK_PARITY);
|
||
// break;
|
||
// }
|
||
// } /* End of for statement */
|
||
|
||
lin_tl_make_slaveres_pdu(SERVICE_ASSIGN_FRAME_ID_RANGE, POSITIVE, 0);
|
||
}
|
||
|
||
void lin_diagservice_read_by_identifier()
|
||
{
|
||
l_u8 id;
|
||
l_u16 supid, fid;
|
||
lin_tl_pdu_data *lin_tl_pdu;
|
||
|
||
/* Multi frame support */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
l_u16 length;
|
||
l_u8 data[10];
|
||
/* get pdu from rx queue */
|
||
ld_receive_message(&length, data+2);
|
||
lin_tl_pdu = (lin_tl_pdu_data *)data;
|
||
#else /* Single frame support */
|
||
lin_tl_pdu = tl_current_rx_pdu_ptr;
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
|
||
//20200801:ȫ<><C8AB><EFBFBD>ظ<EFBFBD><D8B8><EFBFBD><EFBFBD><EFBFBD>Ӧ
|
||
//lin_tl_make_slaveres_pdu(SERVICE_READ_BY_IDENTIFY, POSITIVE, 0);
|
||
//return;
|
||
|
||
/* Get supplier and function indentification in request */
|
||
supid = (l_u16)(((*lin_tl_pdu)[5]) << 8);
|
||
supid = supid |(l_u16)((*lin_tl_pdu)[4]);
|
||
|
||
fid = (l_u16)(((*lin_tl_pdu)[7]) << 8);
|
||
fid = fid |(l_u16)((*lin_tl_pdu)[6]);
|
||
|
||
|
||
// /* Check Supplier ID and Function ID */
|
||
// if (((supid != product_id.supplier_id) && (supid != LD_ANY_SUPPLIER)) || \
|
||
// ((fid != product_id.function_id) && (fid != LD_ANY_FUNCTION)))
|
||
// {
|
||
// tl_slaveresp_cnt = 0;
|
||
// #if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
// tl_service_status = LD_SERVICE_IDLE;
|
||
// #endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
// return;
|
||
// }
|
||
id = (*lin_tl_pdu)[3];
|
||
|
||
switch (id)
|
||
{
|
||
case LIN_PRODUCT_IDENT:
|
||
if((supid==0x0B00 || supid==0x7FFF) && (fid==product_id.function_id || fid==0xFFFF))//iav测试台架发的spid与软件定义spid，高位低位相反，目前直接写死
|
||
{
|
||
lin_tl_make_slaveres_pdu(SERVICE_READ_BY_IDENTIFY, POSITIVE, 0);
|
||
}
|
||
break;
|
||
case SERIAL_NUMBER:
|
||
lin_tl_make_slaveres_pdu(SERVICE_READ_BY_IDENTIFY, POSITIVE, 1);
|
||
break;
|
||
default:
|
||
if (id >= LIN_READ_USR_DEF_MIN && id <= LIN_READ_USR_DEF_MAX)
|
||
{
|
||
lin_tl_make_slaveres_pdu(SERVICE_READ_BY_IDENTIFY, POSITIVE, id);
|
||
break;
|
||
//<2F><>֪<EFBFBD><D6AA>ΪʲôҪ<C3B4><D2AA><EFBFBD><EFBFBD>
|
||
// l_u8 data_callout[5] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
|
||
// l_u8 i;
|
||
// l_u8 retval = ld_read_by_id_callout(id, data_callout);
|
||
// /*If the User ID is supported, make positive response*/
|
||
// if (retval == LD_POSITIVE_RESPONSE)
|
||
// {
|
||
// for (i =0; i <5; i++)
|
||
// {
|
||
// if (data_callout[i] != 0xFF)
|
||
// {
|
||
// lin_tl_make_slaveres_pdu(SERVICE_READ_BY_IDENTIFY, POSITIVE, id);
|
||
// break;
|
||
// }
|
||
// /* If all data_callout is 0xFF, then make negative response*/
|
||
// if (i == 4)
|
||
// {
|
||
// /* Make a negative slave response PDU */
|
||
// lin_tl_make_slaveres_pdu(SERVICE_READ_BY_IDENTIFY, NEGATIVE, SUBFUNCTION_NOT_SUPPORTED);
|
||
// }
|
||
|
||
// }
|
||
// }
|
||
// else if (retval == LD_NEGATIVE_RESPONSE)
|
||
// /*If the User ID is not supported, make negative response*/
|
||
// {
|
||
// /* Make a negative slave response PDU */
|
||
// lin_tl_make_slaveres_pdu(SERVICE_READ_BY_IDENTIFY, NEGATIVE, SUBFUNCTION_NOT_SUPPORTED);
|
||
// }
|
||
// else if (retval == LD_ID_NO_RESPONSE)
|
||
// {
|
||
// /*Do not answer*/
|
||
// tl_slaveresp_cnt = 0;
|
||
// #if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
// tl_service_status = LD_SERVICE_IDLE;
|
||
// #endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
// }
|
||
|
||
}
|
||
else
|
||
{
|
||
/* Make a negative slave response PDU */
|
||
lin_tl_make_slaveres_pdu(SERVICE_READ_BY_IDENTIFY, NEGATIVE, SUBFUNCTION_NOT_SUPPORTED);
|
||
}
|
||
break;
|
||
} /* End of switch */
|
||
}
|
||
|
||
void lin_condittional_change_nad()
|
||
{
|
||
l_u8 id, byte, mask, invert;
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
id = lin_tl_rx_queue.tl_pdu[lin_tl_rx_queue.queue_header][3];
|
||
byte = lin_tl_rx_queue.tl_pdu[lin_tl_rx_queue.queue_header][4];
|
||
mask = lin_tl_rx_queue.tl_pdu[lin_tl_rx_queue.queue_header][5];
|
||
invert = lin_tl_rx_queue.tl_pdu[lin_tl_rx_queue.queue_header][6];
|
||
#else /* Single frame support */
|
||
id = (*tl_current_rx_pdu_ptr)[3];
|
||
byte = (*tl_current_rx_pdu_ptr)[4];
|
||
mask = (*tl_current_rx_pdu_ptr)[5];
|
||
invert = (*tl_current_rx_pdu_ptr)[6];
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
|
||
/* Possible positive ID */
|
||
if (id == 0)
|
||
{
|
||
if(byte>0 && byte<6)
|
||
{
|
||
/*Byte 1: Supplier ID LSB; Byte 2: Supplier ID MSB*/
|
||
if(byte>0 && byte<3)
|
||
{
|
||
byte = product_id.supplier_id >> ((byte-1)*8);
|
||
}
|
||
/*Byte 3: Function ID LSB; Byte 4: Function ID MSB*/
|
||
else if(byte>2 && byte<5)
|
||
{
|
||
byte = product_id.function_id >> ((byte-3)*8);
|
||
}
|
||
/* Byte 5: Variant */
|
||
else
|
||
{
|
||
byte = product_id.variant;
|
||
}
|
||
/* Do a bitwise XOR with Invert and Do a bitwise AND with Mask */
|
||
byte = (byte^invert)&mask;
|
||
/* If the final result is zero, then give positive response*/
|
||
if (byte == 0)
|
||
{
|
||
lin_tl_make_slaveres_pdu(SERVICE_CONDITIONAL_CHANGE_NAD, POSITIVE, 0);
|
||
/* If the final result is zero then change the NAD to New NAD */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
lin_configured_NAD = lin_tl_rx_queue.tl_pdu[lin_tl_rx_queue.queue_header][7];
|
||
#else/* Single frame support */
|
||
lin_configured_NAD = (*tl_current_rx_pdu_ptr)[7];
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
}
|
||
}
|
||
}
|
||
}
|
||
|
||
#endif /* End (LIN_PROTOCOL == PROTOCOL_21) */
|
||
#endif /* End ( _LIN_GPIO_ == 0 ) && !defined(_MC9S08SC4_H) */
|
||
|
||
|
||
#if LIN_PROTOCOL == PROTOCOL_21
|
||
/* Multi frame support */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
void lin_diagsrv_functional_service(void)
|
||
{
|
||
l_u16 length;
|
||
l_u8 data[10];
|
||
/* get pdu from rx queue */
|
||
ld_receive_message(&length, data);
|
||
|
||
/* do something here */
|
||
}
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
#endif /* End (LIN_PROTOCOL == PROTOCOL_21) */
|
||
|
||
#if LIN_PROTOCOL == PROTOCOL_J2602
|
||
void lin_diagservice_target_reset()
|
||
{
|
||
l_u8 *signal_data_ptr;
|
||
l_u8 nad;
|
||
lin_tl_pdu_data *lin_tl_pdu;
|
||
/* Multi frame support */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
lin_tl_pdu = (lin_tl_pdu_data *)&lin_lld_response_buffer[1];
|
||
#else /* Single frame support */
|
||
lin_tl_pdu = tl_current_rx_pdu_ptr;
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
/* Set the reset flag within the J2602 Status Byte */
|
||
/* Set error signal equal to error in response */
|
||
lin_pFrameBuf[response_error_byte_offset] = (lin_pFrameBuf[response_error_byte_offset] &
|
||
(~(0x07 << response_error_bit_offset))) |
|
||
(0x01 << response_error_bit_offset);
|
||
|
||
/* Create positive response */
|
||
|
||
/* Get NAD of node */
|
||
nad = (*lin_tl_pdu)[0];
|
||
|
||
if (LD_BROADCAST != nad)
|
||
{
|
||
lin_tl_make_slaveres_pdu(SERVICE_TARGET_RESET, POSITIVE, 0);
|
||
}
|
||
else
|
||
{
|
||
tl_slaveresp_cnt = 0;
|
||
}
|
||
}
|
||
#endif /* End (LIN_PROTOCOL == PROTOCOL_J2602) */
|
||
|
||
#endif /* End (LIN_MODE == _SLAVE_MODE_) */
|
||
/********------------ End of code for SINGLE Interface --------------**********/
|
||
|
||
|
||
/********------------- Code supports Multi interface ----------------**********/
|
||
#if LIN_MODE == _MASTER_MODE_
|
||
/*************************** FUNCTIONS *******************/
|
||
|
||
|
||
#if LIN_PROTOCOL == PROTOCOL_21
|
||
|
||
void lin_diagservice_assign_frame_id_range
|
||
(
|
||
/* [IN] interface name */
|
||
l_ifc_handle iii
|
||
)
|
||
{
|
||
const lin_configuration* conf;
|
||
l_s8 j, i = 0;
|
||
l_u8 start_index;
|
||
l_u8 cfg_frame_num = 0;
|
||
lin_tl_pdu_data *lin_tl_pdu;
|
||
/* Multi frame support */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
l_u16 length;
|
||
l_u8 NAD, data[10];
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
/* Get current configuration */
|
||
conf = &lin_ifc_configuration[iii];
|
||
/* Do actions only for slave nodes */
|
||
if (conf->function == _SLAVE_)
|
||
{
|
||
/* Multi frame support */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
/* receive message data */
|
||
ld_receive_message(iii, &length, &NAD, data+2);
|
||
|
||
lin_tl_pdu = (lin_tl_pdu_data *)data;
|
||
#else /* Single frame support */
|
||
/* Get current PDU pointer of RX queue */
|
||
lin_tl_pdu = (lin_tl_pdu_data *)&conf->response_buffer[1];
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
|
||
/* Get start index in request */
|
||
start_index = (*lin_tl_pdu)[3];
|
||
|
||
/* Find the number of configurable frame */
|
||
i = 1;
|
||
while (0xFFFF != (conf->configuration_ROM)[i])
|
||
{
|
||
i++;
|
||
cfg_frame_num++;
|
||
}
|
||
/* Check request validity */
|
||
for (i = 7, j = start_index+4; j > start_index; i--, j-- )
|
||
{
|
||
if ((0xFF != (*lin_tl_pdu)[i]) && (j > cfg_frame_num))
|
||
{
|
||
lin_tl_make_slaveres_pdu(iii, SERVICE_ASSIGN_FRAME_ID_RANGE, NEGATIVE, GENERAL_REJECT);
|
||
return;
|
||
}
|
||
}
|
||
|
||
/* Store PIDs */
|
||
for (i = 4, j = 1; i < 8; i++, j++)
|
||
{
|
||
switch ((*lin_tl_pdu)[i])
|
||
{
|
||
case 0x00:
|
||
/* Unassign frame */
|
||
(conf->configuration_RAM)[start_index + j] = 0xFF;
|
||
break;
|
||
|
||
case 0xFF:
|
||
/* keep the previous assigned value of this frame */
|
||
break;
|
||
|
||
default:
|
||
/* Calculate frame ID and Assign ID to frame */
|
||
(conf->configuration_RAM)[start_index + j] = lin_process_parity((*lin_tl_pdu)[i], CHECK_PARITY);
|
||
break;
|
||
}
|
||
} /* End of for statement */
|
||
lin_tl_make_slaveres_pdu(iii, SERVICE_ASSIGN_FRAME_ID_RANGE, POSITIVE, 0);
|
||
}
|
||
}
|
||
|
||
|
||
void lin_diagservice_read_by_identifier
|
||
(
|
||
/* [IN] interface name */
|
||
l_ifc_handle iii
|
||
)
|
||
{
|
||
const lin_configuration* conf;
|
||
const lin_node_attribute* node_conf;
|
||
lin_product_id ident;
|
||
lin_tl_descriptor *tl_conf;
|
||
lin_tl_pdu_data *lin_tl_pdu;
|
||
l_u8 id;
|
||
l_u16 supid, fid;
|
||
/* Multi frame support */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
lin_tl_pdu_data pdu_data;
|
||
l_u16 length;
|
||
l_u8 NAD, data[10];
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
|
||
/* Get current configuration */
|
||
conf = &lin_ifc_configuration[iii];
|
||
|
||
/* Get TL description */
|
||
tl_conf = conf->tl_desc;
|
||
|
||
/* Do actions only for slave nodes */
|
||
if (conf->function == _SLAVE_)
|
||
{
|
||
/* Multi frame support */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
lin_tl_pdu = (lin_tl_pdu_data *)&pdu_data;
|
||
/* receive message data */
|
||
ld_receive_message(iii, &length, &NAD, data+2);
|
||
|
||
lin_tl_pdu = (lin_tl_pdu_data *)data;
|
||
#else /* Single frame support */
|
||
lin_tl_pdu = (lin_tl_pdu_data *)&conf->response_buffer[1];
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
|
||
/* Get the node attribute */
|
||
node_conf = conf->node_attribute;
|
||
|
||
/* Get the product identification */
|
||
ident = node_conf->product_id;
|
||
|
||
/* Get supplier and function indentification in request */
|
||
supid = (l_u16)(((*lin_tl_pdu)[5]) << 8);
|
||
supid = supid |(l_u16)((*lin_tl_pdu)[4]);
|
||
|
||
fid = (l_u16)(((*lin_tl_pdu)[7]) << 8);
|
||
fid = fid |(l_u16)((*lin_tl_pdu)[6]);
|
||
|
||
|
||
/* Check Supplier ID and Function ID */
|
||
if (((supid != ident.supplier_id) && (supid != LD_ANY_SUPPLIER)) || \
|
||
((fid != ident.function_id) && (fid != LD_ANY_FUNCTION)))
|
||
{
|
||
tl_conf->tl_slaveresp_cnt = 0;
|
||
return;
|
||
}
|
||
|
||
/* Get the identifier of request */
|
||
id = (*lin_tl_pdu)[3];
|
||
|
||
switch (id)
|
||
{
|
||
case LIN_PRODUCT_IDENT:
|
||
lin_tl_make_slaveres_pdu(iii, SERVICE_READ_BY_IDENTIFY, POSITIVE, 0);
|
||
break;
|
||
case SERIAL_NUMBER:
|
||
lin_tl_make_slaveres_pdu(iii, SERVICE_READ_BY_IDENTIFY, NEGATIVE, SUBFUNCTION_NOT_SUPPORTED);
|
||
break;
|
||
|
||
default:
|
||
if (id >= LIN_READ_USR_DEF_MIN && id <= LIN_READ_USR_DEF_MAX)
|
||
{
|
||
l_u8 data_callout[5] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
|
||
l_u8 i;
|
||
l_u8 retval = ld_read_by_id_callout(iii,id, data_callout);
|
||
/*If the User ID is supported, make positive response*/
|
||
if (retval == LD_POSITIVE_RESPONSE)
|
||
{
|
||
for (i =0; i <5; i++)
|
||
{
|
||
if (data_callout[i] != 0xFF)
|
||
{
|
||
lin_tl_make_slaveres_pdu(iii,SERVICE_READ_BY_IDENTIFY, POSITIVE, id);
|
||
break;
|
||
}
|
||
/* If all data_callout is 0xFF, then make negative response*/
|
||
if (i == 4)
|
||
{
|
||
/* Make a negative slave response PDU */
|
||
lin_tl_make_slaveres_pdu(iii,SERVICE_READ_BY_IDENTIFY, NEGATIVE, SUBFUNCTION_NOT_SUPPORTED);
|
||
}
|
||
|
||
}
|
||
}
|
||
else if (retval == LD_NEGATIVE_RESPONSE)
|
||
/*If the User ID is not supported, make negative response*/
|
||
{
|
||
/* Make a negative slave response PDU */
|
||
lin_tl_make_slaveres_pdu(iii,SERVICE_READ_BY_IDENTIFY, NEGATIVE, SUBFUNCTION_NOT_SUPPORTED);
|
||
}
|
||
else if (retval == LD_ID_NO_RESPONSE)
|
||
{
|
||
/*Do not answer*/
|
||
tl_conf->tl_slaveresp_cnt = 0;
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
*conf->tl_service_status = LD_SERVICE_IDLE;
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
}
|
||
}
|
||
else
|
||
{
|
||
/* Make a negative slave response PDU */
|
||
lin_tl_make_slaveres_pdu(iii, SERVICE_READ_BY_IDENTIFY, NEGATIVE, SUBFUNCTION_NOT_SUPPORTED);
|
||
}
|
||
break;
|
||
} /* end of switch */
|
||
}
|
||
}
|
||
/*FUNCTION**********************************************************************
|
||
*
|
||
* Function Name : lin_condittional_change_nad
|
||
* Description :
|
||
*
|
||
*END**************************************************************************/
|
||
void lin_condittional_change_nad(l_ifc_handle iii)
|
||
{
|
||
l_u8 id, byte, mask, invert;
|
||
const lin_configuration* conf;
|
||
lin_node_attribute* node_conf;
|
||
lin_tl_descriptor *tl_conf;
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
lin_transport_layer_queue *rx_queue;
|
||
#else /* Single frame support */
|
||
lin_tl_pdu_data *lin_tl_pdu;
|
||
#endif
|
||
/* Get current configuration */
|
||
conf = &lin_ifc_configuration[iii];
|
||
|
||
/* Do actions only for slave nodes */
|
||
if (conf->function == _SLAVE_)
|
||
{
|
||
/* Get TL description */
|
||
tl_conf = conf->tl_desc;
|
||
/* Get the node attribute */
|
||
node_conf = conf->node_attribute;
|
||
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
/* Get receive queue */
|
||
rx_queue = tl_conf->tl_rx_queue;
|
||
id = rx_queue->tl_pdu[rx_queue->queue_header][3];
|
||
byte = rx_queue->tl_pdu[rx_queue->queue_header][4];
|
||
mask = rx_queue->tl_pdu[rx_queue->queue_header][5];
|
||
invert = rx_queue->tl_pdu[rx_queue->queue_header][6];
|
||
#else /* Single frame support */
|
||
/* Get current PDU pointer of RX buffer */
|
||
lin_tl_pdu = tl_conf->tl_current_rx_pdu_ptr;
|
||
id = (*lin_tl_pdu)[3];
|
||
byte = (*lin_tl_pdu)[4];
|
||
mask = (*lin_tl_pdu)[5];
|
||
invert = (*lin_tl_pdu)[6];
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
|
||
/* Possible positive ID */
|
||
/* Support only identifier 0 for LIN Product Identification */
|
||
if (id == 0)
|
||
{
|
||
if(byte>0 && byte<6)
|
||
{
|
||
/*Byte 1: Supplier ID LSB; Byte 2: Supplier ID MSB*/
|
||
if(byte>0 && byte<3)
|
||
{
|
||
byte = (node_conf->product_id).supplier_id >> ((byte-1)*8);
|
||
}
|
||
/*Byte 3: Function ID LSB; Byte 4: Function ID MSB*/
|
||
else if(byte>2 && byte<5)
|
||
{
|
||
byte = (node_conf->product_id).function_id >> ((byte-3)*8);
|
||
}
|
||
/* Byte 5: Variant */
|
||
else
|
||
{
|
||
byte = (node_conf->product_id).variant;
|
||
}
|
||
/* Do a bitwise XOR with Invert and Do a bitwise AND with Mask */
|
||
byte = (byte^invert)&mask;
|
||
/* If the final result is zero, then give positive response*/
|
||
if (byte == 0)
|
||
{
|
||
lin_tl_make_slaveres_pdu(iii,SERVICE_CONDITIONAL_CHANGE_NAD, POSITIVE, 0);
|
||
/* If the final result is zero then change the NAD to New NAD */
|
||
#if (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_)
|
||
node_conf->configured_NAD = rx_queue->tl_pdu[rx_queue->queue_header][7];
|
||
#else/* Single frame support */
|
||
node_conf->configured_NAD = (*lin_tl_pdu)[7];
|
||
#endif /* End (_TL_FRAME_SUPPORT_ == _TL_MULTI_FRAME_) */
|
||
}
|
||
}
|
||
}
|
||
}
|
||
}
|
||
#endif /* End (LIN_PROTOCOL == PROTOCOL_21) */
|
||
|
||
#if LIN_PROTOCOL == PROTOCOL_J2602
|
||
void lin_diagservice_target_reset
|
||
(
|
||
/* [IN] interface name */
|
||
l_ifc_handle iii
|
||
)
|
||
{
|
||
const lin_configuration *conf;
|
||
lin_tl_descriptor *tl_conf;
|
||
lin_tl_pdu_data *pdu;
|
||
l_u8 byte_offset_temp, bit_offset_temp;
|
||
l_u8 nad;
|
||
|
||
/* Get current configuration */
|
||
conf = &lin_ifc_configuration[iii];
|
||
|
||
/* Get TL configuration */
|
||
tl_conf = conf->tl_desc;
|
||
|
||
/* Get PDU from RX queue */
|
||
|
||
/* Get current PDU pointer of RX queue */
|
||
pdu = (lin_tl_pdu_data *)&conf->response_buffer[1];
|
||
|
||
/* Set the reset flag within the J2602 Status Byte */
|
||
byte_offset_temp = conf->node_attribute->response_error_byte_offset;
|
||
bit_offset_temp = conf->node_attribute->response_error_bit_offset;
|
||
|
||
/* Set error signal equal to error in response */
|
||
lin_pFrameBuf[byte_offset_temp] = (lin_pFrameBuf[byte_offset_temp] &
|
||
(~(0x07 << bit_offset_temp))) |
|
||
(0x01 << bit_offset_temp);
|
||
/* Create positive response */
|
||
|
||
/* Get NAD of node */
|
||
nad = (*pdu)[0];
|
||
|
||
if (LD_BROADCAST != nad)
|
||
{
|
||
lin_tl_make_slaveres_pdu(iii, SERVICE_TARGET_RESET, POSITIVE, 0);
|
||
}
|
||
else
|
||
{
|
||
tl_conf->tl_slaveresp_cnt = 0;
|
||
}
|
||
}
|
||
#endif /* End (LIN_PROTOCOL == PROTOCOL_J2602) */
|
||
#endif /* End (LIN_MODE == _MASTER_MODE_) */
|
||
/* ---------------- End of code for Multi Interface ----------------- */
|
||
/**
|
||
* @}
|
||
*/
|