Closed casparvv closed 2 years ago
I propose to make the time2Goal metric depend on the goal dimension instead of the obstacle dimension, will add this to the PR. Otherwise, shape mismatch can occur in calculating the distance between the fks and the goal if the dimension of the goal is 2, but an obstacle dimension of 3 is used. Other metrics might also need to be made goal dependent.
This seems to fix issue #38.