Rollback change on rec. behaviors as it doesn't work. Clear costmaps instead