add voltage and current measurement

This commit is contained in:
interfisch 2019-06-05 14:50:42 +02:00
parent 886ecc5b7a
commit 03b600d4c8
1 changed files with 26 additions and 0 deletions

View File

@ -14,6 +14,17 @@ uint8_t imu_no_change_counter = 0;
#define PIN_LED PC13
#define PIN_VBAT PA0 //battery voltage after voltage divider
#define VBAT_DIV_FACTOR 0.010700 //how much voltage (V) equals one adc unit. measured at 40V and averaged
#define PIN_CURRENT PA1 //output of hall sensor for current measurement
#define CURRENT_OFFSET 2034 //adc reading at 0A, with CJMCU-758 typically at Vcc/2
#define CURRENT_FACTOR 0.4320376 //how much current (A) equals one adc unit
double vbat=0; //battery voltage
double ibat=0; //battery current
long last_uiupdated=0;
#define UI_UPDATEPERIOD 10 //in ms
#define SENDPERIOD 20 //ms
#define CONTROLUPDATEPERIOD 10
@ -104,6 +115,10 @@ void setup() {
digitalWrite(PIN_LED, HIGH);
pinMode(PIN_VBAT,INPUT_ANALOG);
pinMode(PIN_CURRENT,INPUT_ANALOG);
Serial.println("Initializing nrf24");
radio.begin();
@ -135,6 +150,17 @@ void loop() {
last_imuupdated = millis();
}
if (millis() - last_uiupdated > UI_UPDATEPERIOD) { //update current and voltage
vbat=analogRead(PIN_VBAT)*VBAT_DIV_FACTOR;
ibat=(analogRead(PIN_CURRENT)-CURRENT_OFFSET)*CURRENT_FACTOR;
last_uiupdated = millis();
/*
Serial.print("vbat=");
Serial.print(vbat);
Serial.print(", ibat=");
Serial.println(ibat);*/
}
//NRF24
nrf_delay = millis() - last_nrfreceive; //update nrf delay
if ( radio.available() )