diff --git a/main.c b/main.c
--- a/main.c
+++ b/main.c
@@ -1,16 +1,14 @@
 #include "main.h"
 #include "stm32l100c_discovery.h"
+#include "Libraries/u8glib/u8g_arm.h"
 
 static __IO uint32_t TimingDelay;
 uint8_t BlinkSpeed = 0;
 
-/**
-  * @brief  Main program.
-  * @param  None
-  * @retval None
-  */
-int main(void)
-{
+
+/* Setup periphs / etc */
+void setup() {
+
   RCC_ClocksTypeDef RCC_Clocks;
   
   /* Configure LED3 and LED4 on STM32L100C-Discovery */
@@ -23,8 +21,15 @@ int main(void)
   /* SysTick end of count event each 1ms */
   RCC_GetClocksFreq(&RCC_Clocks);
   SysTick_Config(RCC_Clocks.HCLK_Frequency / 1000);
-   
-  /* Initiate Blink Speed variable */ 
+ 
+}
+
+
+/* Main */
+int main(void)
+{
+
+ /* Initiate Blink Speed variable */ 
   BlinkSpeed = 1;
   
   while(1)