Node restart fixed somewhat
Merge branch 'master' of http://github.com/ROS-PSE/arni