costmap_2d: use std::fill_n instead of memset to initialize arrays

memset corrupts the heap as a bool array of size n has a size less than (n * sizeof(bool)).