public PathFollower()
{
pid = new PID();
pathfollower = new Thread(pathRunner);
angular = new PID();
cal = new Calculation();
}
public PathPlanning()
{
changepath = new int();
FinalDistance = new double();
FinalAngle = new double();
cal = new Calculation();
pid =new PID();
Newpath = new ObstacleTrejectory();
changepath = 1;
Rob_P_dist = new double();
index = new int();
pathcomplete = 1;
x = new int[360];
y = new int[360];
for (int i=0; i<360;i++)
{
x[i] =(int) (-1700 + 800 * Math.Cos((i+180) * Math.PI / 180));
y[i] = (int)(0 + 800 * Math.Sin((i+180) * Math.PI / 180));
}
}