Some more logging in world to attempt to pinpoint source of record object pose freezing issue. Also some compulsive refactoring.
Cleanup TODOs.
Tiny cleanup in tests and add robot speech TODO.
Merge pull request #17 from mbforbes/tests

Cosmetic issues, light refactoring, update TODOs