mp_500 and mpo_500 costmaps added