velocity_average.py

#  move_to_point({{0, 40, 0}, HOLD_ANGLE});
#  or
#  move_to_point({{40, 0, 0}, HOLD_ANGLE});
#
#  double cur, last, vel;
#  double cur_time, last_time;
#  while (true) {
#    cur = get_left();
#    cur_time = pros::millis();
#
#    vel = (cur - last) / (cur_time - last_time);
#
#    last = cur;
#    last_time = cur_time;
#
#    if (vel != 0) printf("%f, \n", vel);
#
#    pros::delay(DELAY_TIME);
#  }


x_vel = [
    0.036942,
    0.036166,
    0.030888,
    0.034924,
    0.037330,
    0.040356,
    0.035157,
    0.036166,
    0.034070,
    0.036321,
    0.038727,
    0.036476,
    0.041986,
    0.035545,
    0.036942,
    0.038183,
    0.038571,
    0.036088,
    0.036476,
    0.035700,
    0.038649,
    0.038261,
    0.035855,
    0.038028,
    0.039736,
    0.036786,
    0.038959,
    0.043383,
    0.036476,
    0.039736,
    0.037330,
    0.039658,
    0.038106,
    0.038804,
    0.042452,
    0.038339,
    0.035933,
    0.037330,
    0.037795,
    0.033993,
    0.035389,
    0.036476,

    0.036942,
    0.036166,
    0.030888,
    0.034924,
    0.037330,
    0.040356,
    0.035157,
    0.036166,
    0.034070,
    0.036321,
    0.038727,
    0.036476,
    0.041986,
    0.035545,
    0.036942,
    0.038183,
    0.038571,
    0.036088,
    0.036476,
    0.035700,
    0.038649,
    0.038261,
    0.035855,
    0.038028,
    0.039736,
    0.036786,
    0.038959,
    0.043383,
    0.036476,
    0.039736,
    0.037330,
    0.039658,
    0.038106,
    0.038804,
    0.042452,
    0.038339,
    0.035933,
    0.037330,
    0.037795,
    0.033993,
    0.035389,
    0.036476,

    0.035622,
    0.035001,
    0.031587,
    0.033216,
    0.033760,
    0.033372,
    0.035622,
    0.032596,
    0.035545,
    0.037485,
    0.035001,
    0.033449,
    0.036942,
    0.035467,
    0.036088,
    0.035622,
    0.033682,
    0.035389,
    0.038106,
    0.035312,
    0.036321,
    0.040822,
    0.033294,
    0.034536,
    0.038494,
    0.038494,
    0.035312,
    0.035545,
    0.039968,
    0.038339,
    0.036942,
    0.038882,
    0.039115,
    0.036243,
    0.040977,
    0.043849,
    0.039580,
    0.043538,
    0.041831,
    0.035545,
    0.036786,
    0.036864,
    0.036786,
    0.035700,

    0.034303,
    0.033061,
    0.035157,
    0.035079,
    0.030888,
    0.033915,
    0.038727,
    0.035001,
    0.032596,
    0.033915,
    0.036398,
    0.036554,
    0.036398,
    0.033294,
    0.036010,
    0.036631,
    0.034381,
    0.036554,
    0.038106,
    0.034691,
    0.036942,
    0.076522,
    0.037097,
    0.038416,
    0.039348,
    0.037951,
    0.036942,
    0.036243,
    0.037795,
    0.036321,
    0.040822,
    0.039192,
    0.000000,
    0.041210,
    0.038183,
    0.038804,
    0.043306,
    0.038494,
    0.037795,
    0.036631,
    0.038727,
    0.036554]


y_vel = [
    0.057584,
    0.055488,
    0.053315,
    0.050987,
    0.057817,
    0.058127,
    0.065888,
    0.060222,
    0.057817,
    0.057972,
    0.059214,
    0.059912,
    0.062318,
    0.061775,
    0.066276,
    0.059524,
    0.061231,
    0.064491,
    0.065965,
    0.062939,
    0.066897,
    0.062240,
    0.072795,
    0.064956,
    0.064103,
    0.063404,
    0.067440,
    0.073027,
    0.061775,
    0.060222,
    0.060610,
    0.059912,

    0.048970,
    0.051686,
    0.054712,
    0.056653,
    0.056109,
    0.054635,
    0.053936,
    0.055023,
    0.056342,
    0.057817,
    0.058826,
    0.059834,
    0.059136,
    0.062395,
    0.060843,
    0.060222,
    0.060455,
    0.061387,
    0.069613,
    0.066043,
    0.061154,
    0.061542,
    0.059834,
    0.074968,
    0.064413,
    0.061542,
    0.065422,
    0.062706,
    0.064724,
    0.063482,
    0.065888,
    0.070466,
    0.072795,
    0.061542,
    0.057351,
    0.055256,

    0.056265,
    0.054790,
    0.058205,
    0.059446,
    0.056342,
    0.057972,
    0.060300,
    0.059214,
    0.064801,
    0.060998,
    0.060610,
    0.062318,
    0.059446,
    0.060688,
    0.063948,
    0.059834,
    0.063249,
    0.060766,
    0.063016,
    0.071243,
    0.061697,
    0.064180,
    0.059912,
    0.056730,
    0.063715,
    0.059136]


def Average(l):
    avg = sum(l) / len(l)
    return avg


x_avg = Average(x_vel)
y_avg = Average(y_vel)


print("Average x velocity ", x_avg)
print("Average y velocity ", y_avg)