Kod: Zaznacz cały
/*
FrSky Telemetry library example
(c) Pawelsky 20170831
Not for commercial use
Note that you need Teensy 3.x/LC or 328P/168 based (e.g. Pro Mini, Nano, Uno) board and FrSkyTelemetry library for this example to work
*/
#include "FrSkyTelemetry.h"
#include "NazaDecoderLib.h"
#include "SoftwareSerial.h"
FrSkyTelemetry telemetry; // Create telemetry object
void setup()
{
Serial.begin(115200);
telemetry.begin(FrSkyTelemetry::SOFT_SERIAL_PIN_11);
}
void loop()
{
if(Serial.available())
{
if(NazaDecoder.decode(Serial.read()) == NAZA_MESSAGE_GPS)
{
telemetry.setGpsData(NazaDecoder.getLat(), NazaDecoder.getLon(),
NazaDecoder.getGpsAlt(), NazaDecoder.getSpeed(), NazaDecoder.getCog(),
NazaDecoder.getYear(), NazaDecoder.getMonth(), NazaDecoder.getDay(),
NazaDecoder.getHour(), NazaDecoder.getMinute(), NazaDecoder.getSecond());
telemetry.setTemsData(NazaDecoder.getNumSat(), NazaDecoder.getFixType());
Serial.print("Lat: "); Serial.print(NazaDecoder.getLat(), 7);
Serial.print(", Lon: "); Serial.print(NazaDecoder.getLon(), 7);
Serial.print(", Alt: "); Serial.print(NazaDecoder.getGpsAlt(), 7);
Serial.print(", Fix: "); Serial.print(NazaDecoder.getFixType());
Serial.print(", Sat: "); Serial.println(NazaDecoder.getNumSat());
Serial.print("Heading: "); Serial.println(NazaDecoder.getHeadingNc(), 2);
telemetry.send();
}
}
}
Chciałbym też zrobić aby wysokość pokazywało tak, że 1 metr to 1.0, teraz 1 metr pokazuje jako 0,1 i nie wiem jak można to zmienić, w ustawieniach aparatury nie było opcji przesunięcia przecinka.