Added TreeJntToCOMJacobian solver and relative test