...
I built function that can output height and angle data from input of coordinate data. Simulator can reflect to motion from condition of geography by this function. But angle data is not stable and not correctly. Function should be more improved by other method.
Reference
https://code.google.com/p/libcitygml/
http://www.opengeospatial.org/standards/citygml