| 1 | /****************************************************************************** |
|---|
| 2 | * |
|---|
| 3 | * @file fast_current.c |
|---|
| 4 | * @author ECS, Falko Jahn |
|---|
| 5 | * @version V1.0.0 |
|---|
| 6 | * @date 2022-01-16 |
|---|
| 7 | * @brief |
|---|
| 8 | * |
|---|
| 9 | ******************************************************************************/ |
|---|
| 10 | |
|---|
| 11 | // --- INCLUDES ----------------------------------------------------------------- |
|---|
| 12 | #include "fast_current.h" |
|---|
| 13 | #include "main.h" |
|---|
| 14 | #include "sysdata.h" |
|---|
| 15 | |
|---|
| 16 | // --- EXTERNE VARIABLEN -------------------------------------------------------- |
|---|
| 17 | |
|---|
| 18 | // --- LOKALE DEFINES - bitte hier dokumentieren -------------------------------- |
|---|
| 19 | //#define FAST_CURRENT_FILTER 2 |
|---|
| 20 | |
|---|
| 21 | |
|---|
| 22 | |
|---|
| 23 | #define I_SENSE_GAIN 40.0 |
|---|
| 24 | |
|---|
| 25 | |
|---|
| 26 | #if (DEVICETYPE == 500) |
|---|
| 27 | #define SHUNT_RESISTOR 0.000125 |
|---|
| 28 | #elif (DEVICETYPE == 250) |
|---|
| 29 | #define SHUNT_RESISTOR 0.000250 |
|---|
| 30 | #elif (DEVICETYPE == 125) |
|---|
| 31 | #define SHUNT_RESISTOR 0.000500 |
|---|
| 32 | #else |
|---|
| 33 | #error No valid device type |
|---|
| 34 | #endif |
|---|
| 35 | |
|---|
| 36 | |
|---|
| 37 | |
|---|
| 38 | |
|---|
| 39 | |
|---|
| 40 | // --- LOKALE TYPE DEFS - bitte hier dokumentieren------------------------------- |
|---|
| 41 | |
|---|
| 42 | // --- DEFINITIONEN GLOBALER VARIABLEN - Bitte in Header dokumentieren ---------- |
|---|
| 43 | |
|---|
| 44 | // --- LOKALE VARIABLEN - bitte hier dokumentieren ------------------------------ |
|---|
| 45 | |
|---|
| 46 | // --- LOKALE FUNKTIONS PROTOTYPEN ---------------------------------------------- |
|---|
| 47 | |
|---|
| 48 | // --- LOKALE FUNKTIONEN - bitte hier dokumentieren ----------------------------- |
|---|
| 49 | |
|---|
| 50 | // --- GLOBALE FUNKTIONEN - bitte in Header dokumentieren------------------------ |
|---|
| 51 | |
|---|
| 52 | |
|---|
| 53 | void FAST_CURRENT_Exec(uint32_t newvalP, uint32_t newvalM ) |
|---|
| 54 | { |
|---|
| 55 | static int measCounter; |
|---|
| 56 | static unsigned long avgsumP = 0; |
|---|
| 57 | uint32_t avgvalP; |
|---|
| 58 | |
|---|
| 59 | if (measCounter < INT32_MAX) measCounter++; |
|---|
| 60 | |
|---|
| 61 | |
|---|
| 62 | // Filterlängen in 2er-Potenzen --> Compiler optimiert |
|---|
| 63 | // avgsumP -= avgsumP / FAST_CURRENT_FILTER; |
|---|
| 64 | // avgsumP += newvalP; |
|---|
| 65 | // avgvalP = avgsumP / FAST_CURRENT_FILTER; |
|---|
| 66 | |
|---|
| 67 | // static unsigned long avgsumM = 0; |
|---|
| 68 | // uint32_t avgvalM; |
|---|
| 69 | // Filterlängen in 2er-Potenzen --> Compiler optimiert |
|---|
| 70 | // avgsumM -= avgsumM / FAST_CURRENT_FILTER; |
|---|
| 71 | // avgsumM += newvalM; |
|---|
| 72 | // avgvalM = avgsumM / FAST_CURRENT_FILTER; |
|---|
| 73 | |
|---|
| 74 | |
|---|
| 75 | //Berechne Differenzspannung am ADC Eingnag |
|---|
| 76 | double diff; |
|---|
| 77 | diff = (int32_t) newvalP - (int32_t) newvalM; |
|---|
| 78 | diff = (diff * sys_data.s.values.realVdd) / 65536; |
|---|
| 79 | |
|---|
| 80 | //Umrechung auf Strom |
|---|
| 81 | double temp_current; |
|---|
| 82 | temp_current = (diff / I_SENSE_GAIN) / SHUNT_RESISTOR; |
|---|
| 83 | sys_data.s.values.fast_current = temp_current * (sys_data.s.parameter.batteryCurrentGainCorrectionFaktor / 1000000.0); |
|---|
| 84 | |
|---|
| 85 | } |
|---|
| 86 | |
|---|
| 87 | /*************************** End of file ****************************/ |
|---|
