Remove a bunch of logging to better see what's going on. Code also working for now OMG. Need to start implementing mocking as shadows and scannign real objects (pr2 branch...).