Closed mkghaas closed 7 years ago
This looks good to me, but makes me worried. If .affine() is now transposed relative to before the Eigen change, should that not be reflected everywhere in the code? It looks like in some parts that change has been made, but in others it has not.
Perhaps this explains why various things (e.g. the dynamics engine) are broken?
@jvarley - any thoughts?
I will go ahead and merge this since the only thing that uses localToWorldWrenchMatrix() is GFO stuff, where the change is needed, but I am still worried about the stuff mentioned above...
…Eigen behavior. The behavior of this function is now in line with it's description. I believe the EGPlanner does not use this method, so that should be fine?