implement nifty counter for Controller

include/gamepad/controller.hpp

@@ -45,8 +45,8 @@ class Button {
 };
 
 class Controller {
+    friend struct ControllerInit;
     public:
-        explicit Controller(pros::controller_id_e_t id): controller(id) {}
         /**
          * Updates the state of the gamepad (all joysticks and buttons), and also runs
          * any registered handlers.
@@ -70,8 +70,17 @@ class Controller {
         X{}, B{}, Y{}, A{};
         float LeftX = 0, LeftY = 0, RightX = 0, RightY = 0;
     private:
+        explicit Controller(pros::controller_id_e_t id): controller(id) {}
         static Button Controller::* button_to_ptr(pros::controller_digital_e_t button);
         void updateButton(pros::controller_digital_e_t button_id);
         pros::Controller controller;
-}; // namespace Gamepad
+};
+
+static struct ControllerInit {
+    ControllerInit();
+    ~ControllerInit();
+} _controllerInit;
+
+extern Controller& master;
+extern Controller& partner;
 }

src/gamepad/controller.cpp

@@ -1,8 +1,35 @@
 #include "gamepad/controller.hpp"
 #include "gamepad/todo.hpp"
+#include "pros/misc.h"
+
+#include <new>
+#include <array>
+#include <cstddef>
 
 namespace Gamepad {
 
+static int nifty_counter; // zero initialized at load time
+static std::array<std::byte, sizeof(Controller)> master_buf alignas(Controller);
+Controller& master = *reinterpret_cast<Controller*> (&*master_buf.begin());
+static std::array<std::byte, sizeof(Controller)> partner_buf alignas(Controller);
+Controller& partner = *reinterpret_cast<Controller*> (&*partner_buf.begin());
+
+ControllerInit::ControllerInit() {
+    if(nifty_counter == 0) {
+        new (&*master_buf.begin()) Controller(pros::E_CONTROLLER_MASTER);
+        new (&*partner_buf.begin()) Controller(pros::E_CONTROLLER_PARTNER);
+    }
+    ++nifty_counter;
+}
+
+ControllerInit::~ControllerInit() {
+    --nifty_counter;
+    if(nifty_counter == 0) {
+        master.~Controller();
+        partner.~Controller();
+    }
+}
+
 uint32_t Button::onPress(std::function<void(void)> func) {
     return this->onPressEvent.add_listener(std::move(func));
 }