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 (getSelectedUsbMode() == USB_SERIAL_MODE)
  30     usbSerialPutc(c);
  31 #if defined(SERIAL2)
  32   if (serial2TracesEnabled())
  33     serial2Putc(c);
  34 #endif
  35 }
  36
  37 void serialPrintf(const char * format, ...)
  38 {
  39   va_list arglist;
  40   char tmp[PRINTF_BUFFER_SIZE+1];
  41
  42   va_start(arglist, format);
  43   vsnprintf(tmp, PRINTF_BUFFER_SIZE, format, arglist);
  44   tmp[PRINTF_BUFFER_SIZE] = '\0';
  45   va_end(arglist);
  46
  47   const char *t = tmp;
  48   while (*t) {
  49     serialPutc(*t++);
  50   }
  51 }
  52
  53 void serialCrlf()
  54 {
  55   serialPutc('\r');
  56   serialPutc('\n');
  57 }