1 files changed, 56 insertions, 0 deletions
diff --git a/src/ipa/raspberrypi/controller/rpi/black_level.cpp b/src/ipa/raspberrypi/controller/rpi/black_level.cpp
new file mode 100644
index 00000000..59c9f5a6
--- /dev/null
+++ b/src/ipa/raspberrypi/controller/rpi/black_level.cpp
@@ -0,0 +1,56 @@
+/* SPDX-License-Identifier: BSD-2-Clause */
+/*
+ * Copyright (C) 2019, Raspberry Pi (Trading) Limited
+ *
+ * black_level.cpp - black level control algorithm
+ */
+
+#include <math.h>
+#include <stdint.h>
+
+#include "../black_level_status.h"
+#include "../logging.hpp"
+
+#include "black_level.hpp"
+
+using namespace RPi;
+
+#define NAME "rpi.black_level"
+
+BlackLevel::BlackLevel(Controller *controller)
+	: Algorithm(controller)
+{
+}
+
+char const *BlackLevel::Name() const
+{
+	return NAME;
+}
+
+void BlackLevel::Read(boost::property_tree::ptree const &params)
+{
+	RPI_LOG(Name());
+	uint16_t black_level = params.get<uint16_t>(
+		"black_level", 4096); // 64 in 10 bits scaled to 16 bits
+	black_level_r_ = params.get<uint16_t>("black_level_r", black_level);
+	black_level_g_ = params.get<uint16_t>("black_level_g", black_level);
+	black_level_b_ = params.get<uint16_t>("black_level_b", black_level);
+}
+
+void BlackLevel::Prepare(Metadata *image_metadata)
+{
+	// Possibly we should think about doing this in a switch_mode or
+	// something?
+	struct BlackLevelStatus status;
+	status.black_level_r = black_level_r_;
+	status.black_level_g = black_level_g_;
+	status.black_level_b = black_level_b_;
+	image_metadata->Set("black_level.status", status);
+}
+
+// Register algorithm with the system.
+static Algorithm *Create(Controller *controller)
+{
+	return new BlackLevel(controller);
+}
+static RegisterAlgorithm reg(NAME, &Create);