diff --git a/src/main.c b/src/main.c
index dde40559d6701d393517cce165ec94a115681996..f98cab2ecc77b312c25ce4f4d98a41bef77d4b5c 100644
--- a/src/main.c
+++ b/src/main.c
@@ -132,11 +132,15 @@ static void command_bch(char *arg) {
 	// ensure a "clean" system state
 	XMC_PREFETCH_InvalidateInstructionBuffer();
 	timer_reset();
+
+	P5_7_set();
 	timer_start();
 
 	gene_main(val);
 
 	timer_stop();
+	P5_7_reset();
+
 	uint64_t cycles = timer_get();
 	__set_BASEPRI(old_basepri);
 
@@ -225,6 +229,9 @@ int main(void) {
 	P1_1_set_mode(OUTPUT_PP_GP);
 	P1_1_set_driver_strength(STRONG);
 
+	P5_7_set_mode(OUTPUT_PP_GP);
+	P5_7_set_driver_strength(WEAK);
+
 	#define BUFFER_SIZE 32
 	uint8_t pos = 0;
 	char buffer[BUFFER_SIZE + 1] = {0};