Some late night/early morning adjustments on common functionality and graph slam method. I made sure that graph slam works with newly created common functionality class and can make correct calculations without errors. So, also fixed bugs that existed in CommonFunctionality and also in graph slam class to fit new data structure. Seems to work fine with small test case. Looking forward for bigger test cases. Also fixed issue of seeing all landmarks/no landmarks. It all works now
issueId #8