Python Plot 3d Trajectory