costmap: char changed to signed char to prevent underflow
TrajectoryMatch: error message added before illegal score exception
wandering: velocities adjusted to match himoto robot minimum limits, rear side trajectories randomization added