Fixed bug in drawing_tools.  Added recent scan/pose variable so that we use a consistent pose/scan (current_scan) in each of the particle update functions.