Making joint_state more robust by cheking if exist the element before getting the values.
Comment the debug output
Initial version of RobotState class, it will allow to calculate the forward kinematic using KDL and it will keep the state of the robot (kdl tree and Joint angle positions).
Merge branch 'master' of github.com:pablospe/calibration

Conflicts:
	calibration_estimation/CMakeLists.txt