snapshot.cpp

Go to the documentation of this file.

#ifdef USE_HOST
#include "snapshot.h"
#include "esphome/core/log.h"
 
#include <fcntl.h>
#include <strings.h>
#include <unistd.h>
#include <cctype>
#include <cerrno>
#include <cstdio>
#include <cstring>
#include <ctime>
#include <filesystem>
#include <memory>
 
namespace esphome::snapshot {
 
namespace {
 
constexpr const char *const TAG = "snapshot";
 
// Longest name we will build a path from. NAME_MAX is 255 and we may append a collision suffix.
constexpr size_t MAX_NAME_LENGTH = 200;
// Give up rather than spin forever if every candidate name is taken.
constexpr unsigned MAX_NAME_ATTEMPTS = 1000;
// A BMP file header followed by a BITMAPINFOHEADER, which is where the pixels start.
constexpr size_t BMP_HEADER_SIZE = 54;
constexpr size_t BMP_INFO_HEADER_SIZE = 40;
constexpr int BMP_BITS_PER_PIXEL = 24;
 
bool has_bmp_suffix(const std::string &name) {
  return name.size() >= 4 && strcasecmp(name.c_str() + name.size() - 4, ".bmp") == 0;
}
 
std::string sanitise_filename(const char *const name, bool *name_changed) {
  std::string result;
  bool all_dots = true;
  bool changed = false;
  for (const char *p = name; *p != '\0'; p++) {
    if (result.size() >= MAX_NAME_LENGTH) {
      changed = true;
      break;
    }
    char c = *p;
    if (!(std::isalnum(static_cast<unsigned char>(c)) || c == '.' || c == '_' || c == '-')) {
      c = '_';
      changed = true;
    }
    if (c != '.')
      all_dots = false;
    result.push_back(c);
  }
  if (all_dots) {
    *name_changed = true;
    return "";
  }
  if (!has_bmp_suffix(result))
    result += ".bmp";
  *name_changed = changed;
  return result;
}
 
std::string add_suffix(const std::string &name, unsigned attempt) {
  char suffix[12];
  snprintf(suffix, sizeof(suffix), "-%u", attempt);
  auto dot = name.rfind('.');
  if (dot == std::string::npos)
    return name + suffix;
  return name.substr(0, dot) + suffix + name.substr(dot);
}
 
const char *snapshot_dir() {
  const char *dir = getenv("ESPHOME_SNAPSHOT_DIR");  // NOLINT(concurrency-mt-unsafe)
  return dir != nullptr && dir[0] != '\0' ? dir : ESPHOME_SNAPSHOT_DIR;
}
 
void put_le(uint8_t *&dest, uint32_t value, size_t bytes) {
  for (size_t i = 0; i != bytes; i++)
    *dest++ = static_cast<uint8_t>(value >> (8 * i));
}
 
size_t bmp_row_size(int width) { return (static_cast<size_t>(width) * 3 + 3) & ~size_t{3}; }
 
bool write_bmp(FILE *file, const uint8_t *pixels, int width, int height, size_t row_stride) {
  const size_t row_size = bmp_row_size(width);
  const size_t pixel_bytes = row_size * height;
 
  uint8_t header[BMP_HEADER_SIZE];
  uint8_t *pos = header;
  *pos++ = 'B';
  *pos++ = 'M';
  put_le(pos, static_cast<uint32_t>(BMP_HEADER_SIZE + pixel_bytes), 4);
  put_le(pos, 0, 4);  // reserved
  put_le(pos, BMP_HEADER_SIZE, 4);
  put_le(pos, BMP_INFO_HEADER_SIZE, 4);
  put_le(pos, static_cast<uint32_t>(width), 4);
  put_le(pos, static_cast<uint32_t>(height), 4);
  put_le(pos, 1, 2);  // one plane
  put_le(pos, BMP_BITS_PER_PIXEL, 2);
  put_le(pos, 0, 4);  // not compressed
  put_le(pos, static_cast<uint32_t>(pixel_bytes), 4);
  put_le(pos, 0, 4);  // pixels per metre across, unspecified
  put_le(pos, 0, 4);  // pixels per metre down, unspecified
  put_le(pos, 0, 4);  // no palette
  put_le(pos, 0, 4);  // so no palette entry matters more than another
 
  if (fwrite(header, 1, sizeof(header), file) != sizeof(header))
    return false;
  for (int y = height - 1; y >= 0; y--) {
    if (fwrite(pixels + static_cast<size_t>(y) * row_stride, 1, row_size, file) != row_size)
      return false;
  }
  return true;
}
 
bool write_snapshot_file(const uint8_t *pixels, int width, int height, size_t row_stride, const std::string &name,
                         bool exact) {
  const std::string dir = snapshot_dir();
  std::error_code ec;
  std::filesystem::create_directories(dir, ec);
  if (ec) {
    ESP_LOGE(TAG, "Could not create snapshot directory %s: %s", dir.c_str(), ec.message().c_str());
    return false;
  }
 
  // O_EXCL guarantees we never write over a file that is already there.
  std::string path;
  int fd = -1;
  for (unsigned attempt = 0; attempt < MAX_NAME_ATTEMPTS; attempt++) {
    path = dir + "/" + (attempt == 0 ? name : add_suffix(name, attempt));
    fd = ::open(path.c_str(), O_WRONLY | O_CREAT | O_EXCL | O_NOFOLLOW, 0644);
    if (fd >= 0)
      break;
    if (errno != EEXIST) {
      ESP_LOGE(TAG, "Could not create %s: %s", path.c_str(), strerror(errno));
      return false;
    }
    if (exact) {
      // The caller asked for this exact name, so silently writing somewhere else would be worse
      // than failing - a test asserting on the path would pick up a stale file.
      ESP_LOGE(TAG, "Snapshot %s already exists, not overwriting", path.c_str());
      return false;
    }
  }
  if (fd < 0) {
    ESP_LOGE(TAG, "Could not find an unused name for %s in %s", name.c_str(), dir.c_str());
    return false;
  }
 
  FILE *file = fdopen(fd, "wb");
  if (file == nullptr) {
    ESP_LOGE(TAG, "Could not open %s: %s", path.c_str(), strerror(errno));
    ::close(fd);
    ::unlink(path.c_str());
    return false;
  }
  bool ok = write_bmp(file, pixels, width, height, row_stride);
  int saved_errno = ok ? 0 : errno;
  // Closing can fail in its own right - the last of the data is still on its way out.
  if (fclose(file) != 0) {
    if (ok)
      saved_errno = errno;
    ok = false;
  }
  if (!ok) {
    ESP_LOGE(TAG, "Could not write %s: %s", path.c_str(), strerror(saved_errno));
    // Leave no truncated file behind - it would block a retry under the same name.
    ::unlink(path.c_str());
    return false;
  }
  ESP_LOGI(TAG, "Snapshot written to %s", path.c_str());
  return true;
}
 
}  // namespace
 
// helper function since ESP_LOGW is disallowed in a header file
void Snapshot::log_action_failed() { ESP_LOGW(TAG, "snapshot.take did not write a file"); }
 
bool Snapshot::take_snapshot(const char *filename) {
  const int width = this->snapshot_width();
  const int height = this->snapshot_height();
  if (width <= 0 || height <= 0) {
    ESP_LOGE(TAG, "Snapshot requested but the display is %dx%d", width, height);
    return false;
  }
 
  std::string name;
  bool exact = false;
  if (filename != nullptr) {
    bool name_changed = false;
    name = sanitise_filename(filename, &name_changed);
    exact = !name.empty();
    if (name_changed) {
      ESP_LOGW(TAG, "Requested snapshot name '%s' is not an acceptable file name, using '%s' instead", filename,
               name.empty() ? "a name made from the time" : name.c_str());
    }
  }
  if (name.empty()) {
    struct timespec now {};
    if (clock_gettime(CLOCK_REALTIME, &now) != 0)
      now = {};
    struct tm tm_buf {};
    if (localtime_r(&now.tv_sec, &tm_buf) == nullptr)
      tm_buf = {};
    char stamp[32]{};
    // ::strftime to be sure of the one from <ctime>; display has an unrelated member of that name
    if (::strftime(stamp, sizeof(stamp), "%Y%m%d-%H%M%S", &tm_buf) == 0)
      snprintf(stamp, sizeof(stamp), "unknown-time");
    char buffer[MAX_NAME_LENGTH];
    int written =
        snprintf(buffer, sizeof(buffer), "%s-%s-%03ld.bmp", this->snapshot_prefix_, stamp, now.tv_nsec / 1000000);
    if (written < 0 || static_cast<size_t>(written) >= sizeof(buffer)) {
      ESP_LOGW(TAG, "Could not build a timestamped snapshot name, using a fallback");
      snprintf(buffer, sizeof(buffer), "snapshot.bmp");
    }
    name = buffer;
  }
 
  // Rows are padded out to a multiple of four bytes, as the file wants them, so each one can be
  // written straight from the buffer. Zeroed on allocation, which is what the padding must be.
  const size_t row_stride = bmp_row_size(width);
  auto pixels = std::make_unique<uint8_t[]>(row_stride * height);
  if (!this->capture_bgr(pixels.get(), row_stride))
    return false;
  return write_snapshot_file(pixels.get(), width, height, row_stride, name, exact);
}
 
}  // namespace esphome::snapshot
#endif