refactored to include aslo fuzzy gates
trying to add better test suit for ROS nodes, does not work well, testing..