Add robotsim export trajectory function