Fixed castling so that it follows all rules