Fix hybrid Points to Set

Fixes the recently changed HybridPointsToSet since there was an error in fastAdd() where Nodes could be added several times because of two null checks.
In addition remove some unnecessary final declarations, casts, and use foreachs.