Fix digitalRead() while pin is output mode

teensy4/digital.c

@@ -116,6 +116,6 @@ void pinMode(uint8_t pin, uint8_t mode)
 			*(p->pad) = IOMUXC_PAD_HYS;
 		}
 	}
-	*(p->mux) = 5;
+	*(p->mux) = 5 | 0x10;
 }