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.
Fix the bug for 4310 position read.
Originally, the position read by 4310 is between -2pi
0, but the command that 4310 receives is from -pipi, so if we set 4310 to its current position read, it's possible to see that 4310 will suddenly rotation one full rotation. This is probably because the position data is 16 bits and we are using 16-bit int data type in the code.WARNING: This commit only fixes this problem by wrapping the angle received between -P_MAX and P_MAX, and does not try to fix the issue from the basic level.
Allow change in 4310 position feedback range.
Originally, 4310 feedback range is a constant (-PI~PI). But actually, the range can be changed using dm's PC software. So now there's a second constructor for 4310 motor that allows customized position feedback range.