Renamed position attitude visualization
Revised trace geometry updates
Update robot trace on timeline change
Updates debug messages
Merge pull request #13 from NSchertler/master

Updated robot trace