added pid unit5, hw4 solution and visualization. added slam unit6-7 solution