Simulator for high level robotics snowplow planning