Robot class is working better.
Got Jacobian working for robot class.
Added Hubo class.
Updated names of reference frames and changed name of namespace.
Added the arm IK and wrote a tutorial.