Figure 1: Algorithm 1 and 2