Create cofiCostFunc.m