Mr_Fang/Power-Pico
1
0
Fork 0
mirror of https://github.com/No-Chicken/Power-Pico.git synced 2026-04-03 13:02:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

update valtage and current get

Browse Source
This commit is contained in:
不吃油炸鸡
2025-09-14 18:47:02 +08:00
parent b7e746a7c2
commit a3b9fbbbe7
7 changed files with 122 additions and 29 deletions
Download Patch File Download Diff File Expand all files Collapse all files

83
Power_Pico/BSP/GATE/gate.c
View File

@@ -1,6 +1,8 @@
#include "gate.h"
#include "usart.h"
#include "math.h"
static uint8_t status = HIGH_CUR; // Default status
uint8_t gate_status = HIGH_CUR; // Default status
void Gate_Port_Init(void)
{
@@ -31,6 +33,10 @@ void Gate_Port_Init(void)
void flow_route_selection(uint8_t selection)
{
if(selection > HIGH_CUR)
selection = HIGH_CUR; // Invalid selection
if(selection < LOW_CUR)
selection = LOW_CUR;
if(selection == HIGH_CUR)
{
HAL_GPIO_WritePin(EN1_PORT, EN1_PIN, GPIO_PIN_SET);
@@ -46,16 +52,75 @@ void flow_route_selection(uint8_t selection)
HAL_GPIO_WritePin(EN1_PORT, EN1_PIN, GPIO_PIN_RESET);
HAL_GPIO_WritePin(EN2_PORT, EN2_PIN, GPIO_PIN_RESET);
}
else
{
// Invalid selection
HAL_GPIO_WritePin(EN1_PORT, EN1_PIN, GPIO_PIN_SET);
HAL_GPIO_WritePin(EN2_PORT, EN2_PIN, GPIO_PIN_SET);
}
status = selection; // Update the status
gate_status = selection; // Update the status
}
uint8_t Gate_get_status(void)
{
return status;
return gate_status;
}
// DMA中断中执行, 不能有阻塞
void Gate_Swich_and_UART_Send(ADC_Packet adc_packet)
{
static uint8_t high_times = 0;
static uint8_t low_times = 0;
// low mid high
uint16_t cur_adc = 0;
switch(Gate_get_status()) {
case LOW_CUR:
cur_adc = adc_packet.data[0][1];
break;
case MID_CUR:
cur_adc = adc_packet.data[0][2];
break;
case HIGH_CUR:
cur_adc = adc_packet.data[0][3];
break;
}
// 可信范围内
if(cur_adc < ADC_TRUST_MAX) {
adc_packet.header[3] = Gate_get_status();
HAL_UART_Transmit_DMA(&huart6, (uint8_t*)&adc_packet, sizeof(adc_packet));
// 计算电压电流值
global_valtage = adc_packet.data[0][0] * 3.0f / 4096.0f * 11.0f; // 11 = (100+10)/10
if(Gate_get_status() == LOW_CUR) {
global_current = (adc_packet.data[0][1] - 2048) * (3.0f / 4096.0f / 50.0f / LOW_CUR_RES * 1000000.0f);
global_cur_unit = UNIT_UA;
}
else if(Gate_get_status() == MID_CUR) {
global_current = (adc_packet.data[0][2] - 2048) * (3.0f / 4096.0f / 50.0f / MID_CUR_RES * 1000.0f);
global_cur_unit = UNIT_MA;
}
else if(Gate_get_status() == HIGH_CUR) {
global_current = (adc_packet.data[0][3] - 2048) * (3.0f / 4096.0f / 50.0f / HIGH_CUR_RES * 1000.0f);
global_cur_unit = UNIT_MA;
}
// 超过量程
uint16_t diff = abs((int)cur_adc - 2048);
if(diff > THRESH_HIGH) {
high_times++;
low_times = 0;
if(high_times >= THRESH_TIMES) {
high_times = 0;
flow_route_selection(Gate_get_status()+1);
}
}
else if(diff < THRESH_LOW) {
low_times++;
high_times = 0;
if(low_times >= THRESH_TIMES) {
low_times = 0;
flow_route_selection(Gate_get_status()-1);
}
}
else {
high_times = 0;
low_times = 0;
}
}
// 不可信范围内
else {
flow_route_selection(Gate_get_status()+1);
}
}

14
Power_Pico/BSP/GATE/gate.h
View File

@@ -6,6 +6,7 @@ extern "C" {
#endif
#include "main.h"
#include "adc.h"
// EN1
#define EN1_PORT GPIOB
@@ -16,18 +17,19 @@ extern "C" {
#define EN2_PIN GPIO_PIN_15
// Flow route selection
#define HIGH_CUR 2
#define MID_CUR 1
#define LOW_CUR 0
#define HIGH_CUR 3
#define MID_CUR 2
#define LOW_CUR 1
// Resistance values in ohms
#define HIGH_CUR_RES 0.005 // 5 m ohm
#define MID_CUR_RES 0.5 // 500 m ohm
#define LOW_CUR_RES 50.0 // 50 ohm
#define HIGH_CUR_RES 0.005f // 5 m ohm
#define MID_CUR_RES 0.5f // 500 m ohm
#define LOW_CUR_RES 50.0f // 50 ohm
void Gate_Port_Init(void);
void flow_route_selection(uint8_t selection);
uint8_t Gate_get_status(void);
void Gate_Swich_and_UART_Send(ADC_Packet adc_packet);
#ifdef __cplusplus
}