USM_Sharpen based on matlab sharpening program