Fixed bug involving castling
Added unit test for castling bug
Cleaned up unit tests