Add squarifier helper function and integrate into smoothMOHCA and get_D_smooth