Fix World bug, add better reporting to tests

Attempting to diagnose why real robot won't pass tests.