I have implemented a 3D photo function that is computational not very intensive. It gets triggered by pressing a key when a snapshot is wanted. By that it is possible to add a big Point Cloud around the map as you can see here:

Now writing needs to be finished, code needs to be commented and cleaned up – last two weeks already begun.