Fixed bugs and changed number_of_iterations, also added temp verbose which is to be improved further
Added test results after code rewrite