More realistic trajectory generation, output to file, 3D plotter