Beautified the fillet function

I modified the fillet function to better work with right angles by
making sure the number of sides are divisable by 4.