Refactoring for readability

[larsbrubaker]

So much of this code has changed from the c# implementation that I'm hoping it is worth considering making it more readable as well.

Also fixed a problem with the CleanPolgyons non considering the co-linearity of the points it is collapsing.