added additional features for planning and costmaps