functioning initial estimate of input torque vector, still working on linking adol-c lib