public static void drive(List <TupleXY> list, int speed)
{
double degreePrior = 0.0;
TupleXY tupPrior = new TupleXY(0, 0);
foreach (TupleXY tup in list)
{
double degree = calcDegree(tupPrior._x, tupPrior._y, tup._x, tup._y);
double dist = calcDistance(tupPrior._x, tupPrior._y, tup._x, tup._y);
turn(degreePrior, degree, dist, speed);
tupPrior = tup;
degreePrior = degree;
}
}
public static List <TupleXY> genCircle(int radius, int fidelity)
{
List <TupleXY> list = new List <TupleXY>();
for (int i = 0; i < fidelity; i++)
{
double t = 2 * Math.PI * i / fidelity;
int x = (int)Math.Round(radius * Math.Cos(t));
int y = (int)Math.Round(radius * Math.Sin(t));
TupleXY tup = new TupleXY(x, y);
list.Add(tup);
}
return(list);
}
