#include "ArduinoLog.h"

/*
    _   ___ ___  _   _ ___ _  _  ___  _    ___   ___
   /_\ | _ \   \| | | |_ _| \| |/ _ \| |  / _ \ / __|
  / _ \|   / |) | |_| || || .` | (_) | |_| (_) | (_ |
  /_/ \_\_|_\___/ \___/|___|_|\_|\___/|____\___/ \___|

  Log library for Arduino
  version 1.0.3
  https://github.com/thijse/Arduino-Log

  Licensed under the MIT License <http://opensource.org/licenses/MIT>.

  Permission is hereby  granted, free of charge, to any  person obtaining a copy
  of this software and associated  documentation files (the "Software"), to deal
  in the Software  without restriction, including without  limitation the rights
  to  use, copy,  modify, merge,  publish, distribute,  sublicense, and/or  sell
  copies  of  the Software,  and  to  permit persons  to  whom  the Software  is
  furnished to do so, subject to the following conditions:

  The above copyright notice and this permission notice shall be included in all
  copies or substantial portions of the Software.

  THE SOFTWARE  IS PROVIDED "AS  IS", WITHOUT WARRANTY  OF ANY KIND,  EXPRESS OR
  IMPLIED,  INCLUDING BUT  NOT  LIMITED TO  THE  WARRANTIES OF  MERCHANTABILITY,
  FITNESS FOR  A PARTICULAR PURPOSE AND  NONINFRINGEMENT. IN NO EVENT  SHALL THE
  AUTHORS  OR COPYRIGHT  HOLDERS  BE  LIABLE FOR  ANY  CLAIM,  DAMAGES OR  OTHER
  LIABILITY, WHETHER IN AN ACTION OF  CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  OUT OF OR IN CONNECTION WITH THE SOFTWARE  OR THE USE OR OTHER DEALINGS IN THE
  SOFTWARE.
*/

// #include "ArduinoLog.h"

void Logging::begin(int level, Print* logOutput, bool showLevel)
{
#ifndef DISABLE_LOGGING
  setLevel(level);
  setShowLevel(showLevel);
  _logOutput = logOutput;

#endif
}

void Logging::setLevel(int level)
{
#ifndef DISABLE_LOGGING
  _level = constrain(level, LOG_LEVEL_SILENT, LOG_LEVEL_VERBOSE);
#endif
}

int Logging::getLevel() const
{
#ifndef DISABLE_LOGGING
  return _level;
#else
  return 0;
#endif
}

void Logging::setOutput(Print* output)
{
#ifndef DISABLE_LOGGING
  _logOutput = output;
#endif
}

void Logging::setShowLevel(bool showLevel)
{
#ifndef DISABLE_LOGGING
  _showLevel = showLevel;
#endif
}

bool Logging::getShowLevel() const
{
#ifndef DISABLE_LOGGING
  return _showLevel;
#else
  return false;
#endif
}

void Logging::setPrefix(printfunction f)
{
#ifndef DISABLE_LOGGING
  _prefix = f;
#endif
}

void Logging::setSuffix(printfunction f)
{
#ifndef DISABLE_LOGGING
  _suffix = f;
#endif
}

void Logging::print(const __FlashStringHelper *format, va_list args)
{
#ifndef DISABLE_LOGGING
  PGM_P p = reinterpret_cast<PGM_P>(format);
  char c = pgm_read_byte(p++);
  for (; c != 0; c = pgm_read_byte(p++))
  {
    if (c == '%')
    {
      c = pgm_read_byte(p++);
      printFormat(c, &args);
    }
    else
    {
      _logOutput->print(c);
    }
  }
#endif
}

void Logging::print(const char *format, va_list args) {
#ifndef DISABLE_LOGGING
  for (; *format != 0; ++format)
  {
    if (*format == '%')
    {
      ++format;
      printFormat(*format, &args);
    }
    else
    {
      _logOutput->print(*format);
    }
  }
#endif
}

void Logging::printFormat(const char format, va_list *args) {
#ifndef DISABLE_LOGGING
  if (format == '%')
  {
    _logOutput->print(format);
  }
  else if (format == 's')
  {
    register char *s = (char *)va_arg(*args, int);
    _logOutput->print(s);
  }
#if !defined(ESP8266)
  else if (format == 'S')
  {
    String s = (String)va_arg(*args, String);
    _logOutput->print(s);
  }
  else if (format == 'I')
  {
    char s[16];
    IPAddress ip = (IPAddress)va_arg(*args, IPAddress );
    sprintf(s, "%d.%d.%d.%d", ip[0], ip[1], ip[2], ip[3]);
    _logOutput->print(s);
  }
#endif
  else if (format == 'P')
  {
    register __FlashStringHelper *s = (__FlashStringHelper *)va_arg(*args, int);
    _logOutput->print(s);
  }
  else if (format == 'd' || format == 'i')
  {
    _logOutput->print(va_arg(*args, int), DEC);
  }
  else if (format == 'D' || format == 'F')
  {
    _logOutput->print(va_arg(*args, double));
  }
  else if (format == 'x')
  {
    _logOutput->print(va_arg(*args, int), HEX);
  }
  else if (format == 'X')
  {
    _logOutput->print("0x");
    _logOutput->print(va_arg(*args, int), HEX);
  }
  else if (format == 'b')
  {
    _logOutput->print(va_arg(*args, int), BIN);
  }
  else if (format == 'B')
  {
    _logOutput->print("0b");
    _logOutput->print(va_arg(*args, int), BIN);
  }
  else if (format == 'l')
  {
    _logOutput->print(va_arg(*args, long), DEC);
  }
  else if (format == 'u')
  {
    _logOutput->print(va_arg(*args, unsigned long), DEC);
  }
  else if (format == 'c')
  {
    _logOutput->print((char) va_arg(*args, int));
  }
  else if (format == 't')
  {
    if (va_arg(*args, int) == 1)
    {
      _logOutput->print("T");
    }
    else
    {
      _logOutput->print("F");
    }
  }
  else if (format == 'T')
  {
    if (va_arg(*args, int) == 1)
    {
      _logOutput->print(F("true"));
    }
    else
    {
      _logOutput->print(F("false"));
    }
  }
#endif
}

Logging Log = Logging();
StaticSemaphore_t semMutexBuffer;
SemaphoreHandle_t semLog = xSemaphoreCreateMutexStatic( &semMutexBuffer );