Add CG in function cost