diff --git a/lib/oled_ssd1306.c b/lib/oled_ssd1306.c
new file mode 100644
index 0000000..cf57871
--- /dev/null
+++ b/lib/oled_ssd1306.c
@@ -0,0 +1,140 @@
+/* This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see .
+ *
+ */
+/** SSD1306 OLED library (code)
+ * @file oled_ssd1306.c
+ * @author King Kévin
+ * @date 2018
+ * @note peripherals used: I2C @ref oled_ssd1306_i2c
+ */
+/* standard libraries */
+#include // standard integer types
+#include // boolean type
+#include // general utilities
+
+/* STM32 (including CM3) libraries */
+#include // I2C library
+
+/* own libraries */
+#include "global.h" // global utilities
+#include "oled_ssd1306.h" // OLED definitions
+#include "i2c_master.h" // I2C header and definitions
+
+/** SSD1306 OLED display I2C slave address */
+#define OLED_SSD1306_SLAVE 0x3c
+
+/** @defgroup oled_ssd1306_i2c I2C peripheral to communicate with the SSD1306 OLED
+ * @{
+ */
+#define OLED_SSD1306_I2C I2C1 /**< I2C peripheral */
+/** @} */
+
+bool oled_ssd1306_setup(void)
+{
+ if (!i2c_master_check_signals(OLED_SSD1306_I2C)) { // check if there are pull-ups to operator I2C
+ return false;
+ }
+ i2c_master_setup(OLED_SSD1306_I2C, 400); // setup I2C bus ( SSD1306 supports an I2C cleck up to 400 kHz)
+ const uint8_t oled_init[] = {
+ 0x00, // control byte: continuous (multiple byes), command
+ 0xae, // Set Display ON/OFF: OFF
+ // hardware configuration
+ 0xa8, 0x3f, // Set Multiplex Ratio: 64
+ 0xd3, 0x00, // Set Display Offset: 0
+ 0xa1, // Set Segment Re-map: column address 0 is mapped to SEG127
+ 0xc8, // Set COM Output Scan Direction: normal mode (RESET) Scan from COM[N-1] to COM[0]
+ 0xda, 0x12, // Set COM Pins Hardware Configuration: Alternative COM pin configuration, Disable COM Left/Right remap
+ 0x40, // Set Display Start Line: start line register from 0
+ // fundamental commands
+ 0x81, 0xff, // Set Contrast Control: 256
+ 0xa6, // Set Normal/Inverse Display: Normal display (RESET)
+ // Timing & Driving Scheme Setting
+ 0xd5, 0xf0, // Set Display Clock Divide Ratio/Oscillator Frequency: Divide ratio=129, F_OSC=1
+ 0xd9, 0x22, // Set Pre-charge Period: Phase 1=2 DCLK, Phase 2=2DCLK
+ 0xdb, 0x20, // Set V_COMH Deselect Level: ~0.77xV_CC
+ // Charge Pump
+ 0x8d, 0x14, // Charge Pump Setting: Enable Charge Pump
+ // Addressing Setting
+ 0x20, 0x00 // Set Memory Addressing Mode: Horizontal Addressing Mode
+ }; // command to initialize the display
+ return I2C_MASTER_RC_NONE==i2c_master_slave_write(OLED_SSD1306_I2C, OLED_SSD1306_SLAVE, false, oled_init, LENGTH(oled_init)); // send command to initialize display
+}
+
+void oled_ssd1306_on(void)
+{
+ const uint8_t oled_display_on[] = {
+ 0x80, // control byte: no continuation, command
+ 0xaf, // Set Display ON/OFF: ON
+ }; // command to switch on display
+ i2c_master_slave_write(OLED_SSD1306_I2C, OLED_SSD1306_SLAVE, false, oled_display_on, LENGTH(oled_display_on)); // sent command to switch on display
+}
+
+void oled_ssd1306_off(void)
+{
+ const uint8_t oled_display_off[] = {
+ 0x80, // control byte: no continuation, command
+ 0xae, // Set Display ON/OFF: OFF
+ }; // command to switch off display
+ i2c_master_slave_write(OLED_SSD1306_I2C, OLED_SSD1306_SLAVE, false, oled_display_off, LENGTH(oled_display_off)); // sent command to switch onff display
+}
+
+void oled_ssd1306_test(void)
+{
+ const uint8_t oled_entire_display_on[] = {
+ 0x80, // control byte: no continuation, command
+ 0xa5 // Entire Display ON: Entire display ON Output ignores RAM content
+ }; // command to set entire display on
+ i2c_master_slave_write(OLED_SSD1306_I2C, OLED_SSD1306_SLAVE, false, oled_entire_display_on, LENGTH(oled_entire_display_on)); // send command to switch entire display on
+ oled_ssd1306_on(); // set display on
+ sleep_ms(200); // let is on for a bit (enough for the user to see it is completely on
+ oled_ssd1306_off(); // set display off
+ const uint8_t oled_entire_display_ram[] = {
+ 0x80, // control byte: no continuation, command
+ 0xa4 // Entire Display ON: Resume to RAM content display
+ }; // command to display RAM
+ i2c_master_slave_write(OLED_SSD1306_I2C, OLED_SSD1306_SLAVE, false, oled_entire_display_ram, LENGTH(oled_entire_display_ram)); // send command to display RAM
+}
+
+void oled_ssd1306_display(const uint8_t* display_data, uint16_t display_length)
+{
+ // verify input
+ if (0==display_length || NULL==display_data) {
+ return;
+ }
+
+ const uint8_t oled_start_page[] = {
+ 0x00, // control byte: continuous (multiple byes), command
+ 0xb0, // Set Page Start Address for Page Addressing Mode: PAGE0
+ 0x00, // Set Lower Column Start Address for Page Addressing Mode: 0
+ 0x10 // Set Higher Column Start Address for Page Addressing Mode: 0
+ }; // command to set addressing mode
+ i2c_master_slave_write(OLED_SSD1306_I2C, OLED_SSD1306_SLAVE, false, oled_start_page, LENGTH(oled_start_page)); // send command to set addressing mode
+ if (I2C_MASTER_RC_NONE!=i2c_master_start(OLED_SSD1306_I2C)) { // send start condition
+ return;
+ }
+ if (I2C_MASTER_RC_NONE!=i2c_master_select_slave(OLED_SSD1306_I2C, OLED_SSD1306_SLAVE, false, true)) { // select OLED display
+ return;
+ }
+ const uint8_t oled_data[] = {
+ 0x40, // control byte: continuous (multiple byes), data
+ };
+ if (I2C_MASTER_RC_NONE!=i2c_master_write(OLED_SSD1306_I2C, oled_data, LENGTH(oled_data))) { // send data header
+ return;
+ }
+ if (I2C_MASTER_RC_NONE!=i2c_master_write(OLED_SSD1306_I2C, display_data, display_length)) { // send template picture to display
+ return;
+ }
+ i2c_master_stop(OLED_SSD1306_I2C); // send stop condition
+}
+
diff --git a/lib/oled_ssd1306.h b/lib/oled_ssd1306.h
new file mode 100644
index 0000000..00ad79c
--- /dev/null
+++ b/lib/oled_ssd1306.h
@@ -0,0 +1,36 @@
+/* This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see .
+ *
+ */
+/** SSD1306 OLED library (API)
+ * @file oled_ssd1306.h
+ * @author King Kévin
+ * @date 2018
+ * @note peripherals used: I2C @ref oled_ssd1306_i2c
+ */
+
+/** setup OLED display
+ * @return if the display setup is successful, else the display is probably not on the I2C bus
+ */
+bool oled_ssd1306_setup(void);
+/** switch OLED display on */
+void oled_ssd1306_on(void);
+/** switch OLED display off */
+void oled_ssd1306_off(void);
+/** test OLED display: switch entire screen on for a brief time */
+void oled_ssd1306_test(void);
+/** send data to display to OLED display
+ * @param[in] display_data data to display (first byte is left column, MSb is top pixel, warps pages)
+ * @param[in] display_length length of data to display
+ */
+void oled_ssd1306_display(const uint8_t* display_data, uint16_t display_length);