1 files changed, 22 insertions, 0 deletions
diff --git a/firmware/src/display.hpp b/firmware/src/display.hpp
new file mode 100644
index 0000000..e2dabf2
--- /dev/null
+++ b/firmware/src/display.hpp
@@ -0,0 +1,22 @@
+#include "hardware/i2c.h"
+
+namespace display
+{
+
+// I2C0 on GPIO8 (SDA) and GPIO9 (SCL) running at 400KHz
+constexpr auto I2C_PORT = i2c0;
+constexpr unsigned I2C_SDA = 8;
+constexpr unsigned I2C_SCL = 9;
+
+void
+init()
+{
+    i2c_init(I2C_PORT, 400*1000);
+    
+    gpio_set_function(I2C_SDA, GPIO_FUNC_I2C);
+    gpio_set_function(I2C_SCL, GPIO_FUNC_I2C);
+    gpio_pull_up(I2C_SDA);
+    gpio_pull_up(I2C_SCL);
+}
+
+}