Fertirrega_v6 Scaled to 4096
This commit is contained in:
@@ -194,10 +194,26 @@ extern "C" {
|
||||
#define AD5934_TIME_PER_SWEEP 60 // 60 ms entre o início de cada sweep
|
||||
#define AD5934_TIME_MUX_SETTLING 10 // 10 ms de espera após trocar o MUX
|
||||
|
||||
#define AD5934_BURST_SIZE 7
|
||||
#define AD5934_BURST_SIZE 5
|
||||
#define AD5934_TRIM_COUNT 1
|
||||
#define AD5934_HISTORY_SIZE 8
|
||||
#define AD5934_IIR_ALPHA 0.25f
|
||||
#define AD5934_HISTORY_SIZE 6
|
||||
#define AD5934_IIR_ALPHA 0.4f
|
||||
|
||||
|
||||
#define AD5934_EC_FLOAT_SCALE_MIN 0.0f
|
||||
#define AD5934_EC_FLOAT_SCALE_MAX 15000.0f
|
||||
#define AD5934_EC_OUT_SCALE_MIN 0
|
||||
#define AD5934_EC_OUT_SCALE_MAX 4096
|
||||
|
||||
#define AD5934_REF_FLOAT_SCALE_MIN 1850.0f
|
||||
#define AD5934_REF_FLOAT_SCALE_MAX 2450.0f
|
||||
#define AD5934_REF_OUT_SCALE_MIN 0
|
||||
#define AD5934_REF_OUT_SCALE_MAX 4096
|
||||
|
||||
#define AD5934_RTD_FLOAT_SCALE_MIN 1850.0f
|
||||
#define AD5934_RTD_FLOAT_SCALE_MAX 2450.0f
|
||||
#define AD5934_RTD_OUT_SCALE_MIN 0
|
||||
#define AD5934_RTD_OUT_SCALE_MAX 4096
|
||||
|
||||
|
||||
|
||||
@@ -256,6 +272,7 @@ typedef enum {
|
||||
} AD5934_State_t;
|
||||
|
||||
|
||||
|
||||
typedef struct {
|
||||
float burst[AD5934_BURST_SIZE];
|
||||
uint8_t burst_index;
|
||||
@@ -290,6 +307,79 @@ static const uint8_t ADG715_Channel_Map[AD5934_CH_MAX] = {
|
||||
[AD5934_CH_EC_HIGH_GAIN] = (ADG715_SW3 | ADG715_SW8)
|
||||
};
|
||||
|
||||
static const float AD5934_Scale_Float_Min[AD5934_CH_MAX] = {
|
||||
AD5934_REF_FLOAT_SCALE_MIN,
|
||||
AD5934_REF_FLOAT_SCALE_MIN,
|
||||
AD5934_REF_FLOAT_SCALE_MIN,
|
||||
AD5934_REF_FLOAT_SCALE_MIN,
|
||||
AD5934_REF_FLOAT_SCALE_MIN,
|
||||
AD5934_REF_FLOAT_SCALE_MIN,
|
||||
AD5934_REF_FLOAT_SCALE_MIN,
|
||||
AD5934_REF_FLOAT_SCALE_MIN,
|
||||
AD5934_REF_FLOAT_SCALE_MIN,
|
||||
AD5934_RTD_FLOAT_SCALE_MIN,
|
||||
AD5934_RTD_FLOAT_SCALE_MIN,
|
||||
AD5934_RTD_FLOAT_SCALE_MIN,
|
||||
AD5934_EC_FLOAT_SCALE_MIN,
|
||||
AD5934_EC_FLOAT_SCALE_MIN,
|
||||
AD5934_EC_FLOAT_SCALE_MIN
|
||||
};
|
||||
|
||||
static const float AD5934_Scale_Float_Max[AD5934_CH_MAX] = {
|
||||
AD5934_REF_FLOAT_SCALE_MAX,
|
||||
AD5934_REF_FLOAT_SCALE_MAX,
|
||||
AD5934_REF_FLOAT_SCALE_MAX,
|
||||
AD5934_REF_FLOAT_SCALE_MAX,
|
||||
AD5934_REF_FLOAT_SCALE_MAX,
|
||||
AD5934_REF_FLOAT_SCALE_MAX,
|
||||
AD5934_REF_FLOAT_SCALE_MAX,
|
||||
AD5934_REF_FLOAT_SCALE_MAX,
|
||||
AD5934_REF_FLOAT_SCALE_MAX,
|
||||
AD5934_RTD_FLOAT_SCALE_MAX,
|
||||
AD5934_RTD_FLOAT_SCALE_MAX,
|
||||
AD5934_RTD_FLOAT_SCALE_MAX,
|
||||
AD5934_EC_FLOAT_SCALE_MAX,
|
||||
AD5934_EC_FLOAT_SCALE_MAX,
|
||||
AD5934_EC_FLOAT_SCALE_MAX
|
||||
};
|
||||
|
||||
static const uint16_t AD5934_Scale_Out_Min[AD5934_CH_MAX] = {
|
||||
AD5934_REF_OUT_SCALE_MIN,
|
||||
AD5934_REF_OUT_SCALE_MIN,
|
||||
AD5934_REF_OUT_SCALE_MIN,
|
||||
AD5934_REF_OUT_SCALE_MIN,
|
||||
AD5934_REF_OUT_SCALE_MIN,
|
||||
AD5934_REF_OUT_SCALE_MIN,
|
||||
AD5934_REF_OUT_SCALE_MIN,
|
||||
AD5934_REF_OUT_SCALE_MIN,
|
||||
AD5934_REF_OUT_SCALE_MIN,
|
||||
AD5934_RTD_OUT_SCALE_MIN,
|
||||
AD5934_RTD_OUT_SCALE_MIN,
|
||||
AD5934_RTD_OUT_SCALE_MIN,
|
||||
AD5934_EC_OUT_SCALE_MIN,
|
||||
AD5934_EC_OUT_SCALE_MIN,
|
||||
AD5934_EC_OUT_SCALE_MIN
|
||||
};
|
||||
|
||||
static const uint16_t AD5934_Scale_Out_Max[AD5934_CH_MAX] = {
|
||||
AD5934_REF_OUT_SCALE_MAX,
|
||||
AD5934_REF_OUT_SCALE_MAX,
|
||||
AD5934_REF_OUT_SCALE_MAX,
|
||||
AD5934_REF_OUT_SCALE_MAX,
|
||||
AD5934_REF_OUT_SCALE_MAX,
|
||||
AD5934_REF_OUT_SCALE_MAX,
|
||||
AD5934_REF_OUT_SCALE_MAX,
|
||||
AD5934_REF_OUT_SCALE_MAX,
|
||||
AD5934_REF_OUT_SCALE_MAX,
|
||||
AD5934_RTD_OUT_SCALE_MAX,
|
||||
AD5934_RTD_OUT_SCALE_MAX,
|
||||
AD5934_RTD_OUT_SCALE_MAX,
|
||||
AD5934_EC_OUT_SCALE_MAX,
|
||||
AD5934_EC_OUT_SCALE_MAX,
|
||||
AD5934_EC_OUT_SCALE_MAX
|
||||
};
|
||||
|
||||
|
||||
extern int16_t temperature_dut_samples[2][AD5934_TEMP_AVERAGES];
|
||||
extern int16_t temperature_ref_samples[2][AD5934_TEMP_AVERAGES];
|
||||
extern float temperature_display[AD5934_TEMP_AVERAGES];
|
||||
@@ -335,12 +425,16 @@ float AD5934_Get_Ref_Resistance(void);
|
||||
|
||||
float AD5934_GetTemperature(float mag_ref);
|
||||
|
||||
float AD5934_Calculate_Temperature(float mag_ref, float mag_dut);
|
||||
|
||||
float AD5934_GetImpedance(float temperature_dut);
|
||||
|
||||
float AD5934_GetMagnitude(void);
|
||||
|
||||
void AD5934_Wait_For_Data_Valid(void);
|
||||
|
||||
uint16_t AD5934_Compress_To_IntScale(float value, uint8_t scale);
|
||||
|
||||
float AD5934_Round_Float_Precision(float value, uint8_t number_of_decimals);
|
||||
|
||||
float AD5934_Linear_Correction(float raw_value);
|
||||
|
||||
@@ -130,8 +130,8 @@ extern "C" {
|
||||
|
||||
#define ADS1015_BURST_SIZE 5
|
||||
#define ADS1015_TRIM_COUNT 1
|
||||
#define ADS1015_HISTORY_SIZE 8
|
||||
#define ADS1015_IIR_ALPHA 0.3f
|
||||
#define ADS1015_HISTORY_SIZE 6
|
||||
#define ADS1015_IIR_ALPHA 0.4f
|
||||
|
||||
|
||||
|
||||
@@ -186,7 +186,7 @@ typedef struct {
|
||||
extern ADS1015_filter_t g_ph_filter;
|
||||
extern volatile uint32_t g_ms_counter; // Increment each 1ms Timer
|
||||
|
||||
void ADS1015(ADS1015_I2C* i2c, I2C_HandleTypeDef* hi2c, uint8_t i2cAddress);
|
||||
void ADS1015_Init(void);
|
||||
uint16_t ADSreadADC_SingleEnded(ADS1015_I2C* i2c, uint8_t channel);
|
||||
int16_t ADSreadADC_Differential_0_1(ADS1015_I2C* i2c);
|
||||
int16_t ADSreadADC_Differential_2_3(ADS1015_I2C* i2c);
|
||||
|
||||
@@ -150,6 +150,9 @@ uint32_t AD5934_ReadRegister(uint8_t regAddr, uint8_t numberOfBytes)
|
||||
******************************************************************************/
|
||||
void AD5934_Init(void)
|
||||
{
|
||||
|
||||
ADG715_ResetChannels(); // Disconnects Analog Switch on the CE / RTD / Ref Resistor
|
||||
|
||||
/************ Config Sweep******************/
|
||||
|
||||
// Place AD5934 in reset
|
||||
@@ -396,6 +399,49 @@ float AD5934_GetTemperature(float mag_ref)
|
||||
}
|
||||
|
||||
|
||||
/******************************************************************************
|
||||
* @brief Check if PT100 or PT1000 to Calculate Temperature.
|
||||
*
|
||||
* @param mag_ref - Magnitude of the Reference Resistor.
|
||||
*
|
||||
* @param mag_dut - Magnitude of the device under test.
|
||||
*
|
||||
* @return Temperature in Celsius.
|
||||
******************************************************************************/
|
||||
float AD5934_Calculate_Temperature(float mag_ref, float mag_dut)
|
||||
{
|
||||
uint8_t ch_ref;
|
||||
float gain_factor, impedance_dut, ratio, discriminant;
|
||||
|
||||
if(HAL_GPIO_ReadPin(GPIOA, GPIO_PIN_7) == GPIO_PIN_SET) // OFF = PT1000, ON = PT100, PA7 has internal pull-up and switch connects to GND
|
||||
{
|
||||
ch_ref = AD5934_CH_RTD_LOW_GAIN; //PT100
|
||||
gain_factor = AD5934_GAIN_FACTOR_100R;
|
||||
}
|
||||
else
|
||||
{
|
||||
ch_ref = AD5934_CH_RTD_MID_GAIN; //PT1000
|
||||
gain_factor = AD5934_GAIN_FACTOR_1K;
|
||||
}
|
||||
|
||||
float ratio_mag = mag_ref / mag_dut;
|
||||
|
||||
if(ch_ref==AD5934_CH_REF100R_LOW_GAIN) // only for PT100
|
||||
impedance_dut = AD5934_Linear_Correction(gain_factor * ratio_mag);
|
||||
else
|
||||
impedance_dut = gain_factor * ratio_mag;
|
||||
|
||||
// Calculate impedance ratio with the Reference Resistor
|
||||
ratio = impedance_dut / gain_factor;
|
||||
|
||||
// Calculate impedance discriminant with the ratio
|
||||
discriminant = (AD5934_RTD_A*AD5934_RTD_A)-(4.0f * AD5934_RTD_B * (1.0f - ratio));
|
||||
|
||||
return ((-AD5934_RTD_A + sqrtf(discriminant))/(2.0f * AD5934_RTD_B));
|
||||
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* @brief Calculates impedance and converts it to conductivity using a 2-point
|
||||
* temperature-compensated model.
|
||||
@@ -469,6 +515,9 @@ float AD5934_GetImpedance(float temperature_dut)
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/******************************************************************************
|
||||
* @brief Get Real and Imaginary values and calculate Magnitude.
|
||||
*
|
||||
@@ -524,6 +573,36 @@ void AD5934_Wait_For_Data_Valid(void)
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* @brief Converte um valor float em uma escala de FLOAT_MIN a FLOAT_MAX para uint16_t em escala de UINT16_MIN a UINT16_MAX
|
||||
*
|
||||
* @param value Valor float entre FLOAT_MIN e FLOAT_MAX
|
||||
* @param scale Escala de Ref Res, EC e RTD
|
||||
*
|
||||
* @return uint16_t Valor convertido na escala de UINT16_MIN a UINT16_MAX
|
||||
*/
|
||||
uint16_t AD5934_Compress_To_IntScale(float value, uint8_t scale)
|
||||
{
|
||||
// Proteção contra índice inválido para evitar HardFault
|
||||
if (scale >= AD5934_CH_MAX)
|
||||
return 0;
|
||||
|
||||
// Verifica limites do valor de entrada
|
||||
if (value < AD5934_Scale_Float_Min[scale])
|
||||
return AD5934_Scale_Out_Min[scale];
|
||||
else if (value > AD5934_Scale_Float_Max[scale])
|
||||
return AD5934_Scale_Out_Max[scale];
|
||||
|
||||
// Converte o valor usando a fórmula: ((value - FLOAT_MIN) / (FLOAT_MAX - FLOAT_MIN)) * (UINT16_MAX - UINT16_MIN) + UINT16_MIN
|
||||
uint16_t result = (uint16_t)(((value - AD5934_Scale_Float_Min[scale]) / (AD5934_Scale_Float_Max[scale] - AD5934_Scale_Float_Min[scale])) * ((float)AD5934_Scale_Out_Max[scale] - (float)AD5934_Scale_Out_Min[scale]) + (float)AD5934_Scale_Out_Min[scale]);
|
||||
|
||||
// Garante que o resultado não exceda o limite superior
|
||||
if (result > AD5934_Scale_Out_Max[scale])
|
||||
return (AD5934_Scale_Out_Max[scale]);
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* @brief Reduz a precisão decimal de um float através de truncamento.
|
||||
@@ -955,11 +1034,11 @@ void ADG715_Update(AD5934_Channel_t channel)
|
||||
ADG715_SetRegisterValue(ADG715_Channel_Map[channel]);
|
||||
|
||||
// Gestão inteligente do delay de acomodação
|
||||
if (channel >= AD5934_CH_EC_LOW_GAIN)
|
||||
/* if (channel >= AD5934_CH_EC_LOW_GAIN)
|
||||
HAL_Delay(20); // Canais de Condutividade Elétrica (CE) necessitam de maior estabilização química
|
||||
else
|
||||
HAL_Delay(10); // Resistores puros e RTD estabilizam mais rapidamente
|
||||
|
||||
*/
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -39,12 +39,13 @@ static void ADSbegin(ADS1015_I2C *i2c) {
|
||||
}
|
||||
|
||||
// Declare an ADS1015 structure
|
||||
void ADS1015(ADS1015_I2C *i2c, I2C_HandleTypeDef *hi2c, uint8_t i2cAddress) {
|
||||
i2c->hi2c = hi2c;
|
||||
i2c->m_i2cAddress = i2cAddress; // << 1; // It's Important to shift the address << 1
|
||||
i2c->m_conversionDelay = ADS1015_CONVERSIONDELAY;
|
||||
i2c->m_bitShift = 4;
|
||||
i2c->m_gain = GAIN_SIXTEEN; /* +/- 6.144V range (limited to VDD +0.3V max!) */
|
||||
void ADS1015_Init(void)
|
||||
{
|
||||
i2c_ads1015.hi2c = &hi2c1;
|
||||
i2c_ads1015.m_i2cAddress = ADS1015_ADDR_GND; // It's Important to shift the address << 1
|
||||
i2c_ads1015.m_conversionDelay = ADS1015_CONVERSIONDELAY;
|
||||
i2c_ads1015.m_bitShift = 4;
|
||||
i2c_ads1015.m_gain = GAIN_SIXTEEN; /* +/- 6.144V range (limited to VDD +0.3V max!) */
|
||||
//ADSbegin(i2c); //Ready is not used
|
||||
}
|
||||
|
||||
|
||||
+113
-105
@@ -69,7 +69,7 @@ uint8_t imag_text[6];
|
||||
uint8_t rs485_text[6];
|
||||
|
||||
|
||||
uint8_t newline[]={'\n','\0'};
|
||||
uint8_t newline[]={'\r','\n'};
|
||||
uint8_t doubleSpace[]={'_','_','\0'};
|
||||
uint8_t newline_ph[]={'_','p','H','\n','\0'};
|
||||
uint8_t newline_admi[]={'_','u','S','\n','\0'};
|
||||
@@ -95,8 +95,8 @@ float Temp_Samples[STM32_TEMPERATURE_AVERAGES]={0};
|
||||
/* Private function prototypes -----------------------------------------------*/
|
||||
void SystemClock_Config(void);
|
||||
/* USER CODE BEGIN PFP */
|
||||
void intToStr(int N, char *str);
|
||||
void FloatToString(char * buf, double val);
|
||||
void intToStr(int16_t N, uint8_t *str);
|
||||
void FloatToString(uint8_t * buf, double val);
|
||||
|
||||
/* USER CODE END PFP */
|
||||
|
||||
@@ -121,6 +121,8 @@ int main(void)
|
||||
uint8_t previous_green_state = 0;
|
||||
uint8_t previous_red_state = 0;
|
||||
|
||||
uint8_t mux_connection = 0;
|
||||
|
||||
// Variables for timing
|
||||
uint32_t previous_millis_green = 0;
|
||||
uint32_t previous_millis_red = 0;
|
||||
@@ -132,7 +134,7 @@ int main(void)
|
||||
|
||||
|
||||
/*! Temporary variables */
|
||||
uint8_t tempString[10] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
|
||||
uint8_t tempString[15] = {0};
|
||||
|
||||
uint8_t i;
|
||||
|
||||
@@ -182,20 +184,13 @@ int main(void)
|
||||
|
||||
digital_outputs_init();
|
||||
|
||||
// Initialize RS-485 driver
|
||||
|
||||
rs485_init();
|
||||
|
||||
|
||||
ADS1015(&i2c_ads1015, &hi2c1, ADS1015_ADDR_GND);
|
||||
//ADSsetGain(&i2c_ads1015, GAIN_FOUR);
|
||||
ADS1015_Init(); // Initializes pH Measurement
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
ADG715_ResetChannels();
|
||||
// Start CE and RTD Measurement
|
||||
AD5934_Init();
|
||||
AD5934_Init(); // Initializes CE and RTD Measurement
|
||||
|
||||
|
||||
|
||||
@@ -290,33 +285,74 @@ int main(void)
|
||||
current_millis = g_ms_counter;
|
||||
|
||||
|
||||
if((current_millis % 100) == 0) // Send data each 50ms
|
||||
{
|
||||
|
||||
|
||||
if (g_ref_filter.value_valid) // Reference Resistor on Board: 100 Ohms or 1000 Ohms
|
||||
{
|
||||
if(HAL_GPIO_ReadPin(GPIOA, GPIO_PIN_7) == GPIO_PIN_SET) // OFF = PT1000, ON = PT100, PA7 has internal pull-up and switch connects to GND
|
||||
mux_connection = AD5934_CH_REF100R_LOW_GAIN; // 100 Ohms Reference Resistor
|
||||
else
|
||||
mux_connection = AD5934_CH_REF1K_MID_GAIN; // 1K Reference Resistor
|
||||
|
||||
uint16_t reference_final = AD5934_REF_OUT_SCALE_MAX - AD5934_Compress_To_IntScale(g_ref_filter.filtered_value, mux_connection);
|
||||
intToStr(reference_final, tempString);
|
||||
// float ref_final = g_ref_filter.filtered_value;
|
||||
//FloatToString(tempString, ref_final);
|
||||
rs485_send_broadcast(tempString, (strlen((uint8_t*)tempString)));
|
||||
rs485_send_broadcast(newline, (strlen((uint8_t*)newline)));
|
||||
}
|
||||
|
||||
if (g_ec_filter.value_valid) // EC
|
||||
{
|
||||
if(HAL_GPIO_ReadPin(GPIOA, GPIO_PIN_6) == GPIO_PIN_SET) // Hardware Setup: Gain Selection (PA6)
|
||||
mux_connection = AD5934_CH_EC_HIGH_GAIN;
|
||||
else
|
||||
mux_connection = AD5934_CH_EC_MID_GAIN;
|
||||
|
||||
uint16_t ec_final = AD5934_Compress_To_IntScale(g_ec_filter.filtered_value, mux_connection);
|
||||
intToStr(ec_final, tempString);
|
||||
/* float ec_final = g_ec_filter.filtered_value;
|
||||
FloatToString(tempString, ec_final);*/
|
||||
rs485_send_broadcast(tempString, (strlen((uint8_t*)tempString)));
|
||||
rs485_send_broadcast(newline, (strlen((uint8_t*)newline)));
|
||||
}
|
||||
|
||||
if (g_rtd_filter.value_valid) // PT100 or PT1000 in °C
|
||||
{
|
||||
if(HAL_GPIO_ReadPin(GPIOA, GPIO_PIN_7) == GPIO_PIN_SET) // OFF = PT1000, ON = PT100, PA7 has internal pull-up and switch connects to GND
|
||||
mux_connection = AD5934_CH_RTD_LOW_GAIN; //PT100
|
||||
else
|
||||
mux_connection = AD5934_CH_RTD_MID_GAIN; //PT1000
|
||||
|
||||
uint16_t rtd_final = AD5934_RTD_OUT_SCALE_MAX - AD5934_Compress_To_IntScale(g_rtd_filter.filtered_value, mux_connection);
|
||||
intToStr(rtd_final, tempString);
|
||||
// float rtd_final = g_rtd_filter.filtered_value;
|
||||
// FloatToString(tempString, rtd_final);
|
||||
rs485_send_broadcast(tempString, (strlen((uint8_t*)tempString)));
|
||||
rs485_send_broadcast(newline, (strlen((uint8_t*)newline)));
|
||||
}
|
||||
|
||||
if (g_ph_filter.value_valid) // pH
|
||||
{
|
||||
float ph_final = g_ph_filter.filtered_value;
|
||||
FloatToString(tempString, ph_final);
|
||||
rs485_send_broadcast(tempString, (strlen((uint8_t*)tempString)));
|
||||
rs485_send_broadcast(newline, (strlen((uint8_t*)newline)));
|
||||
}
|
||||
|
||||
rs485_send_broadcast(newline, (strlen((uint8_t*)newline)));
|
||||
|
||||
}
|
||||
|
||||
|
||||
// Piscar LED verde em PB5 a cada 0,5 segundos
|
||||
if ((current_millis - previous_millis_green) >= 500)
|
||||
{
|
||||
previous_millis_green = current_millis;
|
||||
HAL_GPIO_TogglePin(GPIOB, GPIO_PIN_5);
|
||||
|
||||
// Check if state changed and send via RS485
|
||||
uint8_t current_green_state = HAL_GPIO_ReadPin(GPIOB, GPIO_PIN_5);
|
||||
if (current_green_state != previous_green_state)
|
||||
{
|
||||
previous_green_state = current_green_state;
|
||||
uint8_t led_data[2] = {0x01, current_green_state}; // Command 0x01 for green LED
|
||||
|
||||
}
|
||||
/*
|
||||
status1 = rs485_send_broadcast(ph_t, strlen((char*)ph_t));
|
||||
|
||||
|
||||
ph_compensated = ADSCalculate_ph_mV() ;
|
||||
|
||||
|
||||
FloatToString(tempString, ph_compensated);
|
||||
status0 = rs485_send_broadcast(tempString, (strlen((char*)tempString)-1));
|
||||
status1 = rs485_send_broadcast(newline_ph, strlen((char*)newline_ph));
|
||||
|
||||
*/
|
||||
|
||||
}
|
||||
|
||||
// Piscar LED vermelho em PB4 a cada 1 segundo
|
||||
@@ -325,54 +361,6 @@ int main(void)
|
||||
previous_millis_red = current_millis;
|
||||
HAL_GPIO_TogglePin(GPIOB, GPIO_PIN_4);
|
||||
|
||||
// Check if state changed and send via RS485
|
||||
uint8_t current_red_state = HAL_GPIO_ReadPin(GPIOB, GPIO_PIN_4);
|
||||
if (current_red_state != previous_red_state)
|
||||
{
|
||||
previous_red_state = current_red_state;
|
||||
uint8_t led_data[2] = {0x02, current_red_state}; // Command 0x02 for red LED
|
||||
|
||||
}
|
||||
|
||||
|
||||
if (g_rtd_filter.value_valid)
|
||||
{
|
||||
float rtd_final = g_rtd_filter.filtered_value;
|
||||
|
||||
status1 = rs485_send_broadcast(tm_t, strlen((char*)tm_t));
|
||||
//temperature_RTD = AD5934_GetTemperature(refResistance);
|
||||
FloatToString(tempString, rtd_final);
|
||||
status0 = rs485_send_broadcast(tempString, (strlen((char*)tempString)-1));
|
||||
status1 = rs485_send_broadcast(newline_temp, strlen((char*)newline_temp));
|
||||
}
|
||||
|
||||
if (g_ec_filter.value_valid)
|
||||
{
|
||||
float ec_final = g_ec_filter.filtered_value;
|
||||
status1 = rs485_send_broadcast(ad_t, strlen((char*)ad_t));
|
||||
//admittance_EC = AD5934_GetImpedance(temperature_RTD);
|
||||
FloatToString(tempString, ec_final);
|
||||
status0 = rs485_send_broadcast(tempString, (strlen((char*)tempString)-1));
|
||||
status1 = rs485_send_broadcast(newline_admi, strlen((char*)newline_admi));
|
||||
}
|
||||
|
||||
if (g_ref_filter.value_valid)
|
||||
{
|
||||
//float reference_final = g_ref_filter.filtered_value;
|
||||
status1 = rs485_send_broadcast(ph_t, strlen((char*)ph_t));
|
||||
ph_compensated = g_ph_filter.filtered_value;
|
||||
FloatToString(tempString, ph_compensated);
|
||||
|
||||
status0 = rs485_send_broadcast(tempString, (strlen((char*)tempString)-1));
|
||||
status1 = rs485_send_broadcast(newline_ph, strlen((char*)newline_ph));
|
||||
|
||||
status1 = rs485_send_broadcast(newline, strlen((char*)newline));
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
@@ -469,7 +457,7 @@ void SystemClock_Config(void)
|
||||
*
|
||||
* @return None.
|
||||
*******************************************************************************/
|
||||
void FloatToString(char *buf, double val)
|
||||
void FloatToString(uint8_t *buf, double val)
|
||||
{
|
||||
char temp[20]; // Buffer auxiliar para construção segura
|
||||
int i = 0;
|
||||
@@ -531,38 +519,58 @@ void FloatToString(char *buf, double val)
|
||||
|
||||
|
||||
|
||||
void intToStr(int N, char *str) {
|
||||
int i = 0;
|
||||
void intToStr(int16_t N, uint8_t *str)
|
||||
{
|
||||
int16_t i = 0;
|
||||
int16_t sign = N;
|
||||
uint8_t max_len = 15; // Tamanho máximo do buffer
|
||||
uint8_t width = 4; // mínimo 4 caracteres
|
||||
|
||||
// Save the copy of the number for sign
|
||||
int sign = N;
|
||||
// Trata o caso do número zero isoladamente
|
||||
if (N == 0)
|
||||
{
|
||||
// Preenche com zeros à esquerda até atingir a largura desejada
|
||||
while (width > 1 && i < (max_len - 1))
|
||||
{
|
||||
str[i++] = '0';
|
||||
width--;
|
||||
}
|
||||
str[i++] = '0';
|
||||
str[i] = '\0';
|
||||
return;
|
||||
}
|
||||
|
||||
// If the number is negative, make it positive
|
||||
if (N < 0)
|
||||
N = -N;
|
||||
|
||||
// Extract digits from the number and add them to the
|
||||
// string
|
||||
while (N > 0) {
|
||||
|
||||
// Convert integer digit to character and store
|
||||
// it in the str
|
||||
str[i++] = N % 10 + '0';
|
||||
N /= 10;
|
||||
// Extração dos dígitos
|
||||
while (N > 0)
|
||||
{
|
||||
if (i >= (max_len - 1))
|
||||
break; // Proteção de estouro
|
||||
str[i++] = (N % 10) + '0';
|
||||
N /= 10;
|
||||
}
|
||||
|
||||
// If the number was negative, add a minus sign to the
|
||||
// string
|
||||
if (sign < 0) {
|
||||
str[i++] = '-';
|
||||
// Adiciona o sinal de menos se necessário
|
||||
if (sign < 0)
|
||||
{
|
||||
if (i < (max_len - 1))
|
||||
str[i++] = '-';
|
||||
}
|
||||
|
||||
// Preenche com zeros à esquerda (considerando o espaço ocupado pelos dígitos e sinal)
|
||||
while (i < width && i < (max_len - 1))
|
||||
{
|
||||
str[i++] = '0';
|
||||
}
|
||||
|
||||
// Null-terminate the string
|
||||
str[i] = '\0';
|
||||
|
||||
// Reverse the string to get the correct order
|
||||
for (int j = 0, k = i - 1; j < k; j++, k--) {
|
||||
char temp = str[j];
|
||||
// Inverte a string para colocar na ordem correta
|
||||
for (uint8_t j = 0, k = i - 1; j < k; j++, k--)
|
||||
{
|
||||
uint8_t temp = str[j];
|
||||
str[j] = str[k];
|
||||
str[k] = temp;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user