 }
 
 void debug(char* message) {
-  if(DEBUG_MODE == true) {
+  if (DEBUG_MODE == true) {
     Serial.println(message);
-    oled.clearDisplay();
-    oled.setCursor(0, 0);
-    oled.println(message);
-    oled.display();
+    /*
+      oled.clearDisplay();
+      oled.setCursor(0, 0);
+      oled.println(message);
+      oled.display();
+    */
   }
 }
 

#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <MenuSystem.h>
#include "OLEDMenuRenderer.h"

////-------------------------------------------------------------------- Globals
//// BUTTONS
int CAP_THRESHOLD=450;          //May change, but global. Used for capacitive touch sensitivity
const uint8_t BTN_UP=0;         //readCap for A6
const uint8_t BTN_DOWN=1;       //readCap for A7
const uint8_t BTN_SELECT=9;     //readCap for A2
const uint8_t BTN_BACK=10;      //readCap for A3
const uint8_t BTN_USER1=6;      //readCap for A1
const uint8_t BTN_USER2=12;     //readCap for A0

//// I2C
const uint8_t OLED_I2C_ADDRESS=0x3C;

//// OLED
const int SCREEN_WIDTH=128;     // OLED display width, in pixels
const int SCREEN_HEIGHT=64;     // OLED display height, in pixels
// -1 did not work for me, but 6 does (A1) because the signal for OLED reset looks so different from CapTouch
const uint8_t OLED_RESET=6;     // Reset pin # (or -1 if sharing Arduino reset pin)
Adafruit_SSD1306 oled(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);


//// MenuSystem

class MyRenderer : public MenuComponentRenderer {
public:
    void render(Menu const& menu) const {
        oled.clearDisplay();
        oled.setCursor(0, 0);

        if (menu.get_name() == "") {
            oled.println("Main Menu");
        } else {
            oled.println(menu.get_name());
        }

        for (int i = 0; i < menu.get_num_components(); ++i) {
            MenuComponent const* cp_m_comp = menu.get_menu_component(i);
            if (cp_m_comp->is_current()) {
                oled.print(">");
            } else {
                oled.print(" ");
            }
            cp_m_comp->render(*this);

            oled.println("");
        }
    }

    void render_menu_item(MenuItem const& menu_item) const {
        oled.print(menu_item.get_name());
    }

    void render_back_menu_item(BackMenuItem const& menu_item) const {
        oled.print(menu_item.get_name());
    }

    void render_numeric_menu_item(NumericMenuItem const& menu_item) const {
        oled.print(menu_item.get_name());
    }

    void render_menu(Menu const& menu) const {
        oled.print(menu.get_name());
    }
};


MyRenderer menuRenderer;
MenuSystem menuSystem(menuRenderer);

//// Operations
boolean DEBUG_MODE = true;

  int capValue = CircuitPlayground.readCap(capNum, 30);
  if ( capValue > CAP_THRESHOLD) {
    CircuitPlayground.playTone(262, 10);
    if (DEBUG_MODE == true) {
      Serial.print("Cap ");
      Serial.print(capNum);
      Serial.print(" pressed, value is ");
