src/main/drivers/serial.c

   1 /*
   2  * This file is part of Cleanflight.
   3  *
   4  * Cleanflight is free software: you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation, either version 3 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * Cleanflight is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License
  15  * along with Cleanflight.  If not, see <http://www.gnu.org/licenses/>.
  16  */
  17
  18 #include <stdbool.h>
  19 #include <stdint.h>
  20
  21 #include "platform.h"
  22
  23 #include "serial.h"
  24
  25 void serialPrint(serialPort_t *instance, const char *str)
  26 {
  27     uint8_t ch;
  28     while ((ch = *(str++)) != 0) {
  29         serialWrite(instance, ch);
  30     }
  31 }
  32
  33 uint32_t serialGetBaudRate(serialPort_t *instance)
  34 {
  35     return instance->baudRate;
  36 }
  37
  38 void serialWrite(serialPort_t *instance, uint8_t ch)
  39 {
  40     instance->vTable->serialWrite(instance, ch);
  41 }
  42
  43
  44 void serialWriteBuf(serialPort_t *instance, const uint8_t *data, int count)
  45 {
  46     if (instance->vTable->writeBuf) {
  47         instance->vTable->writeBuf(instance, data, count);
  48     } else {
  49         for (const uint8_t *p = data; count > 0; count--, p++) {
  50
  51             while (!serialTxBytesFree(instance)) {
  52             };
  53
  54             serialWrite(instance, *p);
  55         }
  56     }
  57 }
  58
  59 uint32_t serialRxBytesWaiting(const serialPort_t *instance)
  60 {
  61     return instance->vTable->serialTotalRxWaiting(instance);
  62 }
  63
  64 uint32_t serialTxBytesFree(const serialPort_t *instance)
  65 {
  66     return instance->vTable->serialTotalTxFree(instance);
  67 }
  68
  69 uint8_t serialRead(serialPort_t *instance)
  70 {
  71     return instance->vTable->serialRead(instance);
  72 }
  73
  74 void serialSetBaudRate(serialPort_t *instance, uint32_t baudRate)
  75 {
  76     instance->vTable->serialSetBaudRate(instance, baudRate);
  77 }
  78
  79 bool isSerialTransmitBufferEmpty(const serialPort_t *instance)
  80 {
  81     return instance->vTable->isSerialTransmitBufferEmpty(instance);
  82 }
  83
  84 void serialSetMode(serialPort_t *instance, portMode_t mode)
  85 {
  86     instance->vTable->setMode(instance, mode);
  87 }
  88
  89 void serialWriteBufShim(void *instance, const uint8_t *data, int count)
  90 {
  91     serialWriteBuf((serialPort_t *)instance, data, count);
  92 }
  93
  94 void serialBeginWrite(serialPort_t *instance)
  95 {
  96     if (instance->vTable->beginWrite)
  97         instance->vTable->beginWrite(instance);
  98 }
  99
 100 void serialEndWrite(serialPort_t *instance)
 101 {
 102     if (instance->vTable->endWrite)
 103         instance->vTable->endWrite(instance);
 104 }
 105
 106 bool serialIsConnected(const serialPort_t *instance)
 107 {
 108     if (instance->vTable->isConnected)
 109         instance->vTable->isConnected(instance);
 110
 111     // If API is not defined - assume connected
 112     return true;
 113 }
 114
 115 bool serialIsIdle(serialPort_t *instance)
 116 {
 117     if (instance->vTable->isIdle)
 118         return instance->vTable->isIdle(instance);
 119     else
 120         return false;
 121 }