RTR pályatervezés optimalizáció nélkül, a Matlab kóddal nem teljesen egyező eredményt ad