More work on object tracker node. Finished matched shape callback.
Shape matcher outputs standard image coordinates now, add initial work on 3d reconstruction to object tracker.