#include "capture.h" #include "HD_ADC.h" /* 温度的adc值的个数 */ #define mosTemperADCLen 241 ///* 3.3V参考电压温度adc值 */ //const uint16_t mosTemperADC[mosTemperADCLen] = { // 3707, 3697, 3687, 3676, 3665, 3654, 3643, 3632, 3620, 3608, /* -20 - -15.5 ℃ */ // 3596, 3584, 3571, 3559, 3546, 3533, 3519, 3506, 3492, 3478, /* -15 - -10.5 ℃ */ // 3464, 3449, 3434, 3419, 3404, 3389, 3373, 3358, 3341, 3325, /* -10 - -5.5 ℃ */ // 3309, 3292, 3275, 3258, 3241, 3223, 3205, 3187, 3169, 3151, /* -5 - -0.5 ℃ */ // 3132, 3114, 3095, 3075, 3056, 3037, 3017, 2997, 2977, 2957, /* 0 - 4.5 ℃ */ // 2936, 2916, 2895, 2874, 2854, 2832, 2811, 2790, 2768, 2747, /* 9 - 9.5 ℃ */ // 2725, 2703, 2681, 2659, 2637, 2615, 2592, 2570, 2548, 2525, /* 10 - 14.5 ℃ */ // 2503, 2480, 2457, 2435, 2412, 2389, 2366, 2343, 2321, 2298, /* 15 - 19.5 ℃ */ // 2275, 2252, 2229, 2207, 2184, 2161, 2138, 2116, 2093, 2071, /* 20 - 24.5 ℃ */ // 2048, 2026, 2003, 1981, 1959, 1937, 1914, 1893, 1871, 1849, /* 25 - 29.5 ℃ */ // 1827, 1806, 1784, 1763, 1742, 1721, 1700, 1679, 1658, 1638, /* 30 - 34.5 ℃ */ // 1617, 1597, 1577, 1557, 1537, 1518, 1498, 1479, 1460, 1441, /* 35 - 39.5 ℃ */ // 1422, 1403, 1385, 1366, 1348, 1330, 1312, 1295, 1277, 1260, /* 40 - 44.5 ℃ */ // 1243, 1226, 1209, 1192, 1176, 1160, 1144, 1128, 1112, 1097, /* 45 - 49.5 ℃ */ // 1081, 1066, 1051, 1036, 1022, 1007, 993, 979, 965, 951, /* 50 - 54.5 ℃ */ // 938, 924, 911, 898, 885, 872, 860, 848, 835, 823, /* 55 - 59.5 ℃ */ // 811, 800, 788, 777, 765, 754, 743, 732, 722, 711, /* 60 - 64.5 ℃ */ // 701, 691, 681, 671, 661, 651, 642, 632, 623, 614, /* 65 - 69.5 ℃ */ // 605, 596, 588, 579, 571, 562, 554, 546, 538, 530, /* 70 - 74.5 ℃ */ // 522, 515, 507, 500, 493, 486, 478, 471, 465, 458, /* 75 - 79.5 ℃ */ // 451, 445, 438, 432, 426, 420, 414, 408, 402, 396, /* 80 - 84.5 ℃ */ // 390, 385, 379, 374, 368, 363, 358, 353, 348, 343, /* 85 - 89.5 ℃ */ // 338, 333, 328, 324, 319, 315, 310, 306, 301, 297, /* 90 - 94.5 ℃ */ // 293, 289, 285, 281, 277, 273, 269, 266, 262, 258, /* 95 - 99.5 ℃ */ // 255 /* 100 ℃ */ //}; /* 3.0V参考电压温度adc值 */ const uint16_t mosTemperADC[mosTemperADCLen] = { 4077, 4066, 4055, 4043, 4031, 4019, 4007, 3994, 3982, 3969, /* -20 - -15.5 ℃ */ 3955, 3942, 3928, 3914, 3900, 3885, 3871, 3856, 3841, 3825, /* -15 - -10.5 ℃ */ 3809, 3794, 3777, 3761, 3744, 3727, 3710, 3693, 3675, 3657, /* -10 - -5.5 ℃ */ 3639, 3621, 3602, 3583, 3564, 3545, 3525, 3506, 3486, 3465, /* -5 - -0.5 ℃ */ 3445, 3424, 3404, 3383, 3361, 3340, 3318, 3296, 3274, 3252, /* 0 - 4.5 ℃ */ 3230, 3207, 3184, 3162, 3138, 3115, 3092, 3068, 3045, 3021, /* 5 - 9.5 ℃ */ 2997, 2973, 2949, 2925, 2900, 2876, 2851, 2827, 2802, 2777, /* 10 - 14.5 ℃ */ 2752, 2728, 2703, 2678, 2653, 2628, 2602, 2577, 2552, 2527, /* 15 - 19.5 ℃ */ 2502, 2477, 2452, 2427, 2402, 2377, 2352, 2327, 2302, 2277, /* 20 - 24.5 ℃ */ 2253, 2228, 2203, 2179, 2154, 2130, 2106, 2082, 2057, 2034, /* 25 - 29.5 ℃ */ 2010, 1986, 1962, 1939, 1916, 1893, 1869, 1847, 1824, 1801, /* 30 - 34.5 ℃ */ 1779, 1757, 1734, 1713, 1691, 1669, 1648, 1626, 1605, 1584, /* 35 - 39.5 ℃ */ 1564, 1543, 1523, 1503, 1483, 1463, 1443, 1424, 1405, 1386, /* 40 - 44.5 ℃ */ 1367, 1348, 1330, 1312, 1293, 1276, 1258, 1241, 1223, 1206, /* 45 - 49.5 ℃ */ 1189, 1173, 1156, 1140, 1124, 1108, 1092, 1077, 1061, 1046, /* 50 - 54.5 ℃ */ 1031, 1017, 1002, 988, 974, 960, 946, 932, 919, 905, /* 55 - 59.5 ℃ */ 892, 879, 867, 854, 842, 829, 817, 806, 794, 782, /* 60 - 64.5 ℃ */ 771, 760, 749, 738, 727, 716, 706, 696, 685, 675, /* 65 - 69.5 ℃ */ 666, 656, 646, 637, 627, 618, 609, 600, 592, 583, /* 70 - 74.5 ℃ */ 575, 566, 558, 550, 542, 534, 526, 519, 511, 504, /* 75 - 79.5 ℃ */ 496, 489, 482, 475, 468, 461, 455, 448, 442, 435, /* 80 - 84.5 ℃ */ 429, 423, 417, 411, 405, 399, 394, 388, 382, 377, /* 85 - 89.5 ℃ */ 372, 366, 361, 356, 351, 346, 341, 336, 332, 327, /* 90 - 94.5 ℃ */ 322, 318, 313, 309, 305, 300, 296, 292, 288, 284, /* 95 - 99.5 ℃ */ 280 /* 100 ℃ */ }; // /* 2.5V参考电压温度adc值 */ // const uint16_t mosTemperADC[mosTemperADCLen] = { // 4893, 4879, 4866, 4852, 4838, 4823, 4808, 4793, 4778, 4762, /* -20 - -15.5 ℃ */ // 4746, 4730, 4714, 4697, 4680, 4663, 4645, 4627, 4609, 4590, /* -15 - -10.5 ℃ */ // 4571, 4552, 4533, 4513, 4493, 4473, 4452, 4431, 4410, 4389, /* -10 - -5.5 ℃ */ // 4367, 4345, 4323, 4300, 4277, 4254, 4231, 4207, 4183, 4159, /* -5 - -0.5 ℃ */ // 4134, 4109, 4084, 4059, 4034, 4008, 3982, 3956, 3929, 3903, /* 0 - 4.5 ℃ */ // 3876, 3849, 3821, 3794, 3766, 3738, 3710, 3682, 3654, 3625, /* 5 - 9.5 ℃ */ // 3596, 3568, 3539, 3510, 3480, 3451, 3422, 3392, 3362, 3333, /* 10 - 14.5 ℃ */ // 3303, 3273, 3243, 3213, 3183, 3153, 3123, 3093, 3063, 3033, /* 15 - 19.5 ℃ */ // 3003, 2972, 2942, 2912, 2882, 2852, 2822, 2792, 2762, 2733, /* 20 - 24.5 ℃ */ // 2703, 2673, 2644, 2614, 2585, 2556, 2527, 2498, 2469, 2440, /* 25 - 29.5 ℃ */ // 2412, 2383, 2355, 2327, 2299, 2271, 2243, 2216, 2189, 2162, /* 30 - 34.5 ℃ */ // 2135, 2108, 2081, 2055, 2029, 2003, 1977, 1952, 1926, 1901, /* 35 - 39.5 ℃ */ // 1876, 1852, 1827, 1803, 1779, 1755, 1732, 1709, 1686, 1663, /* 40 - 44.5 ℃ */ // 1640, 1618, 1596, 1574, 1552, 1531, 1510, 1489, 1468, 1447, /* 45 - 49.5 ℃ */ // 1427, 1407, 1387, 1368, 1349, 1330, 1311, 1292, 1274, 1256, /* 50 - 54.5 ℃ */ // 1238, 1220, 1203, 1185, 1168, 1151, 1135, 1119, 1102, 1086, /* 55 - 59.5 ℃ */ // 1071, 1055, 1040, 1025, 1010, 995, 981, 967, 953, 939, /* 60 - 64.5 ℃ */ // 925, 912, 898, 885, 872, 860, 847, 835, 822, 810, /* 65 - 69.5 ℃ */ // 799, 787, 775, 764, 753, 742, 731, 721, 710, 700, /* 70 - 74.5 ℃ */ // 690, 679, 670, 660, 650, 641, 631, 622, 613, 604, /* 75 - 79.5 ℃ */ // 596, 587, 578, 570, 562, 554, 546, 538, 530, 523, /* 80 - 84.5 ℃ */ // 515, 508, 500, 493, 486, 479, 472, 466, 459, 452, /* 85 - 89.5 ℃ */ // 446, 440, 433, 427, 421, 415, 409, 404, 398, 392, /* 90 - 94.5 ℃ */ // 387, 381, 376, 371, 366, 361, 355, 350, 346, 341, /* 95 - 99.5 ℃ */ // 336 /* 100 ℃ */ // }; enum { WORK_VOLT_NUM = 0, DSG_CURR_NUM = 1, PV_VOLT_IN_NUM = 2, CHG_CURR_NUM = 3, }; int16_t adcBuff[4]; adcCapture WORK_VOLT_capture = {0}; adcCapture DSG_CURR_capture = {0}; adcCapture PV_VOLT_IN_capture = {0}; adcCapture CHG_CURR_capture = {0}; /* 电流电压采集转换的 */ static float P_CHG_CURR = 0; static float P_PV_VOLT_OUT = 0; static float P_DSG_CURR = 0; static float P_PV1_VOLT_IN = 0; static float P_PV_VOLT_IN1 = 0; /* 2.5为adc的电压，4095是2^adc的位数 - 1 */ // const float32_t Proportion = 2.5 / 4095; const float32_t Proportion = 3.0 / 4095.0; /* matlab生成的5阶滤波器系数 */ const int firLen = 6; const float firLP[6] = { 0.01861755922, -0.1146286726, 0.5962908864, 0.5962908864, -0.1146286726, 0.01861755922 }; /** * @brief 初始化adc * @param * @retval None */ void ADC_Capture_Init(void) { HD_adc_Init(); /* 将回调函数与dma的转换完成中断绑定 */ // hdma_adc1.XferCpltCallback = dmaFerCpltCallback; HAL_Delay(100); /* adc校准 */ HAL_ADCEx_Calibration_Start(&hadc1, ADC_SINGLE_ENDED); HAL_ADCEx_Calibration_Start(&hadc2, ADC_SINGLE_ENDED); HAL_TIM_Base_Start(&htim6); HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adcBuff, 4); // /* 光伏充电输出电流比例，放大倍数*电阻 */ // P_CHG_CURR = (1.0 / (50 * (1 / (1 / 0.01 + 1 / 0.002)))) * Proportion; // /* 充电控制盒输出电压比例，分压系数 */ // P_PV_VOLT_OUT = ((47.0 + 10.0) / 10.0) * Proportion; // /* 放电电流采集电流倍数 */ // P_DSG_CURR = (1.0 / (50 * (1 / (1 / 0.002 * 2)))) * Proportion; // /* 光伏板输出电压比例 */ // P_PV1_VOLT_IN = ((47.0 + 4.7) / 4.7) * Proportion; // /* 系统电源电压比例 */ // P_PV_VOLT_IN1 = ((47 + 4.7) / 4.7) * Proportion; } /** * @brief 初始化电流电压转换的比例（及放大或者缩小倍数） * @param * @retval None */ void proportionalInt(int mode) { /* 仅充当电源盒 */ if (mode) { /* 光伏充电输出电流比例，放大倍数*电阻 */ P_CHG_CURR = (1.0 / (50 * (1 / (1 / 0.01 + 1 / 0.002)))) * Proportion; /* 充电控制盒输出电压比例，分压系数 */ P_PV_VOLT_OUT = ((47.0 + 10.0) / 10.0) * Proportion; /* 放电电流采集电流倍数 */ P_DSG_CURR = (1.0 / (50 * (1 / (1 / 0.002 * 2)))) * Proportion; /* 光伏板输出电压比例 */ P_PV1_VOLT_IN = ((47.0 + 4.7) / 4.7) * Proportion; /* 系统电源电压比例 */ P_PV_VOLT_IN1 = ((47 + 4.7) / 4.7) * Proportion; } /* 电源盒外还有网关功能 */ else { /* 光伏充电输出电流比例，放大倍数*电阻 */ P_CHG_CURR = (1.0 / (50 * 0.005)) * Proportion; /* 光伏充电输出电压比例，分压系数 */ P_PV_VOLT_OUT = ((47.0 + 4.7) / 4.7) * Proportion; /* 放电电流采集电流倍数 */ P_DSG_CURR = (1.0 / (50 * 0.005)) * Proportion; /* 光伏1开路输出电压比例 */ P_PV1_VOLT_IN = ((47.0 + 4.7) / 4.7) * Proportion; /* 系统电源电压比例 */ P_PV_VOLT_IN1 = ((47 + 4.7) / 4.7) * Proportion; } } #define N 4 /** * @brief 中位值平均滤波 * @param funtion 获取ADC的函数 * @param ADC_Channel ADC通道 * @retval None */ static int16_t middleAverageFilter(int16_t funtion(uint32_t Channel), uint32_t ADC_Channel) { int16_t i,j,k; int16_t temp,sum = 0; int16_t value_buf[N]; for (i = 0; i < N; ++i) { value_buf[i] = funtion(ADC_Channel); } /*从小到大冒泡排序*/ for(j = 0; j < N-1; ++j) { for (k = 0; k < N-j-1; ++k) { if(value_buf[k] > value_buf[k+1]) { temp = value_buf[k]; value_buf[k] = value_buf[k+1]; value_buf[k+1] = temp; } } } for(i = 1; i < N-1; ++i) { sum += value_buf[i]; } return sum / (N-2); } /** * @brief 获取adc2的采集值 * @param Channel ADC通道 * @retval None */ static int16_t ADC2_Capture(uint32_t Channel) { return middleAverageFilter(get_adc2Value, Channel); } // /** // * @brief 获取adc1的采集值 // * @param Channel ADC通道 // * @retval None // */ // static int16_t ADC1_Capture(uint32_t Channel) // { // return middleAverageFilter(get_adc1Value, Channel); // } /** * @brief 得到充电电流 * @param * @retval I 电流值 */ float get_CHG_CURR(void) { float I; I = CHG_CURR_capture.outData * P_CHG_CURR; // I = ADC1_Capture(ADC_CHANNEL_11) * P_CHG_CURR; #ifdef enable_Printf_VI debug("\n CHG_CURR ADC : %d \n", (int)CHG_CURR_capture.outDataF); debug(" CHG_CURR I : %f \n", I); #endif return I; } /** * @brief 得到光伏输出电压 * @param * @retval V 电压值 */ float get_PV_VOLT_OUT(void) { float V; V = WORK_VOLT_capture.outData * P_PV_VOLT_OUT; // V = ADC1_Capture(ADC_CHANNEL_7) * P_PV_VOLT_OUT; #ifdef enable_Printf_VI debug("\n PV_VOLT_OUT ADC : %d \n", (int)WORK_VOLT_capture.outDataF); debug(" PV_VOLT_OUT V : %f \n", V); #endif return V; } /** * @brief 得到放电电流 * @param * @retval I 电流值 */ float get_DSG_CURR(void) { float I; I = DSG_CURR_capture.outData * P_DSG_CURR; // I = ADC1_Capture(ADC_CHANNEL_8) * P_DSG_CURR; #ifdef enable_Printf_VI debug("\n DSG_CURR ADC : %d \n", (int)DSG_CURR_capture.outDataF); debug(" DSG_CURR I : %f \n", I); #endif return I; } /** * @brief 得到光伏电压 * @param * @retval V 电压值 */ float get_PV1_VOLT_IN(void) { float V; V = PV_VOLT_IN_capture.outData * P_PV1_VOLT_IN; // V = ADC1_Capture(ADC_CHANNEL_15) * P_PV1_VOLT_IN; #ifdef enable_Printf_VI debug("\n PV1_VOLT_IN ADC : %d \n", (int)PV_VOLT_IN_capture.outDataF); debug(" PV1_VOLT_IN V1 : %f \n", V); #endif return V; } /** * @brief 得到系统电压电压 * @param * @retval V 电压值 */ float get_PV_VOLT_IN1(void) { float V; uint16_t V_ADC; V_ADC = ADC2_Capture(SYS_VOLT_IN_CHANNEL); V = (float)(V_ADC) * P_PV_VOLT_IN1; #ifdef enable_Printf_VI debug("\n PV_VOLT_IN1 ADC : %d \n", V_ADC); debug(" PV_VOLT_IN1 V : %f \n", V); #endif return V; } //const float Rp = 10000.0; //10K //const float T2 = (273.15+25.0);//T2 //const float Bx = 3950.0;//B //const float Bx = 3435.0;//B //const float Ka = 273.15; /** * @brief 得到温度 * @param * @retval V 电压值 */ float get_MOSFET_Temper(void) { float T = 0; uint16_t T_ADC; T_ADC = ADC2_Capture(MOSFET_Temper_CHANNEL); for (int i = 0; i < mosTemperADCLen; ++i) { if (T_ADC >= mosTemperADC[i]) { T = -20 + i * 0.5; break; } } #ifdef enable_Printf_VI debug("\n MOSFET_Temper ADC : %d \n", T_ADC); debug(" MOSFET_Temper T : %f \n", T); #endif return T; } /** * @brief adc转换并传输完成后进入该回调函数 * @param hdma dma * @retval None */ void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef *hdma) { if (hdma->Instance == ADC1) { arm_copy_f32(WORK_VOLT_capture.inDataF, WORK_VOLT_capture.inDataF + 1, 5); arm_copy_f32(DSG_CURR_capture.inDataF, DSG_CURR_capture.inDataF + 1, 5); arm_copy_f32(PV_VOLT_IN_capture.inDataF, PV_VOLT_IN_capture.inDataF + 1, 5); arm_copy_f32(CHG_CURR_capture.inDataF, CHG_CURR_capture.inDataF + 1, 5); WORK_VOLT_capture.inDataF[5] = (float32_t)adcBuff[WORK_VOLT_NUM]; DSG_CURR_capture.inDataF[5] = (float32_t)adcBuff[DSG_CURR_NUM]; PV_VOLT_IN_capture.inDataF[5] = (float32_t)adcBuff[PV_VOLT_IN_NUM]; CHG_CURR_capture.inDataF[5] = (float32_t)adcBuff[CHG_CURR_NUM]; } } /** * @brief 将采集得到的adc进行滤波 * @param None * @retval None */ void adcCaptureFir(void) { static arm_fir_instance_f32 armFirInstanceF32; static float32_t *inputF32, *outputF32; static uint32_t blockSize = 1; static float32_t firStateF32[6]; /* 状态缓存 */ static float32_t outputf; /* 初始化结构体 */ arm_fir_init_f32(&armFirInstanceF32, firLen, (float_t *)&firLP[0], &firStateF32[0], blockSize); /* 初始化输入输出缓存指针 */ inputF32 = &WORK_VOLT_capture.inDataF[0]; outputF32 = &outputf; arm_fir_f32(&armFirInstanceF32, inputF32, outputF32, blockSize); WORK_VOLT_capture.outData = (int16_t)outputf; /* 初始化输入输出缓存指针 */ inputF32 = &DSG_CURR_capture.inDataF[0]; outputF32 = &outputf; arm_fir_f32(&armFirInstanceF32, inputF32, outputF32, blockSize); DSG_CURR_capture.outData = (int16_t)outputf; /* 初始化输入输出缓存指针 */ inputF32 = &PV_VOLT_IN_capture.inDataF[0]; outputF32 = &outputf; arm_fir_f32(&armFirInstanceF32, inputF32, outputF32, blockSize); PV_VOLT_IN_capture.outData = (int16_t)outputf; /* 初始化输入输出缓存指针 */ inputF32 = &CHG_CURR_capture.inDataF[0]; outputF32 = &outputf; arm_fir_f32(&armFirInstanceF32, inputF32, outputF32, blockSize); CHG_CURR_capture.outData = (int16_t)outputf; }