aniketSaha/NorthStar-Endurance-TestBench
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Pump speed decrease in case of high pressure

Browse Source
This commit is contained in:
VineetaGupta 2025-04-02 13:17:18 +02:00
parent 71b468cc6e
commit d2de7da0e3
5 changed files with 31 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
EnduranceTestBench/nehemis/grundfos.c
View File

@ -27,7 +27,7 @@
/******************************************************************************
* Private function Declarations
******************************************************************************/
static float32 GrundfosPmpReadVoltage(uint8 channel_u8);
static uint32 GrundfosPmpReadVoltage(uint8 channel_u8);
/******************************************************************************
* Extern Function Definitions
@ -45,9 +45,9 @@ void GrundfosPmpEnable(uint8 state_u8)
}
float32 GrundfosPmpFeedback(uint8 channel_u8)
uint32 GrundfosPmpFeedback(uint8 channel_u8)
{
float32 feedbackSpeed_u32 = (GrundfosPmpReadVoltage(channel_u8)) * 0.32f;
uint32 feedbackSpeed_u32 = (GrundfosPmpReadVoltage(channel_u8)) * 360u;
return feedbackSpeed_u32;
}
@ -90,13 +90,13 @@ bool GrundfosPmpSetSpeed(float32 setSpeed_f32)
* @return ADC output voltage based on sensor reading.
*
*/
static float32 GrundfosPmpReadVoltage(uint8 channel_u8)
static uint32 GrundfosPmpReadVoltage(uint8 channel_u8)
{
/* Convert ADC value to voltage (assuming 12-bit resolution and 3.3V reference) */
float32 voltage_f32 = 0.0f;
uint32 adcVal_u32 = 0uL;
AnalogMeasurementReadData(channel_u8, &adcVal_u32);
voltage_f32 = (float32)adcVal_u32 * (ANALOG_MEAS_ADC_REF_VOLTAGE / ANALOG_MEAS_ADC_RESOLUTION);
voltage_f32 = adcVal_u32 * (uint32)(ANALOG_MEAS_ADC_REF_VOLTAGE / ANALOG_MEAS_ADC_RESOLUTION);
return voltage_f32;
}

2
EnduranceTestBench/nehemis/grundfos.h
View File

@ -34,7 +34,7 @@ typedef struct
/******************************************************************************
* Extern Function Declarations
******************************************************************************/
float32 GrundfosPmpFeedback(uint8 channel_u8);
uint32 GrundfosPmpFeedback(uint8 channel_u8);
void GrundfosPmpEnable(uint8_t state_u8);
bool GrundfosPmpSetSpeed(float setSpeed_f);
#endif /* GRUNDFOS_H_ */

1
EnduranceTestBench/nehemis/pressureSensor.c
View File

@ -33,6 +33,7 @@ static float PressureSensorReadVoltage(uint32 channel_u32);
******************************************************************************/
void PressureSensorInit(PressureSensorMain_st *pressureSensor_pst)
{
pressureSensor_pst->rawT_f32 = 0.0f;
if (pressureSensor_pst == NULL)
{
/* ERROR */

31
EnduranceTestBench/nehemis/processBoard.c
View File

@ -30,19 +30,19 @@
#define PROCESS_BOARD_VALVE_POS_INDEX 0x6002
#define PROCESS_BOARD_VALVE_FLOW_INDEX 0x6006
#define PROCESS_BOARD_VALVE_PRESSURE_INDEX 0x6001
#define PROCESS_BOARD_VALVE_SUB_INDEX 0x0
#define PU_CANOPEN_SLAVE_LINE 0u
#define PU_CANOPEN_MASTER_LINE 1u
#define PU_PUMP_SPEED_CHANGE_INTERVAL 900000uLL
#define PU_PUMP_MAX_SPEED 10u
#define PU_PUMP_MIN_SPEED 0u
#define PU_PMP_ENABLE 1u
#define PU_PMP_DISABLE 0u
#define PU_PMP_RATED_SPEED 3500uL
#define PU_MAX_PRESSURE 20u
/******************************************************************************
* Global variables
******************************************************************************/
@ -114,6 +114,11 @@ void ProcessBoardInit(void)
FlowmeterInit(&flowmeterFM2_gst);
FlowmeterInit(&flowmeterFM3_gst);
FlowmeterInit(&flowmeterFM4_gst);
PressureSensorInit(&pressureSensorPS1_gst);
PressureSensorInit(&pressureSensorPS2_gst);
PressureSensorInit(&pressureSensorPS3_gst);
PressureSensorInit(&pressureSensorPS4_gst);
}
@ -173,7 +178,7 @@ void ProcessBoardRun(void)
******************************************************************************/
static void ProcessBoardGrundfosPumpHandler(void)
{
static float32 pmpSpeed_f32 = 0.0f;
static uint32 pmpSpeed_u32 = 0uL;
static uint8 speed_u8 = 0u;
static uint64 startTime_u64 = 0uLL;
uint64 currentTimeMs_u64;
@ -189,7 +194,16 @@ static void ProcessBoardGrundfosPumpHandler(void)
if ((currentTimeMs_u64 - startTime_u64) >= PU_PUMP_SPEED_CHANGE_INTERVAL)
{
if (speed_u8 < PU_PUMP_MAX_SPEED)
if (pressureSensorPS1_gst.rawT_f32 > PU_MAX_PRESSURE || pressureSensorPS2_gst.rawT_f32 > PU_MAX_PRESSURE ||
pressureSensorPS3_gst.rawT_f32 > PU_MAX_PRESSURE || pressureSensorPS4_gst.rawT_f32 > PU_MAX_PRESSURE)
{
/* Decrease speed if pressure is too high */
if (speed_u8 > PU_PUMP_MIN_SPEED)
{
speed_u8 -= 2u;
}
}
else if (speed_u8 < PU_PUMP_MAX_SPEED)
{
speed_u8 += 2u;
}
@ -204,15 +218,16 @@ static void ProcessBoardGrundfosPumpHandler(void)
}
/* Grundfos Pump feedback speed OUT */
pmpSpeed_f32 = GrundfosPmpFeedback(PMP_ADC_CHANNEL);
pmpSpeed_u32 = GrundfosPmpFeedback(PMP_ADC_CHANNEL);
if (pmpSpeed_f32 > 3.3f)
if (pmpSpeed_u32 > PU_PMP_RATED_SPEED)
{
GrundfosPmpEnable(PU_PMP_DISABLE);
GrundfosPmpEnable(PU_PMP_DISABLE);
}
}
static void ProcessBoardTriggerMvPosCtrl(uint8 motorId_u8, uint8 posData_u8)
{

1
EnduranceTestBench/scheduler/sdl.c
View File

@ -129,6 +129,7 @@ void SdlInit(void)
{
testBenchStarted_b = false;
SdlInitCanopen();
ProcessBoardInit();
}