Fixed bug allowing CS to move diagonally

Fixed bug and added test