visualize trajectory
add color map