Added some controller and urdf changes to work with all parts of the head and to publish the hands