modified the parameter reading to get the robot footprint and compute the right robot radius, no usage of inflated obstacles anymore, instead obstacles are drawn with robot radius