Refactor TCP Offset to Include Rotation

[juelg]

Currently the TCP Offset which is included as an additional tag in the MuJoCo model files only supports translation.

[juelg]

started in #206 but its not clear if having the TCP offset in the mjcf is the best way to go.