Improve display in gepetto-viewer and create function for recording videos
There is a list of things that we should improve:
- Changed background from blue to white.
- Create a function that saves properly the frame and make a video. Using the record button in GV gui renders videos that aren't consistent with time.
displayTrajectorymight be use a stack of robots. This will render multiple robots and trajectories.