Fix minor bug in resample test: the weights array had the wrong shape.

Add more motion model tests to identify turning issues.

Show particle filter plot legend to label state estimate vs ground truth.