/
navigation_waypoints.cpp
153 lines (139 loc) · 10.5 KB
/
navigation_waypoints.cpp
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
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
#include "navigation_waypoints.h"
const navigationWaypoint waypoints[] =
{
[0] = { ._label = "03N Scimitar Car 5.5m", ._lat = 51.460347, ._long = -0.5489195},
[1] = { ._label = "04N Spitfire Car 6m", ._lat = 51.4601028571429, ._long = -0.54883835},
[2] = { ._label = "05N The Lightning Boat 5.5m", ._lat = 51.4605855, ._long = -0.548901666666667},
[3] = { ._label = "06aN Caves Centre", ._lat = 51.460947625, ._long = -0.54878325},
[4] = { ._label = "06bN Caves Lion Entrance Caves", ._lat = 51.460817, ._long = -0.548734},
[5] = { ._label = "06cN Red Isis Bike @ Cave", ._lat = 51.460898, ._long = -0.548701333},
[6] = { ._label = "06dN Blue Raleigh Bike @ Caves", ._lat = 51.4608584444444, ._long = -0.548736333333333},
[7] = { ._label = "06eN Cave PC Laptop", ._lat = 51.460936875, ._long = -0.548774875},
[8] = { ._label = "07P Cargo 2.5m", ._lat = 51.460014, ._long = -0.548735},
[9] = { ._label = "08B The Hole", ._lat = 51.4604301666667, ._long = -0.548688166666667},
[10] = { ._label = "09P Dance Platform 6m", ._lat = 51.460154, ._long = -0.548687},
[11] = { ._label = "10N Bus 2m", ._lat = 51.460073, ._long = -0.548515},
[12] = { ._label = "11N Confined Area", ._lat = 51.4599718333333, ._long = -0.548582833333333},
[13] = { ._label = "12N Commer Van 6m", ._lat = 51.4613355909091, ._long = -0.548469727272727},
[14] = { ._label = "13B White Boat 7m", ._lat = 51.4605198169044, ._long = -0.548421667307919},
[15] = { ._label = "14P Cargo 8m", ._lat = 51.4602986, ._long = -0.5483127},
[16] = { ._label = "15P Cargo Rusty 8m", ._lat = 51.460192, ._long = -0.548283},
[17] = { ._label = "16P Portacabin 8m", ._lat = 51.46034, ._long = -0.548173},
[18] = { ._label = "17P Shallow Platform 2m", ._lat = 51.4599705, ._long = -0.54810825},
[19] = { ._label = "18N Milk Float 6.5m", ._lat = 51.4601745714286, ._long = -0.548058571428571},
[20] = { ._label = "19N Chicken Hutch Boat 6.5m", ._lat = 51.4604027142857, ._long = -0.54804},
[21] = { ._label = "20N Skittles Sweet Bowl 5.5m", ._lat = 51.46020025, ._long = -0.5479775},
[22] = { ._label = "21B Sticky Up Boat 5m", ._lat = 51.4602514070597, ._long = -0.54789158281982},
[23] = { ._label = "22B Lady of Kent Search Light 5m", ._lat = 51.4599185714286, ._long = -0.547681},
[24] = { ._label = "23N Traffic Lights 7m", ._lat = 51.4600558888889, ._long = -0.547677333333333},
[25] = { ._label = "24N Half Die Hard Taxi 8m", ._lat = 51.460773, ._long = -0.547620875},
[26] = { ._label = "25N Boat In A Hole 7m", ._lat = 51.4599545, ._long = -0.54755475},
[27] = { ._label = "26N Iron Fish 2m", ._lat = 51.4595936666667, ._long = -0.547489833333333},
[28] = { ._label = "27aB Wreck Site 6m", ._lat = 51.4604300973436, ._long = -0.547383365365033},
[29] = { ._label = "27bB 4 Wreck Site 6m", ._lat = 51.46043825, ._long = -0.547208},
[30] = { ._label = "29B Dive/Spike Boat 7m", ._lat = 51.4601315714286, ._long = -0.547417857142857},
[31] = { ._label = "30B White Day boat by platform 6m", ._lat = 51.4598131428572, ._long = -0.547380285714286},
[32] = { ._label = "31P 6m", ._lat = 51.459766, ._long = -0.547347},
[33] = { ._label = "32P 6m", ._lat = 51.459658, ._long = -0.54725},
[34] = { ._label = "33N New (Row) Boat 4.5m", ._lat = 51.4595563333333, ._long = -0.547263333333333},
[35] = { ._label = "34P 6m", ._lat = 51.460312, ._long = -0.547165},
[36] = { ._label = "35N Dragon Boat 7.5m", ._lat = 51.4599636666667, ._long = -0.547154333333333},
[37] = { ._label = "36P 6m", ._lat = 51.459555, ._long = -0.54708},
[38] = { ._label = "37N Dive Bell 4m", ._lat = 51.4594757058824, ._long = -0.547087117647059},
[39] = { ._label = "38B Lifeboat 6.5m", ._lat = 51.459839375, ._long = -0.5469307},
[40] = { ._label = "39N London Black Cab 7m", ._lat = 51.459729, ._long = -0.546992857142857},
[41] = { ._label = "40N RIB Boat 6m", ._lat = 51.460236, ._long = -0.546847571428571},
[42] = { ._label = "41N Tin/Cabin Boat 7m", ._lat = 51.459676625, ._long = -0.5468125},
[43] = { ._label = "42P 6m", ._lat = 51.459491, ._long = -0.546867},
[44] = { ._label = "43N Thorpe Orange Boat 5.5m", ._lat = 51.4602073333333, ._long = -0.546787666666667},
[45] = { ._label = "44N VW Camper Van and Seahorse 5.5m", ._lat = 51.459368, ._long = -0.546760142857143},
[46] = { ._label = "45B Listing Sharon 7.5m", ._lat = 51.4598098699702, ._long = -0.54670373432756},
[47] = { ._label = "46N Plane 6m", ._lat = 51.459745, ._long = -0.546649},
[48] = { ._label = "47P 6m", ._lat = 51.459399, ._long = -0.546594},
[49] = { ._label = "48N Holey Ship 4.5m", ._lat = 51.4594384444444, ._long = -0.5465238},
[50] = { ._label = "49B Claymore 6.5m", ._lat = 51.459634435324, ._long = -0.54646635372985},
[51] = { ._label = "50aN Swim Through - no crates 6m", ._lat = 51.45914367, ._long = -0.546032333},
[52] = { ._label = "50bN Swim Through - mid 6m", ._lat = 51.4591694, ._long = -0.545999},
[53] = { ._label = "50cN Swim Through - crates 6m", ._lat = 51.4592045, ._long = -0.545912625},
[54] = { ._label = "51B Orca Van 5.5m", ._lat = 51.4591431428571, ._long = -0.545936857142857},
[55] = { ._label = "X01 Dinghy Boat", ._lat = 51.4601285, ._long = -0.5488505},
[56] = { ._label = "X02 Quarry Machine in Reeds", ._lat = 51.460434, ._long = -0.548921},
[57] = { ._label = "X03 Metal Grated Box", ._lat = 51.4599582857143, ._long = -0.547648571428571},
[58] = { ._label = "X04 4 crates in a line", ._lat = 51.4599018571429, ._long = -0.547141285714286},
[59] = { ._label = "X05 Lone crate", ._lat = 51.4598467777778, ._long = -0.547212666666667},
[60] = { ._label = "X06 Collapsed Metal", ._lat = 51.45967075, ._long = -0.547253125},
[61] = { ._label = "X07 Boat with Chain Links", ._lat = 51.4600385714286, ._long = -0.548724142857143},
[62] = { ._label = "X08 My Wrecks 4m", ._lat = 51.46043825, ._long = -0.547208},
[63] = { ._label = "X09 Pot in a box", ._lat = 51.459940625, ._long = -0.54852025},
[64] = { ._label = "X10 Seahorse Mid-Water", ._lat = 51.4600703333333, ._long = -0.548645666666667},
[65] = { ._label = "X11 Headless Nick", ._lat = 51.4600602857143, ._long = -0.548671714285714},
[66] = { ._label = "X12 Headless Tom Reeds", ._lat = 51.4600452, ._long = -0.5488188},
[67] = { ._label = "X13 Cement Mixer", ._lat = 51.4600375, ._long = -0.5478815},
[68] = { ._label = "X14 Tyre", ._lat = 51.4600531428571, ._long = -0.548183857142857},
[69] = { ._label = "X15 Roadworks Sign", ._lat = 51.4595778, ._long = -0.547358},
[70] = { ._label = "X16 Fireworks Launcher", ._lat = 51.4599975, ._long = -0.5481015},
[71] = { ._label = "X17 2 Buried Boats in Reeds", ._lat = 51.4593264705883, ._long = -0.5469361},
[72] = { ._label = "X18 Half Buried Solo Boat", ._lat = 51.4596635, ._long = -0.54706025},
[73] = { ._label = "X19 Half Buried Bike", ._lat = 51.4600594210526, ._long = -0.547575473684211},
[74] = { ._label = "X20 Sphere Bell via Reeds to Old Jetty", ._lat = 0, ._long = 0},
[75] = { ._label = "Z01 Cafe Jetty", ._lat = 51.460015, ._long = -0.548316},
[76] = { ._label = "Z02 Mid Jetty", ._lat = 51.459547, ._long = -0.547461},
[77] = { ._label = "Z03 Old Jetty", ._lat = 51.459166, ._long = -0.546999333333333},
[78] = { ._label = "Canoe Est. New", ._lat = 51.4620649, ._long = -0.5489528},
[79] = { ._label = "Canoe NW", ._lat = 51.4621272, ._long = -0.5490348},
[80] = { ._label = "Canoe N", ._lat = 51.4621644, ._long = -0.5489503},
[81] = { ._label = "Canoe NE", ._lat = 51.4621235, ._long = -0.5488664},
[82] = { ._label = "Canoe E", ._lat = 51.4620654, ._long = -0.5488102},
[83] = { ._label = "Canoe SE", ._lat = 51.4620027, ._long = -0.5488524},
[84] = { ._label = "Canoe S", ._lat = 51.4619701, ._long = -0.5489477},
[85] = { ._label = "Canoe SW", ._lat = 51.4619939, ._long = -0.5490341},
[86] = { ._label = "Canoe W", ._lat = 51.4620666, ._long = -0.5490951},
[87] = { ._label = "Canoe NW2", ._lat = 51.4621272, ._long = -0.5490348},
[88] = { ._label = "Canoe NE2", ._lat = 51.4621235, ._long = -0.5488664},
[89] = { ._label = "Canoe SE2", ._lat = 51.4620027, ._long = -0.5488524},
[90] = { ._label = "Canoe SW2", ._lat = 51.4619939, ._long = -0.5490341},
[91] = { ._label = "Canoe E2", ._lat = 51.4620654, ._long = -0.5488102},
[92] = { ._label = "Canoe N2", ._lat = 51.4621644, ._long = -0.5489503},
[93] = { ._label = "Canoe W2", ._lat = 51.4620666, ._long = -0.5490951},
[94] = { ._label = "Canoe S2", ._lat = 51.4619701, ._long = -0.5489477},
[95] = { ._label = "Cafe Jetty", ._lat = 51.460015, ._long = -0.548316},
[96] = { ._label = "Sub Est. New", ._lat = 51.4609545, ._long = -0.5491566},
[97] = { ._label = "Sub W", ._lat = 51.4609559, ._long = -0.5492975},
[98] = { ._label = "Sub NW", ._lat = 51.461031, ._long = -0.5492317},
[99] = { ._label = "Sub N", ._lat = 51.4610407, ._long = -0.5491586},
[100] = { ._label = "Sub NE", ._lat = 51.4610231, ._long = -0.5490675},
[101] = { ._label = "Sub E", ._lat = 51.4609554, ._long = -0.5490171},
[102] = { ._label = "Sub SE", ._lat = 51.460884, ._long = -0.5490634},
[103] = { ._label = "Sub S", ._lat = 51.4608669, ._long = -0.5491586},
[104] = { ._label = "Sub SW", ._lat = 51.4608861, ._long = -0.5492377},
[105] = { ._label = "Sub W2", ._lat = 51.4609559, ._long = -0.5492975},
[106] = { ._label = "Sub N2", ._lat = 51.4610407, ._long = -0.5491586},
[107] = { ._label = "Sub E2", ._lat = 51.4609554, ._long = -0.5490171},
[108] = { ._label = "Sub S2", ._lat = 51.4608669, ._long = -0.5491586},
[109] = { ._label = "Sub NW2", ._lat = 51.461031, ._long = -0.5492317},
[110] = { ._label = "Sub NE2", ._lat = 51.4610231, ._long = -0.5490675},
[111] = { ._label = "Sub SE2", ._lat = 51.460884, ._long = -0.5490634},
[112] = { ._label = "Sub SW2", ._lat = 51.4608861, ._long = -0.5492377},
};
const uint8_t waypointCount = sizeof(waypoints)/sizeof(navigationWaypoint);
uint8_t getWaypointsLength() { return waypointCount; }
/*
const uint8_t waypointCount = 3;
navigationWaypoint waypoints[waypointCount] =
{
[0] = { ._label = "Cafe Jetty", ._lat = 51.460015, ._long = -0.548316},
[1] = { ._label = "Mid Jetty", ._lat = 51.459547, ._long = -0.547461},
[2] = { ._label = "Old Jetty", ._lat = 51.459280, ._long = -0.547084}
};
*/
/*
// re-captured from google maps
const uint8_t waypointCount = 4;
navigationWaypoint waypoints[waypointCount] =
{
[0] = { ._label = "Cafe Jetty", ._lat = 51.460009, ._long = -0.5483115},
[1] = { ._label = "Mid Jetty", ._lat = 51.4595416, ._long = -0.5474575},
[2] = { ._label = "Old Jetty", ._lat = 51.45928, ._long = -0.547084},
[3] = { ._label = "Confined", ._lat = 51.4599901, ._long = -0.548643}
};
*/