zoj_1002做了一天，把此题AC了，看到网上用的算法很复杂，发个自己的出来