書き方は色々ありますが、 参考になればと思い、 僕が書いたプログラムを貼っておきます。