Finished correct computation of gain (likelihood). Added SFODriver (only single iteration)