- lat_deg = latitude / 10000000;
- latitude -= lat_deg * 10000000;
- latitude *= 60;
- lat_min = latitude / 10000000;
- latitude -= lat_min * 10000000;
- lat_frac = (latitude + 50000) / 100000;
-
- lon_deg = longitude / 10000000;
- longitude -= lon_deg * 10000000;
- longitude *= 60;
- lon_min = longitude / 10000000;
- longitude -= lon_min * 10000000;
- lon_frac = (longitude + 50000) / 100000;
-
- c = sprintf ((char *) tncBufferPnt, "=%02u%02u.%02u%c\\%03u%02u.%02u%cO /A=%06u\015",
- lat_deg, lat_min, lat_frac, lat_sign,
- lon_deg, lon_min, lon_frac, lon_sign,
- altitude * 100 / 3048);
- tncBufferPnt += c;
- tncLength += c;
+ alt = (altitude * (int32_t) 10000 + (3048/2)) / (int32_t) 3048;
+ alt = logf((float) altitude) * (1/ALTITUDE_LOG_BASE);
+
+ tncCompressInt(buf, lat, 4);
+ buf += 4;
+ tncCompressInt(buf, lon, 4);
+ buf += 4;
+
+ /* Symbol code */
+ *buf++ = '\'';
+
+ tncCompressInt(buf, alt, 2);
+ buf += 2;
+
+ *buf++ = 33 + ((1 << 5) | (2 << 3));
+
+ buf += tncComment(buf);
+
+ return buf - tncBuffer;
+}
+
+static int16_t
+tncFill(uint8_t *buf, int16_t len)
+{
+ int16_t l = 0;
+ uint8_t b;
+ uint8_t bit;
+
+ while (tncMode != TNC_TX_READY && l < len) {
+ b = 0;
+ for (bit = 0; bit < 8; bit++) {
+ b = b << 1 | (timeNCO >> 15);
+ timeNCO += timeNCOFreq;
+ }
+ *buf++ = b;
+ l++;
+ tnc1200TimerTick();
+ }
+ if (tncMode == TNC_TX_READY)
+ l = -l;
+ return l;