public INS_reader()
{
for (int i = 0; i < _hz_log_count; i++)
{
_hz_rate_log.Enqueue(0);
}
Console.WriteLine($"Getting INS Serial Port");
_serialPort = SerialReader.GetSerialPort(ArduinoTypes.INS);
Console.WriteLine($"Opening INS Serial Port");
Console.WriteLine($"INS Serial Port Opened");
}