Add castling code to benchmark

ArduChess.ino

@@ -65,9 +65,25 @@ void bench() {
 	unmake();
 	unmake();
 
+	make({0x06, 0x25, P_EMPTY});
+	make({0x76, 0x55, P_EMPTY});
+	make({0x16, 0x26, P_EMPTY});
+	make({0x63, 0x43, P_EMPTY});
+	make({0x05, 0x16, P_EMPTY});
+	make({0x62, 0x42, P_EMPTY});
+	make({0x04, 0x06, P_EMPTY});
+	unmake();
+	unmake();
+	unmake();
+	unmake();
+	unmake();
+	unmake();
+	unmake();
+
+
 	int elapsed = micros() - startTime;
 	Serial.print(elapsed);
-	Serial.println(F("microseconds for 5 moves"));
+	Serial.println(F(" microseconds"));
 	panic(F("Bench finished!"));
 }
 
@@ -76,7 +92,7 @@ void setup() {
 	// put your setup code here, to run once:
 	board_init();
 	Serial.begin(115200);
-	debug_castle();
+	bench();
 }
 
 void loop() {