Check TX buffer space before calling serialWrite

- Check TX buffer space before calling serialWrite (which
unconditionally manipulates buffer management variables).
- Added available TX buffer space as one of debug variables.
- Use blackboxWrite() instead of serialWrite in blackboxWriteString().

src/main/blackbox/blackbox_io.c

@@ -127,15 +127,23 @@ void blackboxWrite(uint8_t value)
 #endif
     case BLACKBOX_DEVICE_SERIAL:
     default:
+        {
+            int txBytesFree = serialTxBytesFree(blackboxPort);
+
 #ifdef DEBUG_BB_OUTPUT
-        bbBits += 2;
+            bbBits += 2;
-        if (serialTxBytesFree(blackboxPort) == 0) {
+            DEBUG_SET(DEBUG_BLACKBOX_OUTPUT, 3, txBytesFree);
-            ++bbDrops;
-            DEBUG_SET(DEBUG_BLACKBOX_OUTPUT, 2, bbDrops);
-            return;
-        }
 #endif
-        serialWrite(blackboxPort, value);
+
+            if (txBytesFree == 0) {
+#ifdef DEBUG_BB_OUTPUT
+                ++bbDrops;
+                DEBUG_SET(DEBUG_BLACKBOX_OUTPUT, 2, bbDrops);
+#endif
+                return;
+            }
+            serialWrite(blackboxPort, value);
+        }
         break;
     }
 
@@ -181,7 +189,7 @@ int blackboxWriteString(const char *s)
     default:
         pos = (uint8_t*) s;
         while (*pos) {
-            serialWrite(blackboxPort, *pos);
+            blackboxWrite(*pos);
             pos++;
         }