-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathMaster.ino
More file actions
44 lines (37 loc) · 922 Bytes
/
Copy pathMaster.ino
File metadata and controls
44 lines (37 loc) · 922 Bytes
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
#include <SoftwareSerial.h>
#include <TinyGPSPlus.h>
#include "MasterPins.h"
SoftwareSerial gpsSerial(GPS_RX_PIN, GPS_TX_PIN);
TinyGPSPlus gps;
void setup()
{
Serial.begin(115200); // USB 디버그
Serial1.begin(SLAVE_LINK_BAUD); // Slave 링크 (포고핀, D6/D7)
gpsSerial.begin(GPS_BAUD); // GPS (D0/D1)
Serial.println("Master ready");
}
void loop()
{
// GPS 스트림 파싱
while (gpsSerial.available())
{
gps.encode(gpsSerial.read());
}
// Slave에서 한 줄(ax,ay,az,gx,gy,gz,ir,beat) 수신되면 GPS와 합쳐서 출력
if (Serial1.available())
{
String line = Serial1.readStringUntil('\n');
Serial.print(line);
if (gps.location.isValid())
{
Serial.print(",");
Serial.print(gps.location.lat(), 6);
Serial.print(",");
Serial.println(gps.location.lng(), 6);
}
else
{
Serial.println(",NA,NA");
}
}
}