Express Vector and orientation in a different referencial in C++ with Eigen

Question

Let\'s say I have three referencials (A,B and C)

I know the following values:

• the position of B in A (as an Eigen::Vector3d)
• the orienta