prt.cpp

//
// OOSMOS prt Class
//
// Copyright (C) 2014-2020  OOSMOS, LLC
//
// This program is free software; you can redistribute it and/or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation, version 2 of the License ("GPLv2").
//
// This software may be used without the GPLv2 restrictions by entering
// into a commercial license agreement with OOSMOS, LLC.
// See <https://www.oosmos.com/licensing/>.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
// GNU General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program.  If not, see <http://www.gnu.org/licenses/>.
//

#define MaxBuffer 100

#include "oosmos.h"
#include "prt.h"
#include <stdarg.h>
#include <stdint.h>
#include <stdio.h>

#if defined(ARDUINO)
  #include <stdbool.h>
  extern uint32_t prtArduinoBaudRate;
#endif

extern void prtFormatted(const char * pFormat, ...)
{
  char Buffer[MaxBuffer];

  va_list ArgList; //lint -e438
  va_start(ArgList, pFormat);
    (void) vsnprintf(Buffer, MaxBuffer, pFormat, ArgList);
  va_end(ArgList);

  #if defined(ARDUINO)
    static bool First = true;

    if (First) {
      First = false;

      Serial.end();
      Serial.begin(prtArduinoBaudRate);
    }

    Serial.print(Buffer);
    Serial.flush();
  #else
    printf("%s", Buffer);
  #endif
}