Added green/orange markers for castling

Need to decide which one to use green/orange or orange/green.
Also fixed bug where you could only castle when king was in mate,
instead of the opposite.