All functions of original Matlab file have been added and tested.
Features now can be abstracted.