uzh-rpg/rpg_trajectory_evaluation

How do I fix the scaling issue when plotting the results?

Opened this issue · 0 comments

Hello!
I was trying to run this library but am facing issues regarding scaling. For simplicity i made a small example using a square.
figure_1
I basically generated a blue square and rotated it and scaled it up by 2. all the points for these squares are saved into their appropriate files like so:
Ground Truth (Original Square):
0 -2 -2 0 0 0 0 1
1 -2 2 0 0 0 0 1
2 2 2 0 0 0 0 1
3 2 -2 0 0 0 0 1
4 -2 -2 0 0 0 0 1

Estimate (Rotated and up-scaled Square):
0 5.36828111892 -1.78369218989 0.0 0.0 0.0 0.850903524534 0.525321988818
1 -1.78369218989 -5.36828111892 0.0 0.0 0.0 0.850903524534 0.525321988818
2 -5.36828111892 1.78369218989 0.0 0.0 0.0 0.850903524534 0.525321988818
3 1.78369218989 5.36828111892 0.0 0.0 0.0 0.850903524534 0.525321988818
4 5.36828111892 -1.78369218989 0.0 0.0 0.0 0.850903524534 0.525321988818

After I run the library on these files the library gives me this output.

Screenshot from 2022-09-07 21-10-09

As you can see it manages to correct the rotation but does not resize it.

I have ran the library on one of the examples (the one mentioned in the readme.md) and I get the correct result.