From 1ebb2bebc50fe0459e73bfc8af487d3e7434775a Mon Sep 17 00:00:00 2001
From: bharmai <86177994+bharmai@users.noreply.github.com>
Date: Fri, 18 Oct 2024 16:35:57 -0400
Subject: [PATCH] Update AMSInterface.cpp

Implemented the initialize_charge() function
---
 lib/interfaces/src/AMSInterface.cpp | 13 +++++++++++--
 1 file changed, 11 insertions(+), 2 deletions(-)

diff --git a/lib/interfaces/src/AMSInterface.cpp b/lib/interfaces/src/AMSInterface.cpp
index 0d3e96826..814d346d7 100644
--- a/lib/interfaces/src/AMSInterface.cpp
+++ b/lib/interfaces/src/AMSInterface.cpp
@@ -87,14 +87,23 @@ float AMSInterface::initialize_charge() {
     // Step 3: Use the lowest voltage with the defined VOLTAGE_LOOKUP_TABLE
     //         to determine the approximate percentage charge of the
     //         accumulator.
+    float temp_low = HYTECH_low_voltage_ro_fromS(bms_voltages_.low_voltage_ro);
+    int i;
 
-    // Step 4: Initialize the charge_ member variable to the current charge
+    for(i = 0; temp_low < VOLTAGE_LOOKUP_TABLE[i]; i++) {
 
+    }
+    
+
+    charge_ = ((100-i)/100.0) * MAX_PACK_CHARGE; 
     // Step 5: Initialize the SoC_ member variable.
+    
+    SoC_ = (charge_/MAX_PACK_CHARGE) * 100;
 
     // Step 6: Return the current charge, according to the specifications.
+       
+    return charge_; // TODO: Return the real value
 
-    return 0; // TODO: Return the real value
     
 }