Enhancement

Updating your fork...
Some enhancements for the core and many changes for the normal ROS node