[Taranis] All 'old' sensors now supported
This commit is contained in:
@@ -48,33 +48,6 @@ lcdint_t applyChannelRatio(uint8_t channel, lcdint_t val)
|
|||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if defined(FRSKY_HUB) || defined(WS_HOW_HIGH)
|
|
||||||
void checkMinMaxAltitude()
|
|
||||||
{
|
|
||||||
if (TELEMETRY_ALT_BP > frskyData.hub.maxAltitude)
|
|
||||||
frskyData.hub.maxAltitude = TELEMETRY_ALT_BP;
|
|
||||||
if (TELEMETRY_ALT_BP < frskyData.hub.minAltitude)
|
|
||||||
frskyData.hub.minAltitude = TELEMETRY_ALT_BP;
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#if defined(VARIO) && (defined(FRSKY_HUB) || defined(WS_HOW_HIGH))
|
|
||||||
void evalVario(int16_t altitude_bp, uint16_t altitude_ap)
|
|
||||||
{
|
|
||||||
int32_t varioAltitude_cm = (int32_t)altitude_bp * 100 + (altitude_bp > 0 ? altitude_ap : -altitude_ap);
|
|
||||||
uint8_t varioAltitudeQueuePointer = frskyData.hub.varioAltitudeQueuePointer + 1;
|
|
||||||
if (varioAltitudeQueuePointer >= VARIO_QUEUE_LENGTH)
|
|
||||||
varioAltitudeQueuePointer = 0;
|
|
||||||
frskyData.hub.varioAltitudeQueuePointer = varioAltitudeQueuePointer;
|
|
||||||
frskyData.hub.varioSpeed -= frskyData.hub.varioAltitudeQueue[varioAltitudeQueuePointer] ;
|
|
||||||
frskyData.hub.varioAltitudeQueue[varioAltitudeQueuePointer] = varioAltitude_cm - frskyData.hub.varioAltitude_cm;
|
|
||||||
frskyData.hub.varioAltitude_cm = varioAltitude_cm;
|
|
||||||
frskyData.hub.varioSpeed += frskyData.hub.varioAltitudeQueue[varioAltitudeQueuePointer] ;
|
|
||||||
}
|
|
||||||
#else
|
|
||||||
#define evalVario(...)
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#if defined(FRSKY_HUB)
|
#if defined(FRSKY_HUB)
|
||||||
void extractLatitudeLongitude(uint32_t * latitude, uint32_t * longitude)
|
void extractLatitudeLongitude(uint32_t * latitude, uint32_t * longitude)
|
||||||
{
|
{
|
||||||
|
|||||||
+1
-1
@@ -1355,7 +1355,7 @@ void setGVarValue(uint8_t idx, int16_t value, int8_t phase)
|
|||||||
#if defined(FRSKY) || defined(CPUARM)
|
#if defined(FRSKY) || defined(CPUARM)
|
||||||
void putsTelemetryValue(xcoord_t x, uint8_t y, lcdint_t val, uint8_t unit, uint8_t att)
|
void putsTelemetryValue(xcoord_t x, uint8_t y, lcdint_t val, uint8_t unit, uint8_t att)
|
||||||
{
|
{
|
||||||
#ifdef IMPERIAL_UNITS
|
#if defined(IMPERIAL_UNITS)
|
||||||
if (unit == UNIT_DEGREES) {
|
if (unit == UNIT_DEGREES) {
|
||||||
val += 18 ;
|
val += 18 ;
|
||||||
val *= 115 ;
|
val *= 115 ;
|
||||||
|
|||||||
@@ -1357,8 +1357,6 @@ void putsTelemetryChannel(xcoord_t x, uint8_t y, uint8_t channel, lcdint_t val,
|
|||||||
#define EARTH_RADIUSKM ((uint32_t)6371)
|
#define EARTH_RADIUSKM ((uint32_t)6371)
|
||||||
#define EARTH_RADIUS ((uint32_t)111194)
|
#define EARTH_RADIUS ((uint32_t)111194)
|
||||||
|
|
||||||
void checkMinMaxAltitude();
|
|
||||||
void evalVario(int16_t altitude_bp, uint16_t altitude_ap);
|
|
||||||
void getGpsPilotPosition();
|
void getGpsPilotPosition();
|
||||||
void getGpsDistance();
|
void getGpsDistance();
|
||||||
void varioWakeup();
|
void varioWakeup();
|
||||||
|
|||||||
@@ -69,6 +69,33 @@ uint8_t frskyUsrStreaming = 0;
|
|||||||
uint8_t link_counter = 0;
|
uint8_t link_counter = 0;
|
||||||
FrskyData frskyData;
|
FrskyData frskyData;
|
||||||
|
|
||||||
|
#if defined(FRSKY_HUB) || defined(WS_HOW_HIGH)
|
||||||
|
void checkMinMaxAltitude()
|
||||||
|
{
|
||||||
|
if (TELEMETRY_ALT_BP > frskyData.hub.maxAltitude)
|
||||||
|
frskyData.hub.maxAltitude = TELEMETRY_ALT_BP;
|
||||||
|
if (TELEMETRY_ALT_BP < frskyData.hub.minAltitude)
|
||||||
|
frskyData.hub.minAltitude = TELEMETRY_ALT_BP;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if defined(VARIO) && !defined(FRSKY_SPORT) && (defined(FRSKY_HUB) || defined(WS_HOW_HIGH))
|
||||||
|
void evalVario(int16_t altitude_bp, uint16_t altitude_ap)
|
||||||
|
{
|
||||||
|
int32_t varioAltitude_cm = (int32_t)altitude_bp * 100 + (altitude_bp > 0 ? altitude_ap : -altitude_ap);
|
||||||
|
uint8_t varioAltitudeQueuePointer = frskyData.hub.varioAltitudeQueuePointer + 1;
|
||||||
|
if (varioAltitudeQueuePointer >= VARIO_QUEUE_LENGTH)
|
||||||
|
varioAltitudeQueuePointer = 0;
|
||||||
|
frskyData.hub.varioAltitudeQueuePointer = varioAltitudeQueuePointer;
|
||||||
|
frskyData.hub.varioSpeed -= frskyData.hub.varioAltitudeQueue[varioAltitudeQueuePointer] ;
|
||||||
|
frskyData.hub.varioAltitudeQueue[varioAltitudeQueuePointer] = varioAltitude_cm - frskyData.hub.varioAltitude_cm;
|
||||||
|
frskyData.hub.varioAltitude_cm = varioAltitude_cm;
|
||||||
|
frskyData.hub.varioSpeed += frskyData.hub.varioAltitudeQueue[varioAltitudeQueuePointer] ;
|
||||||
|
}
|
||||||
|
#else
|
||||||
|
#define evalVario(...)
|
||||||
|
#endif
|
||||||
|
|
||||||
#if defined(FRSKY_HUB)
|
#if defined(FRSKY_HUB)
|
||||||
typedef enum {
|
typedef enum {
|
||||||
TS_IDLE = 0, // waiting for 0x5e frame marker
|
TS_IDLE = 0, // waiting for 0x5e frame marker
|
||||||
|
|||||||
@@ -199,7 +199,7 @@ void putsTelemetryChannel(xcoord_t x, uint8_t y, uint8_t channel, lcdint_t val,
|
|||||||
putsTelemetryValue(x, y, val, UNIT_RAW, att);
|
putsTelemetryValue(x, y, val, UNIT_RAW, att);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
#if LCD_W >= 212
|
#if defined(FRSKY_SPORT)
|
||||||
case TELEM_ALT-1:
|
case TELEM_ALT-1:
|
||||||
putsTelemetryValue(x, y, val/10, UNIT_METERS, att|PREC1);
|
putsTelemetryValue(x, y, val/10, UNIT_METERS, att|PREC1);
|
||||||
break;
|
break;
|
||||||
|
|||||||
Reference in New Issue
Block a user