Refactor Moveit2Trajectory class to enhance trajectory handling and add batch retrieval methods for joint and Cartesian states