added focus tool implementation
changed focus tool status text
added point coordinate to focus tool status text
Merge pull request #578 from ros-visualization/focus_tool

added focus tool implementation