Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

[KinematicInertial] Fix use of state-observation #391

Merged
merged 1 commit into from
Sep 12, 2023

Conversation

arntanguy
Copy link
Collaborator

This PR fixes the mistakes introduced by #388 (I have temporarely reverted it on master with d4de8d3)
During walking I could see no differences checking the results of the old versus new method.

However, while perturbing the robot manually (dragging it around in choreonoid), there are still slight differences.
For example (displayed as RPY angles)

[info] New:   0.22885 -0.218569    2.3249
[info] Old:  0.234254 -0.212752   2.29964
[info] New:  0.231229 -0.220776   2.32437
[info] Old:  0.236799 -0.214775   2.29859
[info] New:  0.233628 -0.223039   2.32383
[info] Old:   0.23937 -0.216849   2.29751
[info] New:  0.236055 -0.225358   2.32327
[info] Old:  0.241975 -0.218971    2.2964
[info] New:  0.238506 -0.227731    2.3227
[info] Old:  0.244613 -0.221141   2.29526

@mehdi-benallegue Could you confirm that this is indeed correct?

@arntanguy arntanguy requested a review from gergondet September 11, 2023 07:50
@arntanguy arntanguy force-pushed the topic/FixKinematicInertial branch from 9ce7fa3 to 774748a Compare September 11, 2023 07:53
@gergondet gergondet force-pushed the topic/FixKinematicInertial branch from 774748a to d99f429 Compare September 12, 2023 02:35
@gergondet
Copy link
Member

Hi @arntanguy

I have made some tests and found the correct version to call in state-observation (the one was that was copy-pasted from the state-observation repo back then) although it required a fix in state-observation jrl-umi3218/state-observation@ba30318

Will merge when the CI lands

@gergondet gergondet force-pushed the topic/FixKinematicInertial branch from d99f429 to da12375 Compare September 12, 2023 04:21
@gergondet gergondet merged commit ad5d548 into jrl-umi3218:master Sep 12, 2023
gergondet added a commit that referenced this pull request Sep 19, 2023
Added
---

- [mc_control] Added motor status to joint sensor (#395)
- [mc_control/FSM] Posture tasks' reset can be disabled (#389)
- [mc_rtc/Configuration] Added support for `std::variant` (#393)
- [mc_rtc/Configuration] Added `Configuration::find` (#393)
- [mc_rtc/GUI] Added form elements to provide more complex forms (#394)

Changes
---

- [mc_control/FSM] FSM embedded in a Meta state no longer reset the posture at transition by default (#389)

Fixes
---

- [mc_observers] KinematicInertial uses the correct function from state-observation (#391)
- [mc_solver] Fix a crash in monitor activation
- [mc_tvm] Correctly include refAccel in Orientation|PositionFunction
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants