issue #2771: add more joints
issue #2771: add more joint tests, add some joint api, fix bugs
Merge pull request #4417 from boyu0/iss2771_physical

[ci skip]issue #2771 physical, add more joint and joint tests