added param for general nav. goals
added approach pose + error
added charing pose