Testing the castling helper
A little refactoring for readability
Well, look at that. I just had the logic backwards