Finished sct-step implementation, segmentation fault, verified results for test example and a few other little things