A new forlder for embedded software in our common structure

1 files changed, 46 insertions, 0 deletions

diff --git a/Software/Embedded_SW/Embedded/Modules/IDS/IDS_init.c b/Software/Embedded_SW/Embedded/Modules/IDS/IDS_init.c
new file mode 100644
index 000000000..0294615b6
--- /dev/null
+++ b/Software/Embedded_SW/Embedded/Modules/IDS/IDS_init.c
@@ -0,0 +1,46 @@
+/************************************************************************************************************************
+ **************************************************************************************************************************/
+
+#include "include.h"
+
+#include <Modules/Stubs_Handler/DataDef.h>
+
+#include "ids.h"
+#include "PMR/common/MessageContainer.pb-c.h"
+#include "PMR/Hardware/HardwareDispenser.pb-c.h"
+
+
+DispenserConfigStruc DispensersCfg[ MAX_SYSTEM_DISPENSERS];
+
+
+
+uint32_t DispenserConfigMessage(HardwareDispenser * request)
+{
+    uint32_t status = PASSED;
+    int Dispenser_i;
+
+    Dispenser_i = request->hardwaredispensertype;
+    if ((Dispenser_i)&&(Dispenser_i< MAX_SYSTEM_DISPENSERS))
+    {
+
+        DispensersCfg[Dispenser_i].id               = request->hardwaredispensertype;
+        DispensersCfg[Dispenser_i].minfrequency          = request->minfrequency;
+        DispensersCfg[Dispenser_i].maxfrequency          = request->maxfrequency;
+        DispensersCfg[Dispenser_i].minmicrostep     = request->minmicrostep;
+        DispensersCfg[Dispenser_i].maxmicrostep     = request->maxmicrostep;
+        DispensersCfg[Dispenser_i].correctiongain   = request->correctiongain;
+        DispensersCfg[Dispenser_i].ratiotodryerspeed  = request->ratiotodryerspeed;
+        DispensersCfg[Dispenser_i].kp               = request->kp;
+        DispensersCfg[Dispenser_i].ki               = request->ki;
+        DispensersCfg[Dispenser_i].kd               = request->kd;
+        DispensersCfg[Dispenser_i].changeslope      = request->changeslope;
+        DispensersCfg[Dispenser_i].highlengthmicrosecond   = request->highlengthmicrosecond;
+        DispensersCfg[Dispenser_i].dispensercapacity= request->capacity;
+//        DispensersCfg[Dispenser_i].midtankcapacity  = request->midtankcapacity;
+        DispensersCfg[Dispenser_i].nlperpulse   = request->nlperpulse;
+        DispensersCfg[Dispenser_i].controltiming    = request->controltiming;
+        return status;
+    }
+    else return Dispenser_i;
+
+}