diff --git a/keyboards/teensy_lc_synth/config.h b/keyboards/teensy_lc_synth/config.h
index fdab46864f..1a48a7e91e 100644
--- a/keyboards/teensy_lc_synth/config.h
+++ b/keyboards/teensy_lc_synth/config.h
@@ -31,9 +31,8 @@ along with this program.  If not, see <http://www.gnu.org/licenses/>.
 #define DESCRIPTION "QMK keyboard firmware test for ChibiOS"
 
 /* key matrix size */
-#define MATRIX_ROWS 4
-#define MATRIX_COLS 3
-#define DIODE_DIRECTION ROW2COL
+#define MATRIX_ROWS 3
+#define MATRIX_COLS 4
 
 /* Set 0 if debouncing isn't needed */
 #define DEBOUNCE    5
diff --git a/keyboards/teensy_lc_synth/matrix.c b/keyboards/teensy_lc_synth/matrix.c
index cf5ca643a5..b8bbe5a754 100644
--- a/keyboards/teensy_lc_synth/matrix.c
+++ b/keyboards/teensy_lc_synth/matrix.c
@@ -43,29 +43,28 @@ static void select_row(uint8_t row);
 
 
 inline
-uint8_t matrix_rows(void)
-{
+uint8_t matrix_rows(void) {
     return MATRIX_ROWS;
 }
 
 inline
-uint8_t matrix_cols(void)
-{
+uint8_t matrix_cols(void) {
     return MATRIX_COLS;
 }
 
-void matrix_init(void)
-{
+void matrix_init(void) {
     // initialize row and col
-    unselect_rows();
+    palSetPadMode(TEENSY_PIN13_IOPORT, TEENSY_PIN13, PAL_MODE_OUTPUT_PUSHPULL);
+    palSetPadMode(TEENSY_PIN12_IOPORT, TEENSY_PIN12, PAL_MODE_OUTPUT_PUSHPULL);
+    palSetPadMode(TEENSY_PIN18_IOPORT, TEENSY_PIN18, PAL_MODE_OUTPUT_PUSHPULL);
     init_cols();
 
     // initialize LED
-    palSetPadMode(TEENSY_PIN20_IOPORT, TEENSY_PIN20, PAL_MODE_OUTPUT_PUSHPULL);
+    //palSetPadMode(TEENSY_PIN20_IOPORT, TEENSY_PIN20, PAL_MODE_OUTPUT_PUSHPULL);
 
     // Turn on C's LED
-    palClearPad(TEENSY_PIN20_IOPORT, TEENSY_PIN20);
-    palSetPad(TEENSY_PIN10_IOPORT, TEENSY_PIN10);
+    //palClearPad(TEENSY_PIN20_IOPORT, TEENSY_PIN20);
+    //palSetPad(TEENSY_PIN10_IOPORT, TEENSY_PIN10);
     
     // initialize matrix state: all keys off
     for (uint8_t i=0; i < MATRIX_ROWS; i++) {
@@ -77,12 +76,12 @@ void matrix_init(void)
     debug_matrix = true;
 }
 
-uint8_t matrix_scan(void)
-{
+uint8_t matrix_scan(void) {
     for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
         select_row(i);
         wait_us(30);  // without this wait read unstable value.
         matrix_row_t cols = read_cols();
+        printf("row:%d cols:%d\n", i, cols);
         if (matrix_debouncing[i] != cols) {
             matrix_debouncing[i] = cols;
             if (debouncing) {
@@ -103,23 +102,23 @@ uint8_t matrix_scan(void)
         }
     }
 
+    print("\n"); // FIXME: only here for debugging
+    wait_ms(1000); // FIXME: only here for debugging
+
     return 1;
 }
 
 inline
-bool matrix_is_on(uint8_t row, uint8_t col)
-{
+bool matrix_is_on(uint8_t row, uint8_t col) {
     return (matrix[row] & ((matrix_row_t)1<<col));
 }
 
 inline
-matrix_row_t matrix_get_row(uint8_t row)
-{
+matrix_row_t matrix_get_row(uint8_t row) {
     return matrix[row];
 }
 
-void matrix_print(void)
-{
+void matrix_print(void) {
     print("\nr/c 0123456789ABCDEF\n");
     for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
         phex(row); print(": ");
@@ -130,54 +129,51 @@ void matrix_print(void)
 
 /* Column pin configuration
  */
-static void init_cols(void)
-{
-    // internal pull-up
-    palSetPadMode(TEENSY_PIN12_IOPORT, TEENSY_PIN12, PAL_MODE_INPUT_PULLUP);
-    palSetPadMode(TEENSY_PIN13_IOPORT, TEENSY_PIN13, PAL_MODE_INPUT_PULLUP);
-    palSetPadMode(TEENSY_PIN18_IOPORT, TEENSY_PIN18, PAL_MODE_INPUT_PULLUP);
+static void init_cols(void) {
+    // Set columns to input mode so they can be read.
+    palSetPadMode(TEENSY_PIN14_IOPORT, TEENSY_PIN14, PAL_MODE_INPUT);
+    palSetPadMode(TEENSY_PIN15_IOPORT, TEENSY_PIN15, PAL_MODE_INPUT);
+    palSetPadMode(TEENSY_PIN16_IOPORT, TEENSY_PIN16, PAL_MODE_INPUT);
+    palSetPadMode(TEENSY_PIN11_IOPORT, TEENSY_PIN11, PAL_MODE_INPUT);
 }
 
 /* Returns status of switches(1:on, 0:off) */
-static matrix_row_t read_cols(void)
-{
-    return (
-        (palReadPad(TEENSY_PIN13_IOPORT, TEENSY_PIN13)==PAL_HIGH) ? 0 : (1<<0),
-        (palReadPad(TEENSY_PIN12_IOPORT, TEENSY_PIN12)==PAL_HIGH) ? 0 : (1<<0),
-        (palReadPad(TEENSY_PIN18_IOPORT, TEENSY_PIN18)==PAL_HIGH) ? 0 : (1<<0)
-    );
+static matrix_row_t read_cols(void) {
+    printf("pin14:%d, ", (palReadPad(TEENSY_PIN14_IOPORT, TEENSY_PIN14)==PAL_LOW)<<0);
+    printf("pin15:%d, ", (palReadPad(TEENSY_PIN15_IOPORT, TEENSY_PIN15)==PAL_LOW)<<1);
+    printf("pin16:%d, ", (palReadPad(TEENSY_PIN16_IOPORT, TEENSY_PIN16)==PAL_LOW)<<2);
+    printf("pin11:%d\n", (palReadPad(TEENSY_PIN11_IOPORT, TEENSY_PIN11)==PAL_LOW)<<3);
+    
+    return (palReadPad(TEENSY_PIN14_IOPORT, TEENSY_PIN14)==PAL_LOW) ? 0 : (1<<0) && \
+        (palReadPad(TEENSY_PIN15_IOPORT, TEENSY_PIN15)==PAL_LOW) ? 0 : (1<<1) && \
+        (palReadPad(TEENSY_PIN16_IOPORT, TEENSY_PIN16)==PAL_LOW) ? 0 : (1<<2) && \
+        (palReadPad(TEENSY_PIN11_IOPORT, TEENSY_PIN11)==PAL_LOW) ? 0 : (1<<3);
 }
 
 /* Row pin configuration
  */
-static void unselect_rows(void)
-{
-    palSetPadMode(TEENSY_PIN14_IOPORT, TEENSY_PIN14, PAL_MODE_INPUT); // hi-Z
-    palSetPadMode(TEENSY_PIN15_IOPORT, TEENSY_PIN15, PAL_MODE_INPUT); // hi-Z
-    palSetPadMode(TEENSY_PIN16_IOPORT, TEENSY_PIN16, PAL_MODE_INPUT); // hi-Z
-    palSetPadMode(TEENSY_PIN11_IOPORT, TEENSY_PIN11, PAL_MODE_INPUT); // hi-Z
+static void unselect_rows(void) {
+    // internal pull-down
+    palClearPad(TEENSY_PIN13_IOPORT, TEENSY_PIN13);
+    palClearPad(TEENSY_PIN12_IOPORT, TEENSY_PIN12);
+    palClearPad(TEENSY_PIN18_IOPORT, TEENSY_PIN18);
 }
 
-static void select_row(uint8_t row)
-{
+static void select_row(uint8_t row) {
     (void)row;
-    // Output low to select
+    // Output high to select
     switch (row) {
         case 0:
-            palSetPadMode(TEENSY_PIN14_IOPORT, TEENSY_PIN14, PAL_MODE_OUTPUT_PUSHPULL);
-            palClearPad(TEENSY_PIN14_IOPORT, TEENSY_PIN14);
+            print("Row 1: ");
+            palSetPad(TEENSY_PIN13_IOPORT, TEENSY_PIN13);
             break;
         case 1:
-            palSetPadMode(TEENSY_PIN15_IOPORT, TEENSY_PIN15, PAL_MODE_OUTPUT_PUSHPULL);
-            palClearPad(TEENSY_PIN15_IOPORT, TEENSY_PIN15);
+            print("Row 2: ");
+            palSetPad(TEENSY_PIN12_IOPORT, TEENSY_PIN12);
             break;
         case 2:
-            palSetPadMode(TEENSY_PIN16_IOPORT, TEENSY_PIN16, PAL_MODE_OUTPUT_PUSHPULL);
-            palClearPad(TEENSY_PIN16_IOPORT, TEENSY_PIN16);
-            break;
-        case 3:
-            palSetPadMode(TEENSY_PIN11_IOPORT, TEENSY_PIN11, PAL_MODE_OUTPUT_PUSHPULL);
-            palClearPad(TEENSY_PIN11_IOPORT, TEENSY_PIN11);
+            print("Row 3: ");
+            palSetPad(TEENSY_PIN18_IOPORT, TEENSY_PIN18);
             break;
     }
 }
diff --git a/keyboards/teensy_lc_synth/teensy_lc_synth.h b/keyboards/teensy_lc_synth/teensy_lc_synth.h
index 5485bbb211..ec3f15567e 100644
--- a/keyboards/teensy_lc_synth/teensy_lc_synth.h
+++ b/keyboards/teensy_lc_synth/teensy_lc_synth.h
@@ -3,13 +3,12 @@
 #include "quantum.h"
 
 #define KEYMAP( \
-         k31, k20,      k22, k10, k01, \
-      k30, k32, k21, k11, k12, k00, k02 \
+         k10, k01,      k02, k22, k13, \
+      k00, k20, k11, k21, k12, k03, k23 \
 ) { \
-    { k00, k01, k02 }, \
-    { k10, k11, k12 }, \
-    { k20, k21, k22 }, \
-    { k30, k31, k32 } \
+    { k00, k01, k02, k03 }, \
+    { k10, k11, k12, k13 }, \
+    { k20, k21, k22, k23 }, \
 }
 
 #endif