update Stage1 EG algo to match firmware after tests with Ben