Add a testing world plugin, which contains a topic publisher
Testing Dynamics Joint Generation
Add contact sensor plugin, which is not actually sensor but used to trigger connection between different model
1. Including connection monitor. 2. Including the connection triger layer. 3. Not correct Euler angle calculation. 4. No angle holding function, may try 'prismatic' type of joint
1. Fixed the problem of the equation to calculate the Eular angles of the frame on the opposite side of the current parent link.
2. Fixed the problem that dynamic joint not been constrained.
3. Connection monitoring layer has been built, and pretty good connection performance.