Implementational part of BSc Thesis in University of Zagreb, Faculty of Electrical Engineering and Computing.