fixed FORCES. getting some mediocre results with hacks. try casadi now b/c variance of FD is bad (according to paper)