Steins algorithm implemented, moving to test branc