Fixed wrist flex incorrect calibration for LeKiwi #1787
Merged
+1
−1
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Currently, all motors that have
wristin their name are treated as full-turn motors during calibration of LeKiwi (unlike for so-100 wher onlywrist_rollis treated like this). Butwrist_flexis not a full_turn_motor (it has only a 180-degree range) and should be calibrated; onlywrist_rollis a full-turn motor.As a result, wrist_flex on LeKiwi is moving to an angle that is 2 times bigger than the actual action.
What this does
It simply includes only
wrist_rollin the list offull_turn_motors, but notwrist_flexHow it was tested + How to checkout & try? (for the reviewer)
Calibrate LeKiwi and try to control it using so arm. The current main version will incorrectly control wrist_flex: e.g. when it is 45 degrees for the Leader arm, it will be 90 for the Follower.
If you calibrate LeKiwi with the fixed logic, it will be fine.