diff --git a/keyboard/5x5x9/matrix.c b/keyboard/5x5x9/matrix.c
index c13bfd12..047d759c 100644
--- a/keyboard/5x5x9/matrix.c
+++ b/keyboard/5x5x9/matrix.c
@@ -70,6 +70,9 @@ uint8_t matrix_cols(void)
 
 void matrix_init(void)
 {
+    // disable JTAG SWD
+    AFIO->MAPR = AFIO_MAPR_SWJ_CFG_DISABLE;
+
     // initialize row and col
     unselect_rows();
     init_cols();
@@ -144,16 +147,16 @@ static void  init_cols(void)
 {
 	palSetPadMode(GPIOB, 11, PAL_MODE_INPUT_PULLUP);
 	palSetPadMode(GPIOB, 10, PAL_MODE_INPUT_PULLUP);
-	palSetPadMode(GPIOB, 2, PAL_MODE_INPUT_PULLUP);	
-	palSetPadMode(GPIOB, 0, PAL_MODE_INPUT_PULLUP);
-	palSetPadMode(GPIOA, 7, PAL_MODE_INPUT_PULLUP);
-	palSetPadMode(GPIOA, 6, PAL_MODE_INPUT_PULLUP);
-	palSetPadMode(GPIOA, 5, PAL_MODE_INPUT_PULLUP);
-	palSetPadMode(GPIOA, 4, PAL_MODE_INPUT_PULLUP);
-	palSetPadMode(GPIOA, 3, PAL_MODE_INPUT_PULLUP);
-	palSetPadMode(GPIOA, 2, PAL_MODE_INPUT_PULLUP);
-	palSetPadMode(GPIOA, 1, PAL_MODE_INPUT_PULLUP);
-	palSetPadMode(GPIOA, 0, PAL_MODE_INPUT_PULLUP);
+	palSetPadMode(GPIOB,  2, PAL_MODE_INPUT_PULLUP);	
+	palSetPadMode(GPIOB,  0, PAL_MODE_INPUT_PULLUP);
+	palSetPadMode(GPIOA,  7, PAL_MODE_INPUT_PULLUP);
+	palSetPadMode(GPIOA,  6, PAL_MODE_INPUT_PULLUP);
+	palSetPadMode(GPIOA,  5, PAL_MODE_INPUT_PULLUP);
+	palSetPadMode(GPIOA,  4, PAL_MODE_INPUT_PULLUP);
+	palSetPadMode(GPIOA,  3, PAL_MODE_INPUT_PULLUP);
+	palSetPadMode(GPIOA,  2, PAL_MODE_INPUT_PULLUP);
+	palSetPadMode(GPIOA,  1, PAL_MODE_INPUT_PULLUP);
+	palSetPadMode(GPIOA,  0, PAL_MODE_INPUT_PULLUP);
 	palSetPadMode(GPIOC, 15, PAL_MODE_INPUT_PULLUP);
 	palSetPadMode(GPIOC, 14, PAL_MODE_INPUT_PULLUP);
 	palSetPadMode(GPIOC, 13, PAL_MODE_INPUT_PULLUP);
@@ -174,9 +177,9 @@ static matrix_row_t read_cols(void)
 	| ((palReadPad(GPIOA,  2)==PAL_HIGH) ? 0 : (1<<9))
 	| ((palReadPad(GPIOA,  1)==PAL_HIGH) ? 0 : (1<<10))
 	| ((palReadPad(GPIOA,  0)==PAL_HIGH) ? 0 : (1<<11))
-	| ((palReadPad(GPIOC,  15)==PAL_HIGH) ? 0 : (1<<12))
-	| ((palReadPad(GPIOC,  14)==PAL_HIGH) ? 0 : (1<<13))
-	| ((palReadPad(GPIOC,  13)==PAL_HIGH) ? 0 : (1<<14));
+	| ((palReadPad(GPIOC, 15)==PAL_HIGH) ? 0 : (1<<12))
+	| ((palReadPad(GPIOC, 14)==PAL_HIGH) ? 0 : (1<<13))
+	| ((palReadPad(GPIOC, 13)==PAL_HIGH) ? 0 : (1<<14));
 }
 
 /* Row pin configuration