Added tests for SMUStep and fixed bugs in it from test