Working version of Wrangler.java. All that remains is obstacle + dangerZone avoidance