Proposal
Add documentation to guide how to define a specific robot (by defining a custom cfg file). Also give template interface to make it more easy to read and maintain.
Motivation
Currently we have two specific robots DexforceW1 and CobotMagic. However, we have no docs for them yet and the implementation is not easy to understand and maintainable.
Checklist