the 2D coordinate frame plotting
Merge pull request #99 from ethz-asl/2D_coordinate_frame

the 2D coordinate frame plotting