mt_add_trajectory function

Add new trajectory to trajectory array.