adding some documenation to metapod

This commit adds documentation to use forward kinematics and to manipulate the nodes inside metapod.
It also adds some explanation on how to read the transform matrices when display with an ostream object