modd gmapping
Working on navigate.
changes..
Small modifications
Merged local changes to remote.