汽车电子嵌入式编程车窗霍尔防产品夹源代码.rar

/* ** ################################################################### ** ** Project : ** Processor : ** Version : V1.0 ** Datasheet : ** Date/Time : 2016-11-22 ** Abstract : ** This module contains DRV ANTIPINCH code ** for selected on-chip peripherals. ** Contents : ** Function "" ** ... ** ** ################################################################### */ #include "drv_ap.h" #if _M_DRV_AP /* User declarations and definitions */ #if _M_DRV_AP_HALL_ERR bool SharedCapCntEn; bool SharedflgHallErr; bool SharedflgDualHallErr; t_int8 SharedCapCnt; //IC +1;IC -1 #endif #if _M_DRV_AP_HALL_DIR t_int8 SharedCapDir; //up -1;dn 1 t_int8 SharedCapDirBak; #endif #if _M_DRV_AP_HALL_COMPENS bool SharedflgHallCompens; #endif #if _M_DRV_AP_HALL_FIX bool flgHallReversedFix = false; #endif #if _M_DRV_AP_VOLTAGE_CORRECTION bool flgVoltageEdgeDn; #endif #if _M_DRV_AP_BUF #if AP_nBUF == 8 const t_uint16 cntApPeriodGrp[AP_nBUF][2] = { {1,5}, {2,6}, {3,7}, {4,0}, {5,1}, {6,2}, {7,3}, {0,4}, }; const t_uint16 cntApPreHiLoGrp[AP_nBUF] = { 4, 5, 6, 7, 0, 1, 2, 3, }; #endif #if AP_nBUF == 10 const t_uint16 cntApPeriodGrp[AP_nBUF][2] = { {1,6}, {2,7}, {3,8}, {4,9}, {5,0}, {6,1}, {7,2}, {8,3}, {9,4}, {0,5}, }; const t_uint16 cntApPreHiLoGrp[AP_nBUF] = { 5, 6, 7, 8, 9, 0, 1, 2, 3, 4, }; #endif #if AP_nBUF == 16 //4对绕组 const t_uint16 cntApPeriodGrp[AP_nBUF][2] = { {1,9}, {2,10}, {3,11}, {4,12}, {5,13}, {6,14}, {7,15}, {8,0}, {9,1}, {10,2}, {11,3}, {12,4}, {13,5}, {14,6}, {15,7}, {0,8}, }; const t_uint16 cntApPreHiLoGrp[AP_nBUF] = { 8, 9, 10, 11, 12, 13, 14, 15, 0, 1, 2, 3, 4, 5, 6, 7, }; #endif #if AP_nBUF == 20 //5对绕组 const t_uint16 cntApPeriodGrp[AP_nBUF][2] = { {1,11}, {2,12}, {3,13}, {4,14}, {5,15}, {6,16}, {7,17}, {8,18}, {9,19}, {10,0}, {11,1}, {12,2}, {13,3}, {14,4}, {15,5}, {16,6}, {17,7}, {18,8}, {19,9}, {0,10}, }; const t_uint16 cntApPreHiLoGrp[AP_nBUF] = { 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, }; #endif #if AP_nBUF == 44 //hall 缓存容量 const t_uint16 cntApPeriodGrp[AP_nBUF][2] = { {1,23}, {2,24}, {3,25}, {4,26}, {5,27}, {6,28}, {7,29}, {8,30}, {9,31}, {10,32}, {11,33}, {12,34}, {13,35}, {14,36}, {15,37}, {16,38}, {17,39}, {18,40}, {19,41}, {20,42}, {21,43}, {22,0}, {23,1}, {24,2}, {25,3}, {26,4}, {27,5}, {28,6}, {29,7}, {30,8}, {31,9}, {32,10}, {33,11}, {34,12}, {35,13}, {36,14}, {37,15}, {38,16}, {39,17}, {40,18}, {41,19}, {42,20}, {43,21}, {0,22}, }; const t_uint16 cntApPreHiLoGrp[AP_nBUF] = { 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, }; #endif #endif #if _M_DRV_AP_ALGO_SOFT const t_uint16 ApAlgoSoftLvlRate[AP_ALGO_AP_LVL_TOTAL][AP_ALGO_SOFT_LVL_TOTAL] = { { AP_ALGO_AP_0_SOFT_LVL_0_RATE, AP_ALGO_AP_0_SOFT_LVL_1_RATE, AP_ALGO_AP_0_SOFT_LVL_2_RATE, AP_ALGO_AP_0_SOFT_LVL_3_RATE }, { AP_ALGO_AP_1_SOFT_LVL_0_RATE, AP_ALGO_AP_1_SOFT_LVL_1_RATE, AP_ALGO_AP_1_SOFT_LVL_2_RATE, AP_ALGO_AP_1_SOFT_LVL_3_RATE }, { AP_ALGO_AP_2_SOFT_LVL_0_RATE, AP_ALGO_AP_2_SOFT_LVL_1_RATE, AP_ALGO_AP_2_SOFT_LVL_2_RATE, AP_ALGO_AP_2_SOFT_LVL_3_RATE }, { AP_ALGO_AP_3_SOFT_LVL_0_RATE, AP_ALGO_AP_3_SOFT_LVL_1_RATE, AP_ALGO_AP_3_SOFT_LVL_2_RATE, AP_ALGO_AP_3_SOFT_LVL_3_RATE }, { AP_ALGO_AP_4_SOFT_LVL_0_RATE, AP_ALGO_AP_4_SOFT_LVL_1_RATE, AP_ALGO_AP_4_SOFT_LVL_2_RATE, AP_ALGO_AP_4_SOFT_LVL_3_RATE }, { AP_ALGO_AP_5_SOFT_LVL_0_RATE, AP_ALGO_AP_5_SOFT_LVL_1_RATE, AP_ALGO_AP_5_SOFT_LVL_2_RATE, AP_ALGO_AP_5_SOFT_LVL_3_RATE }, { AP_ALGO_AP_6_SOFT_LVL_0_RATE, AP_ALGO_AP_6_SOFT_LVL_1_RATE, AP_ALGO_AP_6_SOFT_LVL_2_RATE, AP_ALGO_AP_6_SOFT_LVL_3_RATE }, }; const t_uint16 ApAlgoSoftLvlCnt[AP_ALGO_SOFT_LVL_TOTAL] = { AP_ALGO_SOFT_LVL_0_CNT, AP_ALGO_SOFT_LVL_1_CNT, AP_ALGO_SOFT_LVL_2_CNT, AP_ALGO_SOFT_LVL_3_CNT, }; #endif /* Code, declarations and definitions here will be preserved during code generation */ #if _M_DRV_AP_ALGO_HALL inline bool HallAp_Algo(t_timer *T, t_uint16 n, t_uint16 curHi) { #if _M_TEST_9 t_uint32 tmp1,tmp2,tmp3; #endif if ((ALGO_HALL_K/(*(T+MOD(n-M0,T_LEN_MAX)))-ALGO_HALL_K/curHi) >= F) { #if _M_TEST_10 if (GetMCU_GPIOxO_PIN(0,7)) { ClrMCU_GPIOxO_PIN(0,7); } else { SetMCU_GPIOxO_PIN(0,7); } #endif return true; } #if VEHICLE_TYPE == A33 if ((ALGO_HALL_K/(*(T+MOD(n-M0,T_LEN_MAX)))-ALGO_HALL_K/(*(T+n))) >= A && (ALGO_HALL_K/(*(T+MOD(n-M0-M1,T_LEN_MAX)))-ALGO_HALL_K/(*(T+MOD(n-M1,T_LEN_MAX)))) >= B && (ALGO_HALL_K/(*(T+MOD(n-M0-M2,T_LEN_MAX)))-ALGO_HALL_K/(*(T+MOD(n-M2,T_LEN_MAX)))) >= C) #endif #if VEHICLE_TYPE == FY33 if ((ALGO_HALL_K/(*(T+MOD(n-M0,T_LEN_MAX)))-ALGO_HALL_K/(*(T+n))) >= A && (ALGO_HALL_K/(*(T+MOD(n-M0-M1,T_LEN_MAX)))-ALGO_HALL_K/(*(T+MOD(n-M1,T_LEN_MAX)))) >= B) #endif #if (VEHICLE_TYPE == TYPE_A || VEHICLE_TYPE == TYPE_1) if ((ALGO_HALL_K/(*(T+MOD(n-M0,T_LEN_MAX)))-ALGO_HALL_K/curHi) >= A && (ALGO_HALL_K/(*(T+MOD(n-M3,T_LEN_MAX)))-ALGO_HALL_K/curHi) >= B) #endif { #if _M_TEST_9 tmp1 = ALGO_HALL_K/(*(T+MOD(n-M0,T_LEN_MAX))); tmp2 = ALGO_HALL_K/curHi; tmp3 = tmp1-tmp2; if (GetMCU_GPIOxO_PIN(0,7)) { ClrMCU_GPIOxO_PIN(0,7); } else { SetMCU_GPIOxO_PIN(0,7); } #endif return true; } return false; } #endif #if _M_DRV_AP_HALL_DIR inline bool ChkstHallHiLoHi(st_ap *pAp) { if (stHallHiLo == 1) { return true; } else { return false; } } inline bool ChkstHallHiLoLo(st_ap *pAp) { if (stHallHiLo == -1) { return true; } else { return false; } } inline t_bool ChkIC1lLo(st_ap *pAp) { if (stApRx == AP_RX_STAT_UP_FST || stApRx == AP_RX_STAT_UP) //chk lo { return true; } return false; } inline t_bool ChkIC1lHi(st_ap *pAp) { if (stApRx == AP_RX_STAT_DN_FST || stApRx == AP_RX_STAT_DN) //chk hi { return true; } return false; } inline void GetSetSharedCapDirUp(st_ap *pAp) //IC1上升沿方向判定,pAp代表IC2 { #if _M_DRV_AP_HALL_FIX if(!flgHallReversedFix) { #endif if(ChkstHallHiLoHi(pAp)) { SetSharedCapDir(-1); } else if(ChkstHallHiLoLo(pAp)) { SetSharedCapDir(1); } else { SetSharedCapDir(0); } #if _M_DRV_AP_HALL_FIX } else { if(ChkstHallHiLoHi(pAp)) { SetSharedCapDir(1); } else if(ChkstHallHiLoLo(pAp)) { SetSharedCapDir(-1); } else { SetSha