Fixing missing addData method in setOccupiedVoxelAtPoint/OctreePointCloudOccupancy
Merge pull request #551 from jkammerl/OctreePointCloudOccupancy-fix

Fixing missing addData method in OctreePointCloudOccupancy