以下のコードで実装できます（実装コード）。このコードは一般的なアルゴリズムなので、ライセンスなど気にせず自由に商用利用していただいて問題ありません。