finally Turn Slope

This commit is contained in:
richonguzman 2023-01-30 00:25:21 -03:00
parent 2cff04a4cf
commit 70deafa419
3 changed files with 20 additions and 15 deletions

Binary file not shown.

View File

@ -153,6 +153,7 @@ void loop() {
int MinimumTimeDeltaBeacon = CurrentUser[7].toInt();
int TurnMinDegrees = CurrentUser[8].toInt();
int TurnSlope = CurrentUser[9].toInt();
int TurnMinAngle;
currentHeading = gps.course.deg();
lastTxDistance = TinyGPSPlus::distanceBetween(gps.location.lat(), gps.location.lng(), lastTxLatitude, lastTxLongitude);
@ -165,7 +166,11 @@ void loop() {
if (!send_update) {
double headingDelta = abs(previousHeading - currentHeading);
if (lastTx > MinimumTimeDeltaBeacon * 1000) {
int TurnMinAngle = TurnMinDegrees + (TurnSlope/CurrentSpeed);
if (CurrentSpeed == 0) {
TurnMinAngle = TurnMinDegrees + (TurnSlope/(CurrentSpeed + 1));
} else {
TurnMinAngle = TurnMinDegrees + (TurnSlope/CurrentSpeed);
}
if (headingDelta > TurnMinAngle && lastTxDistance > MinimumDistanceTx) {
send_update = true;
mensaje_test = "C:" + String(headingDelta) + " D:" + String(lastTxDistance) + " I:" + String(txInterval);

View File

@ -1,7 +1,7 @@
#ifndef BEACON_CONFIG_H_
#define BEACON_CONFIG_H_
#define FirstUser 3 // Select the First User at Tracker Start Up (Example: 1 means User1)
#define FirstUser 1 // Select the First User at Tracker Start Up (Example: 1 means User1)
#define AprsPath "AP" // APRS Destination (could be also "WIDE1-1")
#define AprsOverlay "/"
#define SendAltitude true // "true" adds Altitude to the APRS packet/message, "false" add Course+Speed
@ -10,14 +10,14 @@
#define User1_Callsign "CD2RXU-7"
#define User1_Symbol "[" // Runner
#define User1_SlowRate 120
#define User1_SlowSpeed 3
#define User1_FastRate 60
#define User1_FastSpeed 15
#define User1_MinDistTx 5 // debe ser 50 pero esta 5 por pruebas
#define User1_MinDeltaBcn 20
#define User1_TurnMinDeg 3
#define User1_TurnSlope 70
#define User1_SlowRate 120 // seg
#define User1_SlowSpeed 3 // km/h
#define User1_FastRate 60 // seg
#define User1_FastSpeed 15 // km/h
#define User1_MinDistTx 5 // debe ser 100 pero esta 5 por pruebas
#define User1_MinDeltaBcn 20 // seg between beacon update
#define User1_TurnMinDeg 3 // degrees
#define User1_TurnSlope 40 // constant
#define User2_Callsign "CD2RXU-8"
#define User2_Symbol "b" // Bicycle
@ -25,10 +25,10 @@
#define User2_SlowSpeed 5
#define User2_FastRate 60
#define User2_FastSpeed 40
#define User2_MinDistTx 70
#define User2_MinDistTx 100
#define User2_MinDeltaBcn 12
#define User2_TurnMinDeg 15
#define User2_TurnSlope 70
#define User2_TurnMinDeg 12
#define User2_TurnSlope 60
#define User3_Callsign "CD2RXU-9"
#define User3_Symbol ">" // Car
@ -38,7 +38,7 @@
#define User3_FastSpeed 70
#define User3_MinDistTx 100
#define User3_MinDeltaBcn 8
#define User3_TurnMinDeg 12
#define User3_TurnMinDeg 10
#define User3_TurnSlope 80
#endif