Moved trajectory visualization from ROSInterface to new file.
Enhanced trajectory visualization features.