Initial dp_slam commit. Not workig yet. Defining data-structure