TreeCOMSolver first solver ported to use GeneralizedJntPositions