| 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 | // Formel zur Berechnen der Eingangsspannung
|
|---|
| 23 | // Da ein Spannungteiler mit Offset genutzt wird muss die gemessene Spannung korrigiert werden
|
|---|
| 24 | // R14 bis R19 sind die Wiederstände auf der Platine die Formel findet sich unter folgendem Link:
|
|---|
| 25 | // https://www.mikrocontroller.net/articles/Spannungsteiler#Spannungsteiler_mit_Offset.2C_passiv
|
|---|
| 26 | // Widerstände auf der Platine sind um den Faktor 1000 größer
|
|---|
| 27 | #define I_SENSE_GAIN 40.0
|
|---|
| 28 |
|
|---|
| 29 |
|
|---|
| 30 | #if (DEVICETYPE == 500)
|
|---|
| 31 | #define SHUNT_RESISTOR 0.000125
|
|---|
| 32 | #elif (DEVICETYPE == 250)
|
|---|
| 33 | #define SHUNT_RESISTOR 0.000250
|
|---|
| 34 | #elif (DEVICETYPE == 125)
|
|---|
| 35 | #define SHUNT_RESISTOR 0.000500
|
|---|
| 36 | #else
|
|---|
| 37 | #error No valid device type
|
|---|
| 38 | #endif
|
|---|
| 39 |
|
|---|
| 40 |
|
|---|
| 41 |
|
|---|
| 42 |
|
|---|
| 43 |
|
|---|
| 44 | // --- LOKALE TYPE DEFS - bitte hier dokumentieren-------------------------------
|
|---|
| 45 |
|
|---|
| 46 | // --- DEFINITIONEN GLOBALER VARIABLEN - Bitte in Header dokumentieren ----------
|
|---|
| 47 |
|
|---|
| 48 | // --- LOKALE VARIABLEN - bitte hier dokumentieren ------------------------------
|
|---|
| 49 |
|
|---|
| 50 | // --- LOKALE FUNKTIONS PROTOTYPEN ----------------------------------------------
|
|---|
| 51 |
|
|---|
| 52 | // --- LOKALE FUNKTIONEN - bitte hier dokumentieren -----------------------------
|
|---|
| 53 |
|
|---|
| 54 | // --- GLOBALE FUNKTIONEN - bitte in Header dokumentieren------------------------
|
|---|
| 55 |
|
|---|
| 56 |
|
|---|
| 57 | void FAST_CURRENT_Exec(uint32_t newvalP, uint32_t newvalM )
|
|---|
| 58 | {
|
|---|
| 59 | static int measCounter;
|
|---|
| 60 | static unsigned long avgsumP = 0;
|
|---|
| 61 | uint32_t avgvalP;
|
|---|
| 62 |
|
|---|
| 63 | if (measCounter < INT32_MAX) measCounter++;
|
|---|
| 64 |
|
|---|
| 65 |
|
|---|
| 66 | // Filterlängen in 2er-Potenzen --> Compiler optimiert
|
|---|
| 67 | // avgsumP -= avgsumP / FAST_CURRENT_FILTER;
|
|---|
| 68 | // avgsumP += newvalP;
|
|---|
| 69 | // avgvalP = avgsumP / FAST_CURRENT_FILTER;
|
|---|
| 70 |
|
|---|
| 71 | // static unsigned long avgsumM = 0;
|
|---|
| 72 | // uint32_t avgvalM;
|
|---|
| 73 | // Filterlängen in 2er-Potenzen --> Compiler optimiert
|
|---|
| 74 | // avgsumM -= avgsumM / FAST_CURRENT_FILTER;
|
|---|
| 75 | // avgsumM += newvalM;
|
|---|
| 76 | // avgvalM = avgsumM / FAST_CURRENT_FILTER;
|
|---|
| 77 |
|
|---|
| 78 |
|
|---|
| 79 | //Berechne Differenzspannung am ADC Eingnag
|
|---|
| 80 | double diff;
|
|---|
| 81 | diff = (int32_t) newvalP - (int32_t) newvalM;
|
|---|
| 82 | diff = (diff * sys_data.s.values.realVdd) / 655350.0;
|
|---|
| 83 |
|
|---|
| 84 | //Umrechung auf Strom
|
|---|
| 85 | sys_data.s.values.fast_current = (diff / I_SENSE_GAIN) / SHUNT_RESISTOR;
|
|---|
| 86 |
|
|---|
| 87 |
|
|---|
| 88 | }
|
|---|
| 89 |
|
|---|
| 90 | /*************************** End of file ****************************/
|
|---|
