RTR optimalizáció, még mindig eltér kicsit a Matlab-tól