public GetPlanRequest(Geometry.PoseStamped start, Geometry.PoseStamped goal, float tolerance)
 {
     this.start     = start;
     this.goal      = goal;
     this.tolerance = tolerance;
 }
 public GetPlanRequest()
 {
     this.start     = new Geometry.PoseStamped();
     this.goal      = new Geometry.PoseStamped();
     this.tolerance = 0.0f;
 }