GPS distance is uint16_t
This commit is contained in:
+3
-3
@@ -572,8 +572,8 @@ void resetTelemetry()
|
|||||||
#ifdef FRSKY_HUB
|
#ifdef FRSKY_HUB
|
||||||
uint16_t sqrt32(uint32_t n)
|
uint16_t sqrt32(uint32_t n)
|
||||||
{
|
{
|
||||||
unsigned int c = 0x8000;
|
uint16_t c = 0x8000;
|
||||||
unsigned int g = 0x8000;
|
uint32_t g = 0x8000;
|
||||||
|
|
||||||
for(;;) {
|
for(;;) {
|
||||||
if(g*g > n)
|
if(g*g > n)
|
||||||
@@ -617,7 +617,7 @@ uint32_t getGpsDistanceX2()
|
|||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
|
|
||||||
uint32_t getGpsDistance()
|
uint16_t getGpsDistance()
|
||||||
{
|
{
|
||||||
return (frskyHubData.pilotLatitude ? sqrt32(getGpsDistanceX2()) : 0);
|
return (frskyHubData.pilotLatitude ? sqrt32(getGpsDistanceX2()) : 0);
|
||||||
}
|
}
|
||||||
|
|||||||
+1
-1
@@ -158,7 +158,7 @@ void resetTelemetry();
|
|||||||
#ifdef FRSKY_HUB
|
#ifdef FRSKY_HUB
|
||||||
void getGpsPilotPosition();
|
void getGpsPilotPosition();
|
||||||
uint32_t getGpsDistanceX2();
|
uint32_t getGpsDistanceX2();
|
||||||
uint32_t getGpsDistance();
|
uint16_t getGpsDistance();
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|||||||
Reference in New Issue
Block a user