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.