simplification
added more debugging commands
Init OpenGL before Kalman Filter
Added rough surface estimation
Improved some variable names
Initial drawing frame in opengl window
Removed Observations structure