Updated method of finding occluded points - now doesn't use image plane projection. Still need to eliminate points in front of occlusion.
Merge branch 'peter'