added thirt part of the algo
add test routines
updated with test routines
update .pro file with new files