Hi Rongzhong,
I am doing a test and have commented out the #define GYRO in OpenCat.h, disabling the use of the MPU6050.
So far all abnormal jerking is gone, include quite aggressive movements in some Postures. In many ways this is a superior execution for the movements I need Nybble to be able to complete (I won't be asking the robot to walk up stairs of any significant incline movements in the short term).
Two questions.
- Now that the MPU is disabled, the walking, trot and crawl gaits are quite fast. Is there a location to define these to slow down.
- Is there any plan to re-write the GYRO routines to address the post transform movement jerkiness.
Overall I like your work. Well done. I do recommend though, as a general comment, if you are considering a faster CPU, then a re-write/clean-up of the code is possibly in order, especially to remove compiler directives intermixed within the code lines. These, and the use of interrupt processing mixed in with the general procedural nature in the code, makes the code difficult to read and troubleshoot.
Once again, well done so far. I hope the project succeeds to your best wishes.
Best regards
D L