mt_plot_add_rect function

Add rectangles to trajectory plot.