SNS - Inverter Current

lib/sensors/adc_mux.hpp

@@ -1,5 +1,7 @@
 #pragma once
 
+#include <cstdint>
+
 namespace hyped::sensors {
 
 constexpr std::uint8_t kAdcMuxAddress  = 0x1D;

lib/sensors/inverter_current.cpp

@@ -0,0 +1,39 @@
+#include "adc_mux.hpp"
+
+#include <inverter_current.hpp>
+
+namespace hyped::sensors {
+
+std::optional<InverterCurrent> InverterCurrent::create(core::ILogger &logger,
+                                                       std::shared_ptr<io::II2c> i2c,
+                                                       const std::uint8_t adc_mux_channel)
+{
+  return InverterCurrent(logger, i2c, adc_mux_channel);
+}
+
+InverterCurrent::InverterCurrent(core::ILogger &logger,
+                                 std::shared_ptr<io::II2c> i2c,
+                                 const std::uint8_t adc_mux_channel)
+    : logger_(logger),
+      i2c_(i2c),
+      adc_mux_channel_(adc_mux_channel)
+{
+}
+
+InverterCurrent::~InverterCurrent()
+{
+}
+
+std::optional<core::Float> InverterCurrent::readCurrent()
+{
+  const auto inverter_current = i2c_->readByte(kAdcMuxAddress, adc_mux_channel_);
+  if (!inverter_current) {
+    logger_.log(core::LogLevel::kFatal, "Failed to read inverter current");
+    return std::nullopt;
+  }
+  logger_.log(core::LogLevel::kDebug, "Successfully read inverter current");
+  // Output is 0-5V, which corresponds to 50-130A
+  return static_cast<core::Float>(*inverter_current) * 16 + 50;
+}
+
+}  // namespace hyped::sensors

lib/sensors/inverter_current.hpp

@@ -0,0 +1,33 @@
+#pragma once
+
+#include <cstdint>
+#include <memory>
+#include <optional>
+
+#include <core/logger.hpp>
+#include <core/types.hpp>
+#include <io/i2c.hpp>
+
+namespace hyped::sensors {
+
+class InverterCurrent {
+ public:
+  static std::optional<InverterCurrent> create(core::ILogger &logger,
+                                               std::shared_ptr<io::II2c> i2c,
+                                               const std::uint8_t adc_mux_channel);
+  ~InverterCurrent();
+
+  std::optional<core::Float> readCurrent();
+
+ private:
+  InverterCurrent(core::ILogger &logger,
+                  std::shared_ptr<io::II2c> i2c,
+                  const std::uint8_t adc_mux_channel);
+
+ private:
+  core::ILogger &logger_;
+  std::shared_ptr<io::II2c> i2c_;
+  const std::uint8_t adc_mux_channel_;
+};
+
+}  // namespace hyped::sensors