I have plotted the campus bagfile as mentioned. I managed to get the shape when plotting x and y.  However, when I plot the z position, it is always increasing. 
I have plotted the campus bagfile as mentioned. I managed to get the shape when plotting x and y.

However, when I plot the z position, it is always increasing.
