code.c 8.47 KB
Newer Older
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

#include "code.h"
static _st_Init FaultCodeInit;
static uint16_t u16FaultCodeDtcCount = 0;
static uint16_t u16FaultCodeDtcCountBack = 0;
static uint16_t u16FaultCodeDtcCounttemp = 0;
static _st_FaultCode stFaultCode[MaxFaultCode] = {0};
static _st_FaultCode stFaultCodeBack[MaxFaultCode] = {0};
static _st_FaultCode stFaultCodetemp[MaxFaultCode] = {0};
static uint8_t u8FaultCodeValid = 0;
uint32_t Get_FaultCodeDtc1(void)
{
    uint32_t u16FaultCode = 0x0000;
    uint8_t DTCH1 = 0;
    uint8_t DTCM1 = 0;

    uint32_t DTC1 = 0;

    DTCH1 = Get_CAN_CH0_ID_402_Sig_ECU_DTCH1();
    DTCM1 = Get_CAN_CH0_ID_402_Sig_ECU_DTCM1();

    if (((DTCH1 & 0xF0) >> 4) >= 0xA)
    {
        DTC1 |= ((DTCH1 & 0xF0) >> 4) + 3;
    }
    else
    {
        DTC1 |= (DTCH1 & 0xF0) >> 4;
    }
    DTC1 <<= 8;
    if ((DTCH1 & 0xF) >= 0xA)
    {
        DTC1 |= (DTCH1 & 0xF) + 3;
    }
    else
    {
        DTC1 |= DTCH1 & 0xF;
    }
    DTC1 <<= 8;

    if (((DTCM1 & 0xF0) >> 4) >= 0xA)
    {
        DTC1 |= ((DTCM1 & 0xF0) >> 4) + 3;
    }
    else
    {
        DTC1 |= (DTCM1 & 0xF0) >> 4;
    }
    DTC1 <<= 8;
    if ((DTCM1 & 0xF) >= 0xA)
    {
        DTC1 |= (DTCM1 & 0xF) + 3;
    }
    else
    {
        DTC1 |= DTCM1 & 0xF;
    }

    if (DTC1 == 0)
    {
        return 0XFFFF;
    }

    u16FaultCode = DTC1;

    return u16FaultCode;
}

uint32_t Get_FaultCodeDtc2(void)
{
    uint32_t u16FaultCode = 0x0000;
    uint8_t DTCH2 = 0;
    uint8_t DTCM2 = 0;
    uint32_t DTC2 = 0;

    DTCH2 = Get_CAN_CH0_ID_402_Sig_ECU_DTCH2();
    DTCM2 = Get_CAN_CH0_ID_402_Sig_ECU_DTCM2();
    if (((DTCH2 & 0xF0) >> 4) >= 0xA)
    {
        DTC2 |= ((DTCH2 & 0xF0) >> 4) + 3;
    }
    else
    {
        DTC2 |= (DTCH2 & 0xF0) >> 4;
    }
    DTC2 <<= 8;
    if ((DTCH2 & 0xF) >= 0xA)
    {
        DTC2 |= (DTCH2 & 0xF) + 3;
    }
    else
    {
        DTC2 |= DTCH2 & 0xF;
    }
    DTC2 <<= 8;

    if (((DTCM2 & 0xF0) >> 4) >= 0xA)
    {
        DTC2 |= ((DTCM2 & 0xF0) >> 4) + 3;
    }
    else
    {
        DTC2 |= (DTCM2 & 0xF0) >> 4;
    }
    DTC2 <<= 8;
    if ((DTCM2 & 0xF) >= 0xA)
    {
        DTC2 |= (DTCM2 & 0xF) + 3;
    }
    else
    {
        DTC2 |= DTCM2 & 0xF;
    }

    if (DTC2 == 0)
    {
        return 0XFFFF;
    }

    u16FaultCode = DTC2;

    return u16FaultCode;
}

uint16_t Get_FaultCodeNum(void)
{
    uint16_t u16FaultCode = 0x0000;

    u16FaultCode = Get_CAN_CH0_ID_402_Sig_ECU_DTCAmnt();
    return u16FaultCode;
}

uint16_t Get_FaultCodeValid(void)
{
    return 1;
}

/**
 * @brief 故障码初始化函数
 */
void FaultCode_Init(void)
{
    uint16_t i = 0;
    for (i = 0; i < MaxFaultCode; i++)
    {
        stFaultCode[i].u16FaultCode = 0;
        stFaultCode[i].u16FaultCodeCount = 0;
        stFaultCodeBack[i].u16FaultCode = 0;
        stFaultCodeBack[i].u16FaultCodeCount = 0;
        stFaultCodetemp[i].u16FaultCode = 0;
        stFaultCodetemp[i].u16FaultCodeCount = 0;
    }

154 155 156
    FaultCodeInit.callbacks[DTC_1] = Get_FaultCodeDtc1;
    FaultCodeInit.callbacks[DTC_2] = Get_FaultCodeDtc2;
    FaultCodeInit.callbacks[DTC_3] = NULL;
157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229
    FaultCodeInit.FaultCodeVaildCbk = Get_FaultCodeValid;
    FaultCodeInit.FaultCodeNumCbk = Get_FaultCodeNum;

    u16FaultCodeDtcCountBack = 0;
    u8FaultCodeValid = 0;
}

/**
 * @brief 查询当前故障码是否存在
 * @param u32FaultCode 故障码
 * @param FaultCodeGrpup 故障码组
 * @param len 故障码组长度
 * @return 0:存在 1:不存在 2:无效故障码不存储
 */
uint8_t FaultCode_Check(const uint32_t u32FaultCode, const _st_FaultCode *FaultCodeGrpup, const uint16_t len)
{
    uint16_t i = 0;
    uint8_t Result = 1;

    if ((u32FaultCode == 0XFFFF) || (u32FaultCode == 0))
    {
        return 2;
    }

    if (len == 1)
    {
        return 1;
    }

    for (i = 0; i < len; i++)
    {
        if (u32FaultCode == FaultCodeGrpup[i].u16FaultCode)
        {
            Result = 0;
            return Result;
        }
    }

    return Result;
}

/**
 * 添加新的故障码到故障码数组中。
 * @param faultCodes 指向故障码数组的指针。
 * @param count 指向当前已添加故障码数量的指针。
 * @param faultCode 要添加的故障码。
 * @param len 实际故障码数量,用于检测数组中是否存在当前故障码
 * @note 如果故障码数组已满或者新的故障码已存在,则不添加。
 */
void AddNewFaultCode(_st_FaultCode *faultCodes, uint16_t *count, uint32_t faultCode, uint16_t len)
{
    if (*count >= MaxFaultCode || FaultCode_Check(faultCode, faultCodes, len) != 1)
    {
        return; // 数组已满或故障码已存在,不进行添加
    }
    faultCodes[*count].u16FaultCode = faultCode;
    (*count)++;
}

/**
 * @brief 故障码服务函数
 * @param Cycle 建议10ms调用 防止故障码数量过多 接收缓慢
 */
void FaultCode_Service(uint16_t Cycle)
{
    uint32_t Dtc1 = 0XFFFF;
    uint32_t Dtc2 = 0XFFFF;
    uint32_t Dtc3 = 0XFFFF;
    uint16_t FaultCodeSum = 0;
    uint16_t i = 0;
    uint32_t tempFaultCode = 0;
    uint16_t Vaild = 0;

230
    if (FaultCodeInit.callbacks[DTC_1] != NULL)
231
    {
232
        Dtc1 = FaultCodeInit.callbacks[DTC_1]();
233 234
    }

235
    if (FaultCodeInit.callbacks[DTC_2] != NULL)
236
    {
237
        Dtc2 = FaultCodeInit.callbacks[DTC_2]();
238 239
    }

240
    if (FaultCodeInit.callbacks[DTC_3] != NULL)
241
    {
242
        Dtc3 = FaultCodeInit.callbacks[DTC_3]();
243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348
    }

    if (FaultCodeInit.FaultCodeVaildCbk != NULL)
    {
        Vaild = FaultCodeInit.FaultCodeVaildCbk();
    }

    if (FaultCodeInit.FaultCodeNumCbk != NULL)
    {
        FaultCodeSum = FaultCodeInit.FaultCodeNumCbk();
    }

    if (FaultCodeSum > MaxFaultCode)
    {
        FaultCodeSum = MaxFaultCode;
    }

    if ((Vaild) && (FaultCodeSum > 0))
    {
        if (u16FaultCodeDtcCountBack < FaultCodeSum) /* 当前存储故障码是否小于实际故障码数量 */
        {
            /* 存储故障码并检查数组中是否存在 */
            AddNewFaultCode(stFaultCodeBack, &u16FaultCodeDtcCountBack, Dtc1, FaultCodeSum);
            AddNewFaultCode(stFaultCodeBack, &u16FaultCodeDtcCountBack, Dtc2, FaultCodeSum);
        }

        /* 接收故障码大于0后进行显示 */
        if (u16FaultCodeDtcCountBack > 0)
        {
            /* 当前存储故障码等于实际故障码数量 用于实时更新故障码*/
            if (u16FaultCodeDtcCountBack == FaultCodeSum)
            {
                u16FaultCodeDtcCountBack = 0;
            }
            /* 更新故障码显示 */
            for (i = 0; i < FaultCodeSum; i++)
            {
                if (stFaultCodetemp[i].u16FaultCode != stFaultCodeBack[i].u16FaultCode)
                {
                    stFaultCodetemp[i].u16FaultCode = stFaultCodeBack[i].u16FaultCode;
                    stFaultCode[i].u16FaultCode = stFaultCodetemp[i].u16FaultCode;
                }
            }
            u8FaultCodeValid = 1;

            /* 大于故障码数量的数组进行清0处理 */
            for (i = FaultCodeSum; i < MaxFaultCode; i++)
            {
                stFaultCode[i].u16FaultCode = 0;
                stFaultCodetemp[i].u16FaultCode = 0;
                stFaultCodeBack[i].u16FaultCode = 0;
            }
        }

        if (stFaultCode[0].u16FaultCode != 0XFFFF)
        {
            /* 故障码计时 */
            if (stFaultCode[0].u16FaultCodeCount < FaultCodeCount)
            {
                stFaultCode[0].u16FaultCodeCount += Cycle;
            }
            else
            {
                /* 计时结束 更新位置 */
                stFaultCode[0].u16FaultCodeCount = 0;
                tempFaultCode = stFaultCode[0].u16FaultCode;

                if (FaultCodeSum > 1)
                {
                    for (i = 0; i < FaultCodeSum - 1; i++)
                    {
                        stFaultCode[i].u16FaultCode = stFaultCode[i + 1].u16FaultCode;
                    }
                    stFaultCode[FaultCodeSum - 1].u16FaultCode = tempFaultCode;
                }
            }
        }
    }
    else
    {
        u8FaultCodeValid = 0;
        for (i = 0; i < MaxFaultCode; i++)
        {
            stFaultCode[i].u16FaultCode = 0;
            stFaultCode[i].u16FaultCodeCount = 0;
            stFaultCodeBack[i].u16FaultCode = 0;
            stFaultCodeBack[i].u16FaultCodeCount = 0;
            stFaultCodetemp[i].u16FaultCode = 0;
            stFaultCodetemp[i].u16FaultCodeCount = 0;
        }
        u16FaultCodeDtcCountBack = 0;
    }
}

/**
 * @brief 获取当前故障码
 */
uint32_t Get_Current_FaultCode(void)
{
    return stFaultCode[0].u16FaultCode;
}

uint8_t Get_FaultCode_Valid(void)
{
    return u8FaultCodeValid;
}