Added state publisher of complete kinematic chain

Using the state publisher, the robot's environment can be published in RVIZ