CSR SM produces correct output for first few cycles.
Fix CSR SM output for all cycles on small test case.