WRITE_TRAJECTORY

Write Optimization Trajectory