PROG: Still coninuing in inner_opt code. Almost done with imposed FOC for CheckGradNAG.m