From e69fd01b667f5c4709ee6401388c204a7e387443 Mon Sep 17 00:00:00 2001
From: Quinten Kock <quintenkock@gmail.com>
Date: Thu, 18 Jun 2020 20:45:10 +0200
Subject: [PATCH] Implement multiple functions in main

---
 ArduChess.ino | 78 ++++++++++++++++++++++++++++-----------------------
 1 file changed, 43 insertions(+), 35 deletions(-)

diff --git a/ArduChess.ino b/ArduChess.ino
index 1621bed..e38560c 100644
--- a/ArduChess.ino
+++ b/ArduChess.ino
@@ -9,9 +9,49 @@
 #include "Movegen.h"
 #include "Types.h"
 
-void bench() {
-	board_init();
+void debug_castle() {
+	print();
+	make({0x06, 0x25, P_EMPTY}); print();
+	make({0x76, 0x55, P_EMPTY}); print();
+	make({0x16, 0x26, P_EMPTY}); print();
+	make({0x63, 0x43, P_EMPTY}); print();
+	make({0x05, 0x16, P_EMPTY}); print();
+	make({0x62, 0x42, P_EMPTY}); print();
+	make({0x04, 0x06, P_EMPTY}); print();
+	unmake(); print();
+	unmake(); print();
+	unmake(); print();
+	unmake(); print();
+	unmake(); print();
+	unmake(); print();
+	unmake(); print();
+}
 
+void debug_ep() {
+	print();
+	make({0x14, 0x34, P_EMPTY});
+	print();
+	make({0x64, 0x54, P_EMPTY});
+	print();
+	make({0x34, 0x44, P_EMPTY});
+	print();
+	make({0x63, 0x43, P_EMPTY});
+	print();
+	make({0x44, 0x53, P_EMPTY});
+	print();
+	unmake();
+	print();
+	unmake();
+	print();
+	unmake();
+	print();
+	unmake();
+	print();
+	unmake();
+	print();
+}
+
+void bench() {
 	int startTime = micros();
 
 	make({0x14, 0x34, P_EMPTY});
@@ -36,39 +76,7 @@ void setup() {
 	// put your setup code here, to run once:
 	board_init();
 	Serial.begin(115200);
-	bench();
-	Serial.println(F("hello"));
-
-
-	board_init();
-	int startTime = micros();
-	print();
-	make({0x14, 0x34, P_EMPTY});
-	print();
-	make({0x64, 0x54, P_EMPTY});
-	print();
-	make({0x34, 0x44, P_EMPTY});
-	print();
-	make({0x63, 0x43, P_EMPTY});
-	print();
-	make({0x44, 0x53, P_EMPTY});
-	print();
-	unmake();
-	print();
-	unmake();
-	print();
-	unmake();
-	print();
-	unmake();
-	print();
-	unmake();
-	print();
-
-	int elapsed = micros() - startTime;
-	Serial.print(elapsed);
-	Serial.println(F("microseconds for 5 moves"));
-
-
+	debug_castle();
 }
 
 void loop() {