Added distance function.
Added armadillo library for vectorization.
Switched to using armadillo vectors.
Corrected functio names.
In process of debugging names.
Finished integration algorithm implementation.

Need to debug and check if result is correct. When commiting currently
in process of debugging.