Replace `Eigen::Isometry3f` class with `Pose`

[Woolfrey]

Related classes:

• RigidBody
• Payload
• CartesianTrajectory

[Woolfrey]

@ssutjipto see:

• Joint
• RigidBody

Still haven't done CartesianTrajectory, but it's not necessary for getting the KinematicTree class working.