UDS_10Service_Main.c 4.67 KB
Newer Older
hu's avatar
hu committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142
#include "UDS_10Service_Main.h"

/**
  *10服务函数入口
  *@param A_TA_type 收到数据的地址
  *@param A_Length 收到数据的长度
  *@param A_Data 收到数据的数据
  */
void UDS_Service_10_Indication(uint32_t A_TA_type, uint16_t A_Length, uint8_t A_Data[])
{
    uint8_t NRC = positiveResponse;
    setDiagMSG(A_TA_type, A_Length, A_Data);
    if(NRC == positiveResponse)
    {
        NRC = UDS_10Service_NRC7F();                                              /*10服务会话是否支持验证*/
    }    
    if(NRC == positiveResponse)
    {
        NRC = UDS_10Service_Sub_NRC13_MinLengthCheck();                          /*10服务最小长度验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_10Service_Sub_NRC12();                                         /*10服务子功能是否支持验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_10Service_Sub_NRC7E();                                         /*10服务子功能会话是否支持验证*/
    }    
    if(NRC == positiveResponse)
    {
        NRC = UDS_10Service_Sub_NRC13_TotalLengthCheck();                       /*10服务子功能总长度长度验证*/
    }
    if(NRC == positiveResponse)
    {
    NRC = UDS_10Service_NRC33();                                                /*10服务解锁等级验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_10Service_Sub_NRC22();                                        /*10服务子功能条件验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_10Service_Sub_NRC24();                                        /*10服务子功能请求顺序验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_10Service_Sub_NRC31();                                        /*10服务子功能超出请求范围验证*/
    }
    if(NRC == positiveResponse)
    {
        UDS_10Service_Sub();                                              /*10服务子功能超出请求范围验证*/
    }
    clearDiagMSG();                                                             /*清除诊断信息*/
}

/**
  *10服务子功能
  */
void UDS_10Service_Sub(void)
{
    
   
        switch(DiagMSG.msgData.SidDetail.SubID)                                 /*子服务判断*/
        {
        case DefaultSession:
            UDS_10Service_Sub01();                                              /*10服务01子功能*/
            break;
        case ProgrammingSession:
            UDS_10Service_Sub02();                                              /*10服务02子功能*/
            break;
        case ExtendedDiagnosticSession:
            UDS_10Service_Sub03();                                              /*10服务03子功能*/
            break;
        default:
            break;
        }
   
}

/**
  *10服务01子功能
  */
void UDS_10Service_Sub01(void)
{
    UDS_10Service_S27Init();
    UDS_10Service_S28Init();
    UDS_10Service_S2FInit();
    UDS_10Service_S85Init();
    setSessionType(DefaultSession);
    
    if(DiagMSG.msgData.SidDetail.PositiveSuppression == 0u)
    {
        DiagMSG.msgData.SidDetail.Data[0] = (uint8_t)((P2_SERVER & (uint16_t) 0xFF00) >> 8);
        DiagMSG.msgData.SidDetail.Data[1] = (uint8_t)(P2_SERVER & (uint16_t) 0x00FF);
        DiagMSG.msgData.SidDetail.Data[2] = (uint8_t)((P2_AST_SERVER & (uint16_t) 0xFF00) >> 8);
        DiagMSG.msgData.SidDetail.Data[3] = (uint8_t)(P2_AST_SERVER & (uint16_t) 0x00FF);
        UDS_Service_Response(0x10u, POSITIVE_RSP, DIAG_ID_Tx, 5u, DiagMSG.msgData.Data);
    }
}

/**
  *10服务02子功能
  */
void UDS_10Service_Sub02(void)
{
    setSessionType(ProgrammingSession);
    if(DiagMSG.msgData.SidDetail.PositiveSuppression == 0u)
    {        
        UDS_NRC78_Sand(0x10u);
        WriteJumpBootStatusToDFlash(JumpToBoot02);
        UDS_RESET();       
    }
    else
    {
        WriteJumpBootStatusToDFlash(JumpToBoot82);
        UDS_RESET();
    }
}

/**
  *10服务03子功能
  */
void UDS_10Service_Sub03(void)
{
    UDS_10Service_S27Init();
    if(getSessionType() == DefaultSession)
    {
        UDS_10Service_S28Init();
        UDS_10Service_S2FInit();
        UDS_10Service_S85Init();
        setSessionType(ExtendedDiagnosticSession);
    }
    
    if(DiagMSG.msgData.SidDetail.PositiveSuppression == 0u)
    {
        DiagMSG.msgData.SidDetail.Data[0] = (uint8_t)((P2_SERVER & (uint16_t) 0xFF00) >> 8);
        DiagMSG.msgData.SidDetail.Data[1] = (uint8_t)(P2_SERVER & (uint16_t) 0x00FF);
        DiagMSG.msgData.SidDetail.Data[2] = (uint8_t)((P2_AST_SERVER & (uint16_t) 0xFF00) >> 8);
        DiagMSG.msgData.SidDetail.Data[3] = (uint8_t)(P2_AST_SERVER & (uint16_t) 0x00FF);
        UDS_Service_Response(0x10u, POSITIVE_RSP, DIAG_ID_Tx, 5u, DiagMSG.msgData.Data);
    }
}