void InitQCControls() {
	currTime = 0.0;
	lastTime = 0.0;
	hoverThrottle = settings.GetDouble("copter_throttle_hover");

	fout.open("data.txt");

	err = 0.0;
	errAcc = 0.0;
	lastErr = 0.0;

	errF = 0.0;
	lastErrF = 0.0;
	errAccF = 0.0;
}
double ConfigManager::get_value<double>(const Settings settings, const char* key) const
{
  if (key != nullptr)
  {
    if (settings[key].IsNumber() && settings.HasMember(key))
      return settings[key].GetDouble();
    else
      throw ConfigException("Configuration Manager: Parse error.");
  }
  else
  {
    if (settings.IsNumber())
      return settings.GetDouble();
    else
      throw ConfigException("Configuration Manager: Parse error.");
  }
}