Utilities.h

#pragma once

#include "CoordSet.h"
#include "ping.h"

#define SPEED_OF_SOUND_MODIFIER 0.03448F

/*
// CoordSet Ultilities
*/

// Calculates center coordinates between the position before and during the deviation (Assumes a maximum difference in position of MAX_DISTANCE_BETWEEN_MEASUREMENTS)
CoordSet calcCenterBetweenMeasurementPoints(CoordSet setA, CoordSet setB);

// Calculates center coordinates between two points (Assumes one of the axis is more or less equal to each other and only calculates the other axis)
CoordSet calcCenterBetweenPoints(CoordSet setA, CoordSet setB);

float pingCm(int pin);