all analytical derivatives for two joint, 1 DOF system are in place, as well as the code for iteratively solving the optimization problem... still needs debugging, because iterations are not behaving as expected... succesfully linked to ADOLC lib