kopia lustrzana https://github.com/ogre/habboy
60 wiersze
1.1 KiB
C++
60 wiersze
1.1 KiB
C++
|
|
#include "helpers/gps.h"
|
|
#include "helpers/rotary_mod16.h"
|
|
|
|
|
|
|
|
void setup()
|
|
{
|
|
// Serial.begin(115200);
|
|
Serial.begin(9600);
|
|
while (!Serial)
|
|
; //Wait for user to open terminal
|
|
|
|
Serial.println(F("interrupts()"));
|
|
interrupts();
|
|
|
|
Serial.println(F("Wire.begin()"));
|
|
Wire.begin();
|
|
|
|
Serial.println(F("SetupUBlox()"));
|
|
bool gps_ok = SetupUBlox();
|
|
while(!gps_ok)
|
|
{
|
|
Serial.println(F("err::gps"));
|
|
delay(1000);
|
|
}
|
|
|
|
Serial.println(F("SetupMod16RotSwitch()"));
|
|
SetupMod16RotSwitch(11, 12, 0);
|
|
|
|
Serial.println(F("setup() done"));
|
|
|
|
}
|
|
|
|
|
|
long G_GPS_WAIT = 0;
|
|
long G_ROT_WAIT = 0;
|
|
void loop()
|
|
{
|
|
/*if( G_ROT_SWITCH_COUNTER && (millis()-G_GPS_WAIT)>50 )
|
|
{
|
|
{
|
|
int rot_switch_counter = G_ROT_SWITCH_COUNTER;
|
|
G_ROT_SWITCH_COUNTER = 0;
|
|
Serial.print(F("rot::")); Serial.println(rot_switch_counter/2);
|
|
G_ROT_WAIT = millis();
|
|
}
|
|
}
|
|
*/
|
|
|
|
if (millis() - G_GPS_WAIT > 300)
|
|
{
|
|
UpdateGps();
|
|
PrintGpsState();
|
|
Serial.println();
|
|
|
|
G_GPS_WAIT = millis();
|
|
}
|
|
|
|
} |