Migrated TreeFkSolverPos to new GeneralizedJntTorques data structures