[planning-cpp] Const correctness and use of size_t in rasters.
[planning-cpp] Const correctness and use of size_t in rasters.

fire-rs-laas/fire-rs-saop,fire-rs-laas/fire-rs-saop,fire-rs-laas/fire-rs-saop,fire-rs-laas/fire-rs-saop