refactor: move emulation logic into sys

1 files changed, 18 insertions, 0 deletions

diff --git a/lib/nes/sys/controller.cc b/lib/nes/sys/controller.cc
new file mode 100644
index 0000000..910ef57
--- /dev/null
+++ b/lib/nes/sys/controller.cc
@@ -0,0 +1,18 @@
+#include "nes/sys/controller.hh"
+
+namespace nes
+{
+	auto controller::read() -> std::uint8_t
+	{
+		auto const res = index_ < 8 ? (pressed_.get_raw_value() >> index_) & 1 : 0;
+		index_ += 1;
+		if (strobing_) { index_ = 0; }
+		return static_cast<std::uint8_t>(res);
+	}
+
+	auto controller::write(std::uint8_t const value) -> void
+	{
+		strobing_ = value & 1;
+		if (strobing_) { index_ = 0; }
+	}
+} // namespace nes
\ No newline at end of file