Create costfunctionreg.m