radio/src/serial.cpp

   1 /*
   2  * Copyright (C) OpenTX
   3  *
   4  * Based on code named
   5  *   th9x - http://code.google.com/p/th9x
   6  *   er9x - http://code.google.com/p/er9x
   7  *   gruvin9x - http://code.google.com/p/gruvin9x
   8  *
   9  * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  */
  20
  21 #include "opentx.h"
  22 #include "serial.h"
  23 #include <stdarg.h>
  24 #include <stdio.h>
  25
  26 #define PRINTF_BUFFER_SIZE    128
  27
  28 void serialPutc(char c) {
  29 #if !defined(BOOT) && defined(USB_SERIAL)
  30   if (getSelectedUsbMode() == USB_SERIAL_MODE)
  31     usbSerialPutc(c);
  32 #endif
  33 #if defined(AUX_SERIAL)
  34   if (auxSerialTracesEnabled())
  35     auxSerialPutc(c);
  36 #endif
  37 }
  38
  39 void serialPrintf(const char * format, ...)
  40 {
  41   va_list arglist;
  42   char tmp[PRINTF_BUFFER_SIZE+1];
  43
  44   va_start(arglist, format);
  45   vsnprintf(tmp, PRINTF_BUFFER_SIZE, format, arglist);
  46   tmp[PRINTF_BUFFER_SIZE] = '\0';
  47   va_end(arglist);
  48
  49   const char *t = tmp;
  50   while (*t) {
  51     serialPutc(*t++);
  52   }
  53 }
  54
  55 void serialCrlf()
  56 {
  57   serialPutc('\r');
  58   serialPutc('\n');
  59 }