MemoryFirmware.hpp

Go to the documentation of this file.

#pragma once
#include "HcBin.h"
#include <cstdint>
#include <cstring>
 
class MemoryFirmware {
public:
  MemoryFirmware(const uint8_t* data, uint32_t len, const char* format = "BNO_V1",
                 const char* part = "unknown", uint32_t packet_len = 0)
      : data_(data), len_(len), format_(format), part_(part), packet_len_(packet_len) {}
 
  const HcBin_t& hcbin() const {
    pending_ = this;
    return impl_;
  }
 
private:
  static int open();
  static int close();
  static const char* getMeta(const char* key);
  static uint32_t getAppLen();
  static uint32_t getPacketLen();
  static int getAppData(uint8_t* packet, uint32_t offset, uint32_t len);
 
  static const HcBin_t impl_;
  static thread_local const MemoryFirmware* pending_;
  static thread_local const MemoryFirmware* active_;
 
  const uint8_t* data_;
  uint32_t len_;
  const char* format_;
  const char* part_;
  uint32_t packet_len_;
};
 
// --- Implementation ---------------------------------------------------------
 
inline int MemoryFirmware::open() {
  if (active_ != nullptr) {
    return -1;
  }
  if (pending_ == nullptr) {
    return -1;
  }
  active_ = pending_;
  pending_ = nullptr;
  return 0;
}
inline int MemoryFirmware::close() {
  active_ = nullptr;
  pending_ = nullptr;
  return 0;
}
inline const char* MemoryFirmware::getMeta(const char* key) {
  if (!active_)
    return nullptr;
  if (std::strcmp(key, "FW-Format") == 0)
    return active_->format_;
  if (std::strcmp(key, "SW-Part-Number") == 0)
    return active_->part_;
  return nullptr;
}
inline uint32_t MemoryFirmware::getAppLen() {
  return active_ ? active_->len_ : 0;
}
inline uint32_t MemoryFirmware::getPacketLen() {
  return active_ ? active_->packet_len_ : 0;
}
inline int MemoryFirmware::getAppData(uint8_t* packet, uint32_t offset, uint32_t len) {
  if (!active_ || offset > active_->len_ || len > (active_->len_ - offset))
    return -1;
  std::memcpy(packet, active_->data_ + offset, len);
  return 0;
}
 
inline const HcBin_t MemoryFirmware::impl_ = {
    MemoryFirmware::open,      MemoryFirmware::close,        MemoryFirmware::getMeta,
    MemoryFirmware::getAppLen, MemoryFirmware::getPacketLen, MemoryFirmware::getAppData};
inline thread_local const MemoryFirmware* MemoryFirmware::pending_ = nullptr;
inline thread_local const MemoryFirmware* MemoryFirmware::active_ = nullptr;