Polygon shape improved for better collision response
Private methods made private