Implementation of CUSP scheme