Added a function to generate newG matrix to be used as input for path finding
Merge branch 'master' of https://github.com/swook/project-bambi