yaw is now correct, but it's only a hack
corrected comment
generateGoals and testing added
class method names pythonicized
goto is now goto_map and goto_real
split run into several programs for convenience and added run_sample_grid