UDS_31Service_Main.c 5.01 KB
Newer Older
时昊's avatar
时昊 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 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164
#include "UDS_31Service_Main.h"

/**
  *31服务函数入口
  *@param A_TA_type 收到数据的地址
  *@param A_Length 收到数据的长度
  *@param A_Data 收到数据的数据
  */
void UDS_Service_31_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_31Service_NRC11();                                            /*31服务是否支持功能寻址*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_NRC7F();                                            /*31服务会话是否支持验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_NRC33();                                            /*31服务解锁等级验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_NRC13_MinLengthCheck();                             /*31服务最小长度验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_NRC31();                                            /*31服务超出请求范围验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_NRC13_TotalLengthCheck();                           /*31服务总长度长度验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_NRC22();                                            /*31服务条件验证*/
    }
    if(NRC == positiveResponse)
    {
        UDS_31Service_Sub();                                                    /*31服务子功能判断*/
    }
    clearDiagMSG();                                                             /*清除诊断信息*/
}

/**
  *31服务子功能
  */
void UDS_31Service_Sub(void)
{
    uint8_t NRC = positiveResponse;
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_Sub_NRC13_MinLengthCheck();                         /*31服务子功能最小长度验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_Sub_NRC12();                                        /*31服务子功能是否支持验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_Sub_NRC7E();                                        /*31服务子功能会话是否支持验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_Sub_NRC31();                                        /*31服务子功能超出请求范围验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_Sub_NRC13_TotalLengthCheck();                       /*31服务子功能总长度长度验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_Sub_NRC24();                                        /*31服务子功能请求顺序验证*/
    }
    if(NRC == positiveResponse)
    {
        NRC = UDS_31Service_Sub_NRC22();                                        /*31服务子功能条件验证*/
    }
    if(NRC == positiveResponse)
    {
        switch(DiagMSG.msgData.SidDetail.SubID)                                 /*子服务判断*/
        {
        case startRoutine:
            UDS_31Service_Sub01();                                              /*31服务01子功能*/
            break;
        case stopRoutine:
            UDS_31Service_Sub02();                                              /*31服务02子功能*/
            break;
        case requestRoutineResults:
            UDS_31Service_Sub03();                                              /*31服务03子功能*/
            break;
        default:
            break;
        }
    }
}

/**
  *31服务01子功能
  */
void UDS_31Service_Sub01(void)
{
    switch(getDID(DiagMSG.msgData.S31Detail.DID_H, DiagMSG.msgData.S31Detail.DID_L))/*31服务DID判断*/
    {
    case 0x0203:
        UDS_31Service_Sub01_DID_0203();                         /*检查编程预调件*/
    break;
    default:
        break;
    }
}

/**
  *31服务02子功能
  */
void UDS_31Service_Sub02(void)
{
    switch(getDID(DiagMSG.msgData.S31Detail.DID_H, DiagMSG.msgData.S31Detail.DID_L))/*31服务DID判断*/
    {
    case 0x62F3:
        //UDS_31Service_Sub02_DID_62F3();                         /*更新GPU*/
        break;
    default:
        break;
    }
}

/**
  *31服务03子功能
  */
void UDS_31Service_Sub03(void)
{
    switch(getDID(DiagMSG.msgData.S31Detail.DID_H, DiagMSG.msgData.S31Detail.DID_L))/*31服务DID判断*/
    {
    case 0x62F3:
        //UDS_31Service_Sub03_DID_62F3();                         /*更新GPU*/
        break;
    default:
        break;
    }
}

/**
  *31服务01子功能DID0203
  检查编程预条件
  */
void UDS_31Service_Sub01_DID_0203(void)
{
    if(getSpeed() > 30)
    {
        S31DID0203RequestFlag = 0;
        DiagMSG.msgData.S31Detail.Data[0] = 0x01u;
        UDS_Service_Response(0x31u, POSITIVE_RSP, DIAG_ID_Tx, 4u, DiagMSG.msgData.Data);
    }
    else
    {
        S31DID0203RequestFlag = 1;
        DiagMSG.msgData.S31Detail.Data[0] = 0x00u;
        UDS_Service_Response(0x31u, POSITIVE_RSP, DIAG_ID_Tx, 4u, DiagMSG.msgData.Data);
    }
}