Algorithms fix: take into account transform between base and camera, transform from pixels to 3d points. Added marker publishing