Luis Rodil-Fernandez
2 years ago
commit
6fd89c7ee1
7 changed files with 588 additions and 0 deletions
-
5README.md
-
46lib/README
-
3lib/wmm/README.md
-
302lib/wmm/wmm.cpp
-
44lib/wmm/wmm.h
-
26platformio.ini
-
162src/main.cpp
@ -0,0 +1,5 @@ |
|||
## Heliograph prototype |
|||
|
|||
ESP32 with a GPS module calculates sun position and magnetic declination. |
|||
|
|||
- Is this enough for an earth bound object to know where to find the sun? |
|||
@ -0,0 +1,46 @@ |
|||
|
|||
This directory is intended for project specific (private) libraries. |
|||
PlatformIO will compile them to static libraries and link into executable file. |
|||
|
|||
The source code of each library should be placed in a an own separate directory |
|||
("lib/your_library_name/[here are source files]"). |
|||
|
|||
For example, see a structure of the following two libraries `Foo` and `Bar`: |
|||
|
|||
|--lib |
|||
| | |
|||
| |--Bar |
|||
| | |--docs |
|||
| | |--examples |
|||
| | |--src |
|||
| | |- Bar.c |
|||
| | |- Bar.h |
|||
| | |- library.json (optional, custom build options, etc) https://docs.platformio.org/page/librarymanager/config.html |
|||
| | |
|||
| |--Foo |
|||
| | |- Foo.c |
|||
| | |- Foo.h |
|||
| | |
|||
| |- README --> THIS FILE |
|||
| |
|||
|- platformio.ini |
|||
|--src |
|||
|- main.c |
|||
|
|||
and a contents of `src/main.c`: |
|||
``` |
|||
#include <Foo.h> |
|||
#include <Bar.h> |
|||
|
|||
int main (void) |
|||
{ |
|||
... |
|||
} |
|||
|
|||
``` |
|||
|
|||
PlatformIO Library Dependency Finder will find automatically dependent |
|||
libraries scanning project source files. |
|||
|
|||
More information about PlatformIO Library Dependency Finder |
|||
- https://docs.platformio.org/page/librarymanager/ldf.html |
|||
@ -0,0 +1,3 @@ |
|||
World Magnetic Model library slightly modified |
|||
from original written by Rene Herrero Gomez |
|||
https://github.com/sevenseas-io/wmm |
|||
@ -0,0 +1,302 @@ |
|||
#include <stdint.h>
|
|||
#include <stdbool.h>
|
|||
#include <string.h>
|
|||
#include <math.h>
|
|||
#include "wmm.h"
|
|||
|
|||
#define PI_CONST 3.14159265359f
|
|||
#define RADIANS_TO_DEGREES 0.017453292f
|
|||
#define DEGREES_TO_RADIANS (PI_CONST / 180.0f)
|
|||
#define A_CONST 6378.137f
|
|||
#define A2_CONST (A_CONST * A_CONST)
|
|||
#define B_CONST 6356.7523142f
|
|||
#define B2_CONST (B_CONST * B_CONST)
|
|||
#define RE_CONST 6371.2f
|
|||
#define A4_CONST (A2_CONST * A2_CONST)
|
|||
#define B4_CONST (B2_CONST * B2_CONST)
|
|||
#define C2_CONST (A2_CONST - B2_CONST)
|
|||
#define C4_CONST (A4_CONST - B4_CONST)
|
|||
#define COEFFICIENTS_COUNT 90U
|
|||
|
|||
static float c[13][13]; |
|||
static float cd[13][13]; |
|||
static float k[13][13]; |
|||
static float snorm[169]; |
|||
static float fn[13]; |
|||
static float fm[13]; |
|||
|
|||
const uint8_t wmm_cof_entries_encoded[] = |
|||
{0xDD, 0xF2, 0x23, 0x00, 0x83, 0x01, 0x00, 0xEB, 0xE2, 0x01, 0x81, 0xD7, 0x05, 0x8D, 0x01, 0xFB, 0x03, 0xE8, 0x86, 0x03, 0x00, 0xF3, 0x01, 0x00, 0xBC, 0xD1, 0x03, 0xDC, 0xD3, 0x03, 0xC7, 0x01, 0xEE, 0x04, 0x80, 0x86, 0x02, 0xF4, 0x72, 0x56, 0xEF, 0x03, 0x87, 0xD5, 0x01, 0x00, 0x1C, 0x00, 0xC2, 0xF4, 0x02, 0xF6, 0x0C, 0x7E, 0x39, 0x8A, 0xC1, 0x01, 0xB2, 0x25, 0x22, 0x4A, 0x89, 0x52, 0xF5, 0x54, 0xFA, 0x01, 0x0B, 0x87, 0x8D, 0x01, 0x00, 0x4B, 0x00, 0x9E, 0x7E, 0x84, 0x2C, 0x50, 0x02, 0x9E, 0x0D, 0xF0, 0x18, 0x7C, 0x85, 0x01, 0xD6, 0x30, 0x8E, 0x1F, 0x36, 0x25, 0x9F, 0x07, 0xED, 0x36, 0x77, 0x78, 0xE8, 0x24, 0x00, 0x43, 0x00, 0xAF, 0x38, 0x9D, 0x07, 0x06, 0x01, 0x96, 0x1D, 0xA4, 0x20, 0x47, 0x19, 0xFF, 0x15, 0xFD, 0x12, 0x01, 0x49, 0xE8, 0x17, 0x82, 0x05, 0x0C, 0x1E, 0x89, 0x02, 0x9F, 0x0F, 0x0A, 0x05, 0x93, 0x0A, 0x00, 0x46, 0x00, 0x90, 0x0A, 0xFF, 0x02, 0x44, 0x01, 0x9A, 0x0B, 0xBA, 0x03, 0x05, 0x52, 0xFF, 0x12, 0x8F, 0x08, 0x0E, 0x4E, 0xEA, 0x05, 0xC4, 0x0A, 0x4E, 0x09, 0x87, 0x02, 0x9A, 0x01, 0x00, 0x01, 0xC7, 0x0A, 0xA9, 0x0A, 0x08, 0x0A, 0xA6, 0x0C, 0x00, 0x41, 0x00, 0xC0, 0x0C, 0xC2, 0x08, 0x43, 0x05, 0xD3, 0x01, 0xE8, 0x02, 0x41, 0x06, 0xB5, 0x08, 0x17, 0x07, 0x47, 0x9E, 0x02, 0xAB, 0x03, 0x02, 0x42, 0x80, 0x01, 0x56, 0x45, 0x4C, 0xC8, 0x01, 0xD0, 0x04, 0x48, 0x02, 0xA2, 0x01, 0x53, 0x0A, 0x03, 0xAC, 0x03, 0x00, 0x41, 0x00, 0xA2, 0x01, 0x94, 0x01, 0x01, 0x43, 0xEF, 0x02, 0xD9, 0x02, 0x41, 0x07, 0x44, 0x80, 0x02, 0x05, 0x42, 0xD3, 0x03, 0xF6, 0x01, 0x41, 0x05, 0x99, 0x02, 0x95, 0x02, 0x04, 0x43, 0x89, 0x02, 0x24, 0x05, 0x45, 0xE5, 0x02, 0xC5, 0x01, 0x00, 0x04, 0x43, 0x1C, 0x04, 0x01, 0x32, 0x00, 0x41, 0x00, 0x92, 0x01, 0xE9, 0x03, 0x42, 0x43, 0x1D, 0xAF, 0x01, 0x00, 0x02, 0x4E, 0xA2, 0x01, 0x04, 0x44, 0x4B, 0x73, 0x43, 0x04, 0xC5, 0x02, 0x7E, 0x00, 0x01, 0x0B, 0x8E, 0x01, 0x03, 0x00, 0x99, 0x01, 0x04, 0x00, 0x42, 0xDD, 0x01, 0x4F, 0x00, 0x05, 0xF7, 0x01, 0xA1, 0x01, 0x44, 0x02, 0x53, 0x00, 0x00, 0x00, 0x7E, 0x22, 0x00, 0x00, 0x41, 0x42, 0x00, 0x01, 0x11, 0x23, 0x02, 0x43, 0x49, 0x30, 0x41, 0x01, 0x06, 0xD6, 0x01, 0x42, 0x42, 0x49, 0x41, 0x00, 0x01, 0x13, 0x6A, 0x41, 0x00, 0x0E, 0x62, 0x42, 0x41, 0x58, 0x41, 0x41, 0x02, 0x67, 0xD8, 0x01, 0x00, 0x00, 0x1E, 0x00, 0x00, 0x00, 0x4E, 0x00, 0x41, 0x00, 0x59, 0x1A, 0x00, 0x01, 0x18, 0x45, 0x00, 0x00, 0x49, 0x44, 0x00, 0x02, 0x03, 0x06, 0x41, 0x00, 0x47, 0x42, 0x00, 0x00, 0x41, 0x51, 0x00, 0x01, 0x0E, 0x50, 0x41, 0x00, 0x46, 0x5E, 0x41, 0x41, 0x02, 0x54, 0x41, 0x00, 0x1F, 0x5A, 0x41, 0x00, 0x54, 0x00, 0x00, 0x00, 0x41, 0x4C, 0x00, 0x00, 0x05, 0x05, 0x00, 0x00, 0x0D, 0x0D, 0x00, 0x41, 0x4C, 0x52, 0x00, 0x01, 0x07, 0x01, 0x00, 0x00, 0x03, 0x07, 0x00, 0x00, 0x05, 0x41, 0x00, 0x00, 0x42, 0x06, 0x00, 0x01, 0x45, 0x02, 0x00, 0x00, 0x01, 0x49, 0x00, 0x00, 0x4B, 0x00, 0x00, 0x00, 0x43, 0x05, 0x41, 0x41}; |
|||
|
|||
static wmm_cof_record_t wmm_cof_entries[COEFFICIENTS_COUNT]; |
|||
|
|||
static float convert_varint_to_float(char **bytes); |
|||
|
|||
float wmm_get_date(uint8_t year, uint8_t month, uint8_t date) |
|||
{ |
|||
return (float)year + 2000.0f + (float)(month - 1U) / 12.0f + (float)(date - 1U) / (365.0f); |
|||
} |
|||
|
|||
static float convert_varint_to_float(char **bytes) |
|||
{ |
|||
float result; |
|||
int32_t result_int; |
|||
bool negative = false; |
|||
bool first_byte = true; |
|||
uint8_t shift; |
|||
|
|||
do |
|||
{ |
|||
if (first_byte) |
|||
{ |
|||
if (**bytes & 0x40) |
|||
{ |
|||
negative = true; |
|||
} |
|||
|
|||
result_int = **bytes & 0x3f; |
|||
shift = 6U; |
|||
first_byte = false; |
|||
} |
|||
else |
|||
{ |
|||
result_int += (uint32_t)(**bytes & 0x7f) << shift; |
|||
shift += 7U; |
|||
} |
|||
|
|||
if ((**bytes & 0x80) == 0U) |
|||
{ |
|||
(*bytes)++; |
|||
break; |
|||
} |
|||
|
|||
(*bytes)++; |
|||
|
|||
} while (true); |
|||
|
|||
|
|||
result = ((float)result_int) / 10.0f; |
|||
if (negative) |
|||
{ |
|||
result = -result; |
|||
} |
|||
|
|||
return result; |
|||
} |
|||
|
|||
void wmm_init(void) |
|||
{ |
|||
uint8_t j; |
|||
uint8_t m; |
|||
uint8_t n; |
|||
uint8_t D2; |
|||
float gnm; |
|||
float hnm; |
|||
float dgnm; |
|||
float dhnm; |
|||
float flnmj; |
|||
uint8_t i; |
|||
char *bytes = (char *)&wmm_cof_entries_encoded[0]; |
|||
|
|||
// unpack coefficients
|
|||
for (i = 0U; i < COEFFICIENTS_COUNT; i++) |
|||
{ |
|||
wmm_cof_entries[i].gnm = convert_varint_to_float(&bytes); |
|||
wmm_cof_entries[i].hnm = convert_varint_to_float(&bytes); |
|||
wmm_cof_entries[i].dgnm = convert_varint_to_float(&bytes); |
|||
wmm_cof_entries[i].dhnm = convert_varint_to_float(&bytes); |
|||
} |
|||
|
|||
c[0][0] = 0.0f; |
|||
cd[0][0] = 0.0f; |
|||
|
|||
j = 0U; |
|||
for (n = 1U; n <= 12U; n++) |
|||
{ |
|||
for (m = 0U; m <= n; m++) |
|||
{ |
|||
gnm = wmm_cof_entries[j].gnm; |
|||
hnm = wmm_cof_entries[j].hnm; |
|||
dgnm = wmm_cof_entries[j].dgnm; |
|||
dhnm = wmm_cof_entries[j].dhnm; |
|||
j++; |
|||
|
|||
if (m <= n) |
|||
{ |
|||
c[m][n] = gnm; |
|||
cd[m][n] = dgnm; |
|||
if (m != 0U) |
|||
{ |
|||
c[n][m - 1U] = hnm; |
|||
cd[n][m - 1U] = dhnm; |
|||
} |
|||
} |
|||
} |
|||
} |
|||
|
|||
// CONVERT SCHMIDT NORMALIZED GAUSS COEFFICIENTS TO UNNORMALIZED
|
|||
*snorm = 1.0f; |
|||
for (n = 1U; n <= 12U; n++) |
|||
{ |
|||
*(snorm + n) = *(snorm + n - 1U) * (float)(2U * n - 1U) / (float)n; |
|||
j = 2U; |
|||
m = 0U; |
|||
for (D2 = n - m + 1U; D2 > 0U; D2--) |
|||
{ |
|||
k[m][n] = (float)(((n - 1U) * (n - 1U)) - (m * m)) / (float)((2U * n - 1U) * (2U * n - 3U)); |
|||
if (m > 0U) |
|||
{ |
|||
flnmj = (float)((n - m + 1U) * j) / (float)(n + m); |
|||
*(snorm + n + m * 13U) = *(snorm + n + (m - 1U) * 13U) * sqrt(flnmj); |
|||
j = 1U; |
|||
c[n][m - 1U] = *(snorm + n + m * 13U) * c[n][m - 1U]; |
|||
cd[n][m - 1U] = *(snorm + n + m * 13U) * cd[n][m - 1U]; |
|||
} |
|||
c[m][n] = *(snorm + n + m * 13U) * c[m][n]; |
|||
cd[m][n] = *(snorm + n + m *13U) * cd[m][n]; |
|||
m += 1U; |
|||
} |
|||
fn[n] = (float)(n + 1U); |
|||
fm[n] = (float)n; |
|||
} |
|||
k[1][1] = 0.0f; |
|||
} |
|||
|
|||
void E0000(float glat, float glon, float time_years, float *dec) |
|||
{ |
|||
static float tc[13][13]; |
|||
static float sp[13]; |
|||
static float cp[13]; |
|||
static float dp[13][13]; |
|||
static float pp[13]; |
|||
float dt = time_years - WMM_EPOCH; |
|||
float rlon = glon * DEGREES_TO_RADIANS; |
|||
float rlat = glat * DEGREES_TO_RADIANS; |
|||
float srlon = sinf(rlon); |
|||
float srlat = sinf(rlat); |
|||
float crlon = cosf(rlon); |
|||
float crlat = cosf(rlat); |
|||
float srlat2 = srlat * srlat; |
|||
float crlat2 = crlat * crlat; |
|||
sp[0] = 0.0f; |
|||
sp[1] = srlon; |
|||
cp[0] = 1.0f; |
|||
cp[1] = crlon; |
|||
dp[0][0] = 0.0f; |
|||
pp[0] = 1.0f; |
|||
|
|||
// CONVERT FROM GEODETIC COORDS. TO SPHERICAL COORDS
|
|||
float q = sqrtf(A2_CONST - C2_CONST * srlat2); |
|||
float q2 = (A2_CONST / (B2_CONST)) * (A2_CONST / B2_CONST); |
|||
float ct = srlat / sqrtf(q2 * crlat2 + srlat2); |
|||
float st = sqrtf(1.0f - (ct * ct)); |
|||
float r2 = (A4_CONST - C4_CONST * srlat2) / (q * q); |
|||
float r = sqrtf(r2); |
|||
float d = sqrtf(A2_CONST * crlat2 + B2_CONST * srlat2); |
|||
float ca = d / r; |
|||
float sa = C2_CONST * crlat * srlat / (r * d); |
|||
for (uint8_t m = 2U; m <= 12U; m++) |
|||
{ |
|||
sp[m] = sp[1] * cp[m - 1U] + cp[1] * sp[m - 1U]; |
|||
cp[m] = cp[1] * cp[m - 1U] - sp[1] * sp[m - 1U]; |
|||
} |
|||
float aor = RE_CONST / r; |
|||
float ar = aor * aor; |
|||
float br = 0.0f; |
|||
float bt = 0.0f; |
|||
float bp = 0.0f; |
|||
float bpp = 0.0f; |
|||
|
|||
for (uint16_t n = 1U; n <= 12U; n++) |
|||
{ |
|||
ar = ar * aor; |
|||
uint8_t m = 0U; |
|||
for (uint8_t D4 = n + 1U; D4 > 0U; D4--) |
|||
{ |
|||
// COMPUTE UNNORMALIZED ASSOCIATED LEGENDRE POLYNOMIALS AND DERIVATIVES VIA RECURSION RELATIONS
|
|||
if (n == m) |
|||
{ |
|||
*(snorm + n + m * 13U) = st * *(snorm + n - 1U + (m - 1U) * 13U); |
|||
dp[m][n] = st * dp[m - 1U][n - 1U] + ct * *(snorm + n - 1U + (m - 1U) * 13U); |
|||
goto S50; |
|||
} |
|||
if (n == 1U && m == 0U) |
|||
{ |
|||
*(snorm + n + m * 13U) = ct * *(snorm + n - 1U + m * 13U); |
|||
dp[m][n] = ct * dp[m][n - 1U] - st * *(snorm + n - 1U + m * 13U); |
|||
goto S50; |
|||
} |
|||
if (n > 1U && n != m) |
|||
{ |
|||
if (m > n - 2U) |
|||
{ |
|||
*(snorm + n - 2U + m * 13U) = 0.0f; |
|||
} |
|||
if (m > n - 2U) |
|||
{ |
|||
dp[m][n - 2U] = 0.0f; |
|||
} |
|||
*(snorm + n + m * 13U) = ct * *(snorm + n - 1U + m * 13U) - k[m][n] * *(snorm + n - 2U + m * 13U); |
|||
dp[m][n] = ct * dp[m][n - 1U] - st * *(snorm + n - 1U + m * 13U) - k[m][n] * dp[m][n - 2U]; |
|||
} |
|||
S50: |
|||
|
|||
// TIME ADJUST THE GAUSS COEFFICIENTS
|
|||
tc[m][n] = c[m][n] + dt * cd[m][n]; |
|||
if (m != 0U) |
|||
{ |
|||
tc[n][m - 1U] = c[n][m - 1U] + dt * cd[n][m - 1U]; |
|||
} |
|||
|
|||
// ACCUMULATE TERMS OF THE SPHERICAL HARMONIC EXPANSIONS
|
|||
float par = ar * *(snorm + n + m * 13U); |
|||
float temp1; |
|||
float temp2; |
|||
|
|||
if (m == 0) |
|||
{ |
|||
temp1 = tc[m][n] * cp[m]; |
|||
temp2 = tc[m][n] * sp[m]; |
|||
} |
|||
else |
|||
{ |
|||
temp1 = tc[m][n] * cp[m] + tc[n][m - 1U] * sp[m]; |
|||
temp2 = tc[m][n] * sp[m] - tc[n][m - 1U] * cp[m]; |
|||
} |
|||
|
|||
bt = bt - ar * temp1 * dp[m][n]; |
|||
bp += (fm[m] * temp2 * par); |
|||
br += (fn[n] * temp1 * par); |
|||
|
|||
// SPECIAL CASE: NORTH/SOUTH GEOGRAPHIC POLES
|
|||
if (st == 0.0f && m == 1U) |
|||
{ |
|||
if (n == 1U) |
|||
{ |
|||
pp[n] = pp[n - 1U]; |
|||
} |
|||
else |
|||
{ |
|||
pp[n] = ct * pp[n - 1U] - k[m][n] * pp[n - 2U]; |
|||
} |
|||
bpp += (fm[m] * temp2 * ar * pp[n]); |
|||
} |
|||
m += 1U; |
|||
} |
|||
} |
|||
if (st == 0.0f) |
|||
{ |
|||
bp = bpp; |
|||
} |
|||
else |
|||
{ |
|||
bp /= st; |
|||
} |
|||
|
|||
// ROTATE MAGNETIC VECTOR COMPONENTS FROM SPHERICAL TO GEODETIC COORDINATES
|
|||
float bx = -bt * ca - br * sa; |
|||
float by = bp; |
|||
|
|||
// COMPUTE DECLINATION
|
|||
*dec = atan2f(by, bx) / DEGREES_TO_RADIANS; |
|||
} |
|||
@ -0,0 +1,44 @@ |
|||
#ifndef WMM_H |
|||
#define WMM_H |
|||
|
|||
#include <stdint.h> |
|||
|
|||
#define WMM_EPOCH 2020.0f |
|||
|
|||
typedef struct |
|||
{ |
|||
float gnm; |
|||
float hnm; |
|||
float dgnm; |
|||
float dhnm; |
|||
} wmm_cof_record_t; |
|||
|
|||
/** |
|||
* Initialize the WMM. Needs calling only once. |
|||
*/ |
|||
void wmm_init(void); |
|||
|
|||
/** |
|||
* Get the date in WMM format |
|||
* |
|||
* @param year Year in 2 digit format of 21st centuary, i.e. 20 represents 2020 |
|||
* @param month Month, 1 to 12 |
|||
* @param date Date of month, 1 to 31 |
|||
* @return Date in WMM format |
|||
* @note No checking of illegal dates is done |
|||
*/ |
|||
float wmm_get_date(uint8_t year, uint8_t month, uint8_t date); |
|||
|
|||
/** |
|||
* Get the magnetic variation at a point on the earth's surface |
|||
* |
|||
* @param glat Latitude in degrees and fractional degrees, negative west |
|||
* @param glon Longitude in degrees and fractional degrees, negative west |
|||
* @param time_years The date as returned from wmm_get_date |
|||
* @param dec Pointer to float holding calculated magnetic variation (also known as declination). Negative is west. |
|||
* @note The altitude used is the ellipsoid at the supplied latitude/longitude, not the earth's surface. This will |
|||
* give very small errors in some parts of the world comapred to sea level. |
|||
*/ |
|||
void E0000(float glat, float glon, float time_years, float *dec); |
|||
|
|||
#endif |
|||
@ -0,0 +1,26 @@ |
|||
; PlatformIO Project Configuration File |
|||
; |
|||
; Build options: build flags, source filter |
|||
; Upload options: custom upload port, speed and extra flags |
|||
; Library options: dependencies, extra library storages |
|||
; Advanced options: extra scripting |
|||
; |
|||
; Please visit documentation for the other options and examples |
|||
; https://docs.platformio.org/page/projectconf.html |
|||
|
|||
[env:lolin32] |
|||
platform = espressif32 |
|||
board = lolin32 |
|||
framework = arduino |
|||
|
|||
|
|||
monitor_speed = 115200 |
|||
|
|||
lib_deps = |
|||
SSD1306=adafruit/Adafruit SSD1306@^2.5.6 |
|||
Adafruit_GPS=https://github.com/adafruit/Adafruit_GPS/archive/refs/tags/1.7.0.zip |
|||
SoftwareSerial=https://github.com/plerup/espsoftwareserial/archive/refs/tags/6.16.1.zip |
|||
Time=paulstoffregen/Time@^1.6.1 |
|||
SolarPosition=https://github.com/KenWillmott/SolarPosition.git |
|||
; NeoGPS=slashdevin/NeoGPS@^4.2.9 |
|||
|
|||
@ -0,0 +1,162 @@ |
|||
#include <Arduino.h>
|
|||
|
|||
#include <SPI.h>
|
|||
#include <Wire.h>
|
|||
#include <Adafruit_GFX.h>
|
|||
#include <Adafruit_SSD1306.h>
|
|||
|
|||
#include <Adafruit_GPS.h>
|
|||
#include <SoftwareSerial.h>
|
|||
|
|||
#include <wmm.h>
|
|||
#include <SolarPosition.h>
|
|||
|
|||
#define SCREEN_WIDTH 128
|
|||
#define SCREEN_HEIGHT 64
|
|||
|
|||
#define OLED_RESET -1
|
|||
#define SCREEN_ADDRESS 0x3C
|
|||
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET); |
|||
|
|||
SoftwareSerial altserial(14, 12); |
|||
Adafruit_GPS GPS(&altserial); |
|||
|
|||
uint32_t tstamp = millis(); |
|||
|
|||
typedef struct { |
|||
time_t epoch; |
|||
float latitude; |
|||
float longitude; |
|||
float declination; |
|||
float elevation; |
|||
float azimuth; |
|||
} tSolar; |
|||
|
|||
tSolar sun; |
|||
|
|||
void init_display() { |
|||
Wire.begin(5, 4); |
|||
|
|||
if(!display.begin(SSD1306_SWITCHCAPVCC, SCREEN_ADDRESS, false, false)) { |
|||
Serial.println(F("SSD1306 allocation failed")); |
|||
while(true) ; // do not proceed
|
|||
} |
|||
|
|||
display.clearDisplay(); |
|||
} |
|||
|
|||
void init_gps() { |
|||
altserial.begin(9600); |
|||
delay(2000); |
|||
|
|||
// Serial.println("Software Serial GPS Test Echo Test");
|
|||
// you can send various commands to get it started
|
|||
//mySerial.println(PMTK_SET_NMEA_OUTPUT_RMCGGA);
|
|||
altserial.println(PMTK_SET_NMEA_OUTPUT_ALLDATA); |
|||
altserial.println(PMTK_SET_NMEA_UPDATE_1HZ); |
|||
// Serial.println("Get version!");
|
|||
altserial.println(PMTK_Q_RELEASE); |
|||
} |
|||
|
|||
// ///////////////////////////////////////////////////////////////////////////////////////
|
|||
// ///////////////////////////////////////////////////////////////////////////////////////
|
|||
// ///////////////////////////////////////////////////////////////////////////////////////
|
|||
void setup() { |
|||
Serial.begin(115200); |
|||
init_display(); |
|||
init_gps(); |
|||
wmm_init(); |
|||
} |
|||
|
|||
void draw_sunpos() { |
|||
display.clearDisplay(); |
|||
|
|||
display.setTextSize(1); |
|||
display.setTextColor(SSD1306_WHITE); |
|||
display.setCursor(0, 0); |
|||
//display.print(F("lat ------> "));
|
|||
display.print(F("lat ....... ")); |
|||
display.print((double)sun.latitude, 2); |
|||
display.println(); |
|||
display.print(F("lon ....... ")); |
|||
display.print((double)sun.longitude, 2); |
|||
display.println(); |
|||
display.print(F("WMM ....... ")); |
|||
display.print((double)sun.declination, 2); |
|||
display.println(); |
|||
display.print(F("elevation .. ")); |
|||
display.print((double)sun.elevation, 4); |
|||
display.println(); |
|||
display.print(F("azimuth .... ")); |
|||
display.print((double)sun.azimuth, 4); |
|||
display.println(); |
|||
|
|||
// refresh
|
|||
display.display(); |
|||
} |
|||
|
|||
void debug_solar() { |
|||
Serial.print("Location: "); |
|||
Serial.print(sun.latitude, 4); //Serial.print(GPS.lat);
|
|||
Serial.print(", "); |
|||
Serial.print(sun.longitude, 4); //Serial.println(GPS.lon);
|
|||
|
|||
Serial.println(); |
|||
|
|||
Serial.print("WMM declination "); Serial.print(sun.declination, 4); |
|||
|
|||
Serial.println(); |
|||
|
|||
Serial.print(F("elevation: ")); |
|||
Serial.print(sun.elevation, 4); |
|||
Serial.print(F(" azimuth: ")); |
|||
Serial.println(sun.azimuth, 4); |
|||
|
|||
Serial.println(); |
|||
|
|||
// Serial.print("Speed (knots): "); Serial.println(GPS.speed);
|
|||
// Serial.print("Angle: "); Serial.println(GPS.angle);
|
|||
// Serial.print("Altitude: "); Serial.println(GPS.altitude);
|
|||
// Serial.print("Satellites: "); Serial.println((int)GPS.satellites);
|
|||
// Serial.print("Antenna status: "); Serial.println((int)GPS.antenna);
|
|||
} |
|||
|
|||
void loop() { |
|||
char c = GPS.read(); |
|||
// // if you want to debug, this is a good time to do it!
|
|||
//if (c) Serial.write(c);
|
|||
|
|||
// if a sentence is received, we can check the checksum, parse it...
|
|||
if (GPS.newNMEAreceived()) { |
|||
if (!GPS.parse(GPS.lastNMEA())) // this also sets the newNMEAreceived() flag to false
|
|||
return; // we can fail to parse a sentence in which case we should just wait for another
|
|||
} |
|||
|
|||
// approximately every 2 seconds or so, print out the current stats
|
|||
if (millis() - tstamp > 2000) { |
|||
tstamp = millis(); // reset the timer
|
|||
float wmmtime = wmm_get_date(GPS.year, GPS.month, GPS.day); |
|||
|
|||
sun.latitude = GPS.latitudeDegrees; |
|||
sun.longitude = GPS.longitudeDegrees; |
|||
|
|||
// create a fixed UNIX time to test fixed time method
|
|||
tmElements_t someTime = {GPS.seconds, GPS.minute, GPS.hour, 0, GPS.day, GPS.month, CalendarYrToTm(GPS.year) }; |
|||
sun.epoch = makeTime(someTime); |
|||
|
|||
if (GPS.fix) { |
|||
SolarPosition location(GPS.latitudeDegrees, GPS.longitudeDegrees); |
|||
|
|||
// calculate magnetic declination
|
|||
E0000(GPS.latitudeDegrees, GPS.longitudeDegrees, wmmtime, &sun.declination); |
|||
|
|||
sun.elevation = location.getSolarPosition(sun.epoch).elevation; |
|||
sun.azimuth = location.getSolarPosition(sun.epoch).azimuth; |
|||
|
|||
debug_solar(); |
|||
draw_sunpos(); |
|||
} |
|||
} |
|||
|
|||
// draw_sunpos();
|
|||
} // loop()
|
|||
Write
Preview
Loading…
Cancel
Save
Reference in new issue