Add modified SAC algorithm

Add the modified version of sac as described in the tutorial to the devel branch via a merge request.