Initial implementation of presented algorithms