add pedestrian and simple gui
1. simple gui to show
2. add handle to plot functions
3. plot lidars as long as simulation