367 lines
8.3 KiB
C
367 lines
8.3 KiB
C
/*
|
||
* charger_gbt.c
|
||
*
|
||
* Created on: Apr 18, 2024
|
||
* Author: colorbass
|
||
*/
|
||
|
||
|
||
#include "charger_gbt.h"
|
||
#include "main.h"
|
||
#include "board.h"
|
||
#include "stdio.h"
|
||
#include "j1939.h"
|
||
#include "string.h"
|
||
#include "edcan.h"
|
||
|
||
gbtState_t GBT_State;
|
||
uint32_t GBT_state_tick; //Tick after state switch
|
||
uint32_t GBT_delay;
|
||
uint8_t GBT_BAT_INFO_recv;
|
||
uint8_t GBT_BAT_STAT_recv;
|
||
uint8_t EV_ready;
|
||
|
||
GBT_BHM_t GBT_MaxVoltage;
|
||
GBT_CML_t GBT_MaxLoad;
|
||
GBT_CRM_t GBT_ChargerInfo;
|
||
|
||
GBT_BRM_t GBT_EVInfo;
|
||
GBT_BCP_t GBT_BATStat;
|
||
GBT_BCL_t GBT_ReqPower;
|
||
GBT_BCL_t GBT_CurrPower;
|
||
|
||
GBT_BCS_t GBT_ChargingStatus;
|
||
|
||
GBT_BSM_t GBT_BatteryStatus;
|
||
|
||
GBT_CCS_t GBT_ChargerCurrentStatus;
|
||
|
||
uint8_t GBT_BRO;
|
||
|
||
extern GBT_EDCAN_Output_t GBT_EDCAN_Output;
|
||
|
||
|
||
void GBT_Init(){
|
||
GBT_State = GBT_DISABLED;
|
||
GBT_Lock(0);
|
||
}
|
||
|
||
uint8_t GBT_CC_GetState(){
|
||
//Vref=3.3v = 4095
|
||
//k=1/11
|
||
//Vin = 12v
|
||
//Vin*k= 1.09v
|
||
//12vin = 1353 ADC
|
||
//TODO: Filter 100ms
|
||
uint32_t adc;
|
||
float volt;
|
||
ADC_Select_Channel(ADC_CHANNEL_6);
|
||
HAL_ADC_Start(&hadc1);
|
||
HAL_ADC_PollForConversion(&hadc1, 100);
|
||
adc = HAL_ADC_GetValue(&hadc1);
|
||
HAL_ADC_Stop(&hadc1);
|
||
|
||
volt = (float)adc/113.4f;
|
||
if((volt<12.6f) && (volt>11.4f)) return GBT_CC_12V;
|
||
if((volt<6.8f) && (volt>5.2f)) return GBT_CC_6V;
|
||
if((volt<4.8f) && (volt>3.2f)) return GBT_CC_4V;
|
||
if((volt<2.8f) && (volt>1.2f)) return GBT_CC_2V;
|
||
return GBT_CC_UNKNOWN;
|
||
}
|
||
|
||
float GBT_CC_GetAdc(){
|
||
//Vref=3.3v = 4095
|
||
//k=1/11
|
||
//Vin = 12v
|
||
//Vin*k= 1.09v
|
||
//12vin = 1353 ADC
|
||
|
||
uint32_t adc;
|
||
float volt;
|
||
ADC_Select_Channel(ADC_CHANNEL_6);
|
||
HAL_ADC_Start(&hadc1);
|
||
HAL_ADC_PollForConversion(&hadc1, 100);
|
||
adc = HAL_ADC_GetValue(&hadc1);
|
||
HAL_ADC_Stop(&hadc1);
|
||
|
||
volt = (float)adc/113.4f;
|
||
|
||
return volt;
|
||
}
|
||
|
||
void GBT_ChargerTask(){
|
||
|
||
if(j_rx.state == 2){
|
||
switch (j_rx.PGN){
|
||
case 0x2700: //PGN BHM
|
||
memcpy (&GBT_MaxVoltage, j_rx.data, sizeof(GBT_MaxVoltage));
|
||
|
||
break;
|
||
|
||
case 0x0200: //PGN BRM LONG
|
||
GBT_BAT_INFO_recv = 1;
|
||
memcpy (&GBT_EVInfo, j_rx.data, sizeof(GBT_EVInfo));
|
||
|
||
break;
|
||
|
||
case 0x0600: //PGN BCP LONG
|
||
GBT_BAT_STAT_recv = 1;
|
||
memcpy (&GBT_BATStat, j_rx.data, sizeof(GBT_BATStat));
|
||
break;
|
||
|
||
case 0x0900: //PGN BRO
|
||
if(j_rx.data[0] == 0xAA) EV_ready = 1;
|
||
else EV_ready = 0;
|
||
GBT_BRO = j_rx.data[0];
|
||
break;
|
||
|
||
case 0x1000: //PGN BCL
|
||
//TODO: power block
|
||
memcpy (&GBT_ReqPower, j_rx.data, sizeof(GBT_ReqPower));
|
||
uint16_t volt=GBT_ReqPower.requestedVoltage/10;
|
||
GBT_EDCAN_Output.requestedVoltage = volt;
|
||
uint16_t curr=(4000-GBT_ReqPower.requestedCurrent);
|
||
GBT_EDCAN_Output.requestedCurrent = curr;
|
||
break;
|
||
|
||
case 0x1100: //PGN BCS
|
||
//TODO
|
||
memcpy (&GBT_ChargingStatus, j_rx.data, sizeof(GBT_ChargingStatus));
|
||
GBT_EDCAN_Output.chargingRemainingTimeMin = GBT_ChargingStatus.estimatedRemainingChargingTime;
|
||
GBT_EDCAN_Output.chargingPercentage = GBT_ChargingStatus.currentChargeState;
|
||
break;
|
||
|
||
case 0x1300: //PGN BSM
|
||
//TODO
|
||
memcpy (&GBT_BatteryStatus, j_rx.data, sizeof(GBT_BatteryStatus));
|
||
break;
|
||
|
||
case 0x1500: //PGN BMV
|
||
//TODO
|
||
break;
|
||
|
||
case 0x1600: //PGN BMT
|
||
//TODO
|
||
break;
|
||
|
||
case 0x1700: //PGN BSP
|
||
//TODO
|
||
break;
|
||
|
||
|
||
//BSM BMV BMT BSP BST BSD BEM
|
||
|
||
}
|
||
j_rx.state = 0;
|
||
}
|
||
|
||
if(GBT_delay>HAL_GetTick()){
|
||
//waiting
|
||
}else switch (GBT_State){
|
||
case GBT_DISABLED:
|
||
|
||
break;
|
||
case GBT_S0_UNCONNECTED:
|
||
if(GBT_CC_GetState()==GBT_CC_4V){
|
||
|
||
GBT_SwitchState(GBT_S1_CONNECTED);
|
||
GBT_Delay(500);
|
||
}
|
||
break;
|
||
case GBT_S1_CONNECTED:
|
||
if(GBT_CC_GetState()==GBT_CC_4V){
|
||
|
||
GBT_Lock(1);
|
||
GBT_SwitchState(GBT_S2_LOCKED);
|
||
GBT_Delay(500);
|
||
}else{
|
||
GBT_SwitchState(GBT_S0_UNCONNECTED);
|
||
}
|
||
break;
|
||
case GBT_S2_LOCKED:
|
||
if(1){ //TODO: charge permission
|
||
RELAY_Write(RELAY_AUX, 1); // 13.8V AUX ON
|
||
GBT_SwitchState(GBT_S3_STARTED);
|
||
GBT_Delay(500);
|
||
}
|
||
break;
|
||
|
||
case GBT_S3_STARTED:
|
||
GBT_SwitchState(GBT_S4_ISOTEST);
|
||
GBT_Delay(500);
|
||
break;
|
||
|
||
case GBT_S4_ISOTEST:
|
||
if(j_rx.state == 0) GBT_SendCHM();
|
||
GBT_Delay(250);
|
||
//TODO: Isolation test
|
||
//TODO: Timeout
|
||
if(GBT_StateTick()>1500){
|
||
//Isolation test finish
|
||
GBT_SwitchState(GBT_S5_BAT_INFO);
|
||
}
|
||
break;
|
||
|
||
case GBT_S5_BAT_INFO:
|
||
if(j_rx.state == 0) GBT_SendCRM(0x00);
|
||
GBT_Delay(250);
|
||
if(GBT_BAT_INFO_recv){
|
||
//Got battery info
|
||
GBT_SwitchState(GBT_S6_BAT_STAT);
|
||
}
|
||
break;
|
||
|
||
case GBT_S6_BAT_STAT:
|
||
if(j_rx.state == 0) GBT_SendCRM(0xAA);
|
||
GBT_Delay(250);
|
||
if(GBT_BAT_STAT_recv){
|
||
//Got battery status
|
||
GBT_SwitchState(GBT_S7_BMS_WAIT);
|
||
}
|
||
break;
|
||
|
||
case GBT_S7_BMS_WAIT:
|
||
if(j_rx.state == 0) GBT_SendCTS();
|
||
HAL_Delay(2);
|
||
if(j_rx.state == 0) GBT_SendCML();
|
||
GBT_Delay(250);
|
||
if(EV_ready){
|
||
//EV ready (AA)
|
||
GBT_SwitchState(GBT_S8_INIT_CHARGER);
|
||
}
|
||
break;
|
||
|
||
case GBT_S8_INIT_CHARGER:
|
||
if(j_rx.state == 0) GBT_SendCRO(0x00);
|
||
//TODO
|
||
GBT_Delay(250);
|
||
if(GBT_StateTick()>1500){
|
||
//Power Modules initiated
|
||
GBT_SwitchState(GBT_S9_WAIT_BCL);
|
||
}
|
||
break;
|
||
|
||
case GBT_S9_WAIT_BCL:
|
||
if(j_rx.state == 0) GBT_SendCRO(0xAA);
|
||
GBT_Delay(250);
|
||
if(GBT_ReqPower.chargingMode != 0){
|
||
//BCL power requirements received
|
||
//write power modules
|
||
GBT_SwitchState(GBT_S10_CHARGING);
|
||
uint16_t curr=(4000-GBT_ReqPower.requestedCurrent);
|
||
uint16_t volt=GBT_ReqPower.requestedVoltage/10;
|
||
//if ((curr10>0) && (curr10<500));
|
||
//PSU_SetVoltage(volt);
|
||
//PSU_SetCurrent(curr);
|
||
GBT_EDCAN_Output.requestedVoltage = volt;
|
||
GBT_EDCAN_Output.requestedCurrent = curr;
|
||
GBT_EDCAN_Output.enablePSU = 1;
|
||
|
||
|
||
//TODO: EDCAN_SendPacketRead
|
||
|
||
//смещение -400а
|
||
//RELAY_Write(RELAY_3, 1);
|
||
//PSU_Mode(0x0200);
|
||
}
|
||
break;
|
||
|
||
case GBT_S10_CHARGING:
|
||
//CHARGING
|
||
if(j_rx.state == 0) GBT_SendCCS();
|
||
// write power modules
|
||
|
||
|
||
// if(mm_queue_size()==0){//TODO: hysteresis, charging mode
|
||
// if(GBT_CurrPower.requestedCurrent != GBT_ReqPower.requestedCurrent){
|
||
// GBT_CurrPower.requestedCurrent = GBT_ReqPower.requestedCurrent;
|
||
// //PSU_SetVoltage(GBT_ReqPower.requestedVoltage/10);
|
||
// uint16_t curr=(4000-GBT_ReqPower.requestedCurrent);
|
||
// //PSU_SetCurrent(curr);
|
||
// GBT_ChargingSummary.requestedCurrent = curr;
|
||
// }
|
||
// if(GBT_CurrPower.requestedVoltage != GBT_ReqPower.requestedVoltage){
|
||
// GBT_CurrPower.requestedVoltage = GBT_ReqPower.requestedVoltage;
|
||
// //PSU_SetCurrent(GBT_ReqPower.requestedCurrent);
|
||
// uint16_t volt=GBT_ReqPower.requestedVoltage/10;
|
||
// GBT_ChargingSummary.requestedVoltage = volt;
|
||
// //PSU_SetVoltage(volt);
|
||
// //смещение -400а
|
||
// }
|
||
//// }
|
||
|
||
GBT_Delay(50);
|
||
|
||
break;
|
||
|
||
case GBT_STOP:
|
||
//TODO: turn off power modules
|
||
GBT_Delay(10);
|
||
GBT_EDCAN_Output.enablePSU = 0;
|
||
GBT_SendCST();
|
||
//RELAY_Write(RELAY_OUTPUT, 0);
|
||
//GBT_SwitchState(GBT_DISABLED);
|
||
if(GBT_StateTick()>1000){
|
||
GBT_SwitchState(GBT_DISABLED);
|
||
GBT_Lock(0);
|
||
RELAY_Write(RELAY_AUX, 0);
|
||
//PSU_Mode(0x0100);
|
||
}
|
||
break;
|
||
|
||
default:
|
||
GBT_SwitchState(GBT_DISABLED);
|
||
}
|
||
}
|
||
|
||
|
||
|
||
void GBT_SwitchState(gbtState_t state){
|
||
GBT_State = state;
|
||
ED_status = state;
|
||
GBT_state_tick = HAL_GetTick();
|
||
if(GBT_State == GBT_DISABLED) printf ("GBT_DISABLED\n");
|
||
if(GBT_State == GBT_S0_UNCONNECTED) printf ("GBT_S0_UNCONNECTED\n");
|
||
if(GBT_State == GBT_S1_CONNECTED) printf ("GBT_S1_CONNECTED\n");
|
||
if(GBT_State == GBT_S2_LOCKED) printf ("GBT_S2_LOCKED\n");
|
||
if(GBT_State == GBT_S3_STARTED) printf ("GBT_S3_STARTED\n");
|
||
if(GBT_State == GBT_S4_ISOTEST) printf ("GBT_S4_ISOTEST\n");
|
||
if(GBT_State == GBT_S5_BAT_INFO) printf ("GBT_S5_BAT_INFO\n");
|
||
if(GBT_State == GBT_S6_BAT_STAT) printf ("GBT_S6_BAT_STAT\n");
|
||
if(GBT_State == GBT_S7_BMS_WAIT) printf ("GBT_S7_BMS_WAIT\n");
|
||
if(GBT_State == GBT_S8_INIT_CHARGER)printf ("GBT_S8_INIT_CHARGER\n");
|
||
if(GBT_State == GBT_S9_WAIT_BCL) printf ("GBT_S9_WAIT_BCL\n");
|
||
if(GBT_State == GBT_S10_CHARGING) printf ("GBT_S10_CHARGING\n");
|
||
if(GBT_State == GBT_STOP) printf ("GBT_STOP\n");
|
||
|
||
|
||
}
|
||
|
||
uint32_t GBT_StateTick(){
|
||
return HAL_GetTick() - GBT_state_tick;
|
||
}
|
||
|
||
void GBT_Delay(uint32_t delay){
|
||
GBT_delay = HAL_GetTick()+delay;
|
||
}
|
||
|
||
void GBT_Stop(){
|
||
if(GBT_State != GBT_STOP) GBT_SwitchState(GBT_STOP);
|
||
}
|
||
|
||
void GBT_Stop1(){
|
||
GBT_SwitchState(GBT_DISABLED);
|
||
GBT_Lock(0);
|
||
RELAY_Write(RELAY_AUX, 0);
|
||
}
|
||
|
||
void GBT_Start(){
|
||
GBT_BAT_INFO_recv = 0;
|
||
GBT_BAT_STAT_recv = 0;
|
||
EV_ready = 0;
|
||
memset(&GBT_EVInfo, 0, sizeof (GBT_EVInfo));
|
||
memset(&GBT_BATStat, 0, sizeof (GBT_BATStat));
|
||
memset(&GBT_ReqPower, 0, sizeof (GBT_ReqPower));
|
||
GBT_SwitchState(GBT_S0_UNCONNECTED);
|
||
}
|