See my code at the end. The Wikipedia article is pretty good too. I can send you more if you like.