diff --git a/main.c b/main.c
--- a/main.c
+++ b/main.c
@@ -49,17 +49,17 @@ int main(void)
 
     GPIO_ResetBits(LED_STAT);
     Delay(100);
-
-    //ssd1306_Init();
-    //ssd1306_DrawPoint(3,3,1);
-    //ssd1306_DrawPoint(5,5,0);
-
     GPIO_SetBits(LED_POWER);
     Delay(500);
     GPIO_ResetBits(LED_POWER);
 
     init_spi();
 
+    ssd1306_Init();
+    ssd1306_DrawPoint(3,3,1);
+    ssd1306_DrawPoint(5,5,0);
+
+
     while(1)
    {  
         // Process sensor inputs [TODO: 5hz?]
@@ -406,11 +406,11 @@ void init_gpio(void) {
   /*Enable or disable the AHB peripheral clock */
   RCC_AHBPeriphClockCmd(RCC_AHBPeriph_GPIOA, ENABLE);
 
-  /*Configure GPIO pin : PA */
+  /*Configure GPIO pin : PA: MOSI,SCK */
   GPIO_InitStruct.GPIO_Pin = GPIO_Pin_5|GPIO_Pin_7;
-  GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
+  GPIO_InitStruct.GPIO_Mode = GPIO_Mode_AF;
   GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_NOPULL;
-  GPIO_InitStruct.GPIO_Speed = GPIO_Speed_400KHz;
+  GPIO_InitStruct.GPIO_Speed = GPIO_Speed_10MHz;
   GPIO_Init(GPIOA, &GPIO_InitStruct);
 
   /*Configure GPIO pin alternate function */
@@ -428,13 +428,24 @@ void init_gpio(void) {
   /*Enable or disable the AHB peripheral clock */
   RCC_AHBPeriphClockCmd(RCC_AHBPeriph_GPIOB, ENABLE);
 
-  /*Configure GPIO pin : PB */
-  GPIO_InitStruct.GPIO_Pin = GPIO_Pin_13|GPIO_Pin_14|GPIO_Pin_15;
-  GPIO_InitStruct.GPIO_OType = GPIO_OType_PP;
+
+// SPI PINSSS
+
+  /*Configure GPIO pin : PB, MOSI, SCK */
+  GPIO_InitStruct.GPIO_Pin = GPIO_Pin_13|GPIO_Pin_15;
+  GPIO_InitStruct.GPIO_Mode = GPIO_Mode_AF;
   GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_NOPULL;
-  GPIO_InitStruct.GPIO_Speed = GPIO_Speed_400KHz;
+  GPIO_InitStruct.GPIO_Speed = GPIO_Speed_10MHz;
   GPIO_Init(GPIOB, &GPIO_InitStruct);
 
+// MISO
+  GPIO_InitStruct.GPIO_Pin = GPIO_Pin_14;
+  GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IN;
+  GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_NOPULL;
+  GPIO_InitStruct.GPIO_Speed = GPIO_Speed_10MHz;
+  GPIO_Init(GPIOB, &GPIO_InitStruct);
+
+
   /*Configure GPIO pin alternate function */
   GPIO_PinAFConfig(GPIOB, GPIO_PinSource13, GPIO_AF_SPI2);