public ObstacleState(PointD position, double radius)
 {
     pp = new PredictablePosition(position);
     this.radius = radius;
 }       
 public ObstacleState()
 {
     pp = new PredictablePosition();
     this.radius = 0;
 }