Enable Shape Optimzation, fix Focu selection bug

Shape optimization happens just after adding a poly, and randomly every
3 polys added.