How can I apply this algorithm to a three-dimensional model

Hello, I would like to apply this algorithm to a three-dimensional model for surveillance layout. Should I simply add elevation data to the point coordinates? Also, could you please let me know where in the code I need to make modifications?