thooge
/
esp32-nmea2000-obp60
mirror of https://github.com/thooge/esp32-nmea2000-obp60.git
1
0
Fork 0
Code Releases Activity

no buffer writes for invalid data; fix ringbuffer index

This commit is contained in:
Ulrich Meine 2025-07-14 21:17:17 +02:00
parent 91a3ac081f
commit bb99978177
3 changed files with 70 additions and 83 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

26
lib/obp60task/OBPRingBuffer.tpp
View File

@ -44,11 +44,11 @@ void RingBuffer<T>::setMetaData(String name, String format, int updateFrequency,
template <typename T> template <typename T>
bool RingBuffer<T>::getMetaData(String& name, String& format, int& updateFrequency, T& minValue, T& maxValue) bool RingBuffer<T>::getMetaData(String& name, String& format, int& updateFrequency, T& minValue, T& maxValue)
{ {
GWSYNCHRONIZED(&bufLocker);
if (dataName == "" || dataFmt == "" || updFreq == -1) { if (dataName == "" || dataFmt == "" || updFreq == -1) {
return false; // Meta data not set return false; // Meta data not set
} }
GWSYNCHRONIZED(&bufLocker);
name = dataName; name = dataName;
format = dataFmt; format = dataFmt;
updateFrequency = updFreq; updateFrequency = updFreq;
@ -108,7 +108,7 @@ T RingBuffer<T>::getFirst() const
if (isEmpty()) { if (isEmpty()) {
return MIN_VAL; return MIN_VAL;
} }
return get(first); return get(0);
} }
// Get the last (newest) value in the buffer // Get the last (newest) value in the buffer
@ -118,7 +118,7 @@ T RingBuffer<T>::getLast() const
if (isEmpty()) { if (isEmpty()) {
return MIN_VAL; return MIN_VAL;
} }
return get(last); return get(count - 1);
} }
// Get the lowest value in the buffer // Get the lowest value in the buffer
@ -129,11 +129,11 @@ T RingBuffer<T>::getMin() const
return MIN_VAL; return MIN_VAL;
} }
T minVal = get(first); T minVal = getFirst();
T value; T value;
for (size_t i = 0; i < count; i++) { for (size_t i = 1; i < count; i++) {
value = get(i); value = get(i);
if (value < minVal) { if (value < minVal && value != MIN_VAL) {
minVal = value; minVal = value;
} }
} }
@ -150,10 +150,10 @@ T RingBuffer<T>::getMin(size_t amount) const
if (amount > count) if (amount > count)
amount = count; amount = count;
T minVal = get(last); T minVal = getLast();
T value; T value;
for (size_t i = 0; i < amount; i++) { for (size_t i = 0; i < amount; i++) {
value = get((last + capacity - i) % capacity); value = get(count - 1 - i);
if (value < minVal && value != MIN_VAL) { if (value < minVal && value != MIN_VAL) {
minVal = value; minVal = value;
} }
@ -169,11 +169,11 @@ T RingBuffer<T>::getMax() const
return MIN_VAL; return MIN_VAL;
} }
T maxVal = get(first); T maxVal = getFirst();
T value; T value;
for (size_t i = 0; i < count; i++) { for (size_t i = 1; i < count; i++) {
value = get(i); value = get(i);
if (value > maxVal) { if (value > maxVal && value != MIN_VAL) {
maxVal = value; maxVal = value;
} }
} }
@ -190,10 +190,10 @@ T RingBuffer<T>::getMax(size_t amount) const
if (amount > count) if (amount > count)
amount = count; amount = count;
T maxVal = get(last); T maxVal = getLast();
T value; T value;
for (size_t i = 0; i < amount; i++) { for (size_t i = 0; i < amount; i++) {
value = get((last + capacity - i) % capacity); value = get(count - 1 - i);
if (value > maxVal && value != MIN_VAL) { if (value > maxVal && value != MIN_VAL) {
maxVal = value; maxVal = value;
} }

14
lib/obp60task/OBPSensorTask.cpp
View File

@ -812,30 +812,24 @@ void sensorTask(void *param){
if (twdBVal->valid) { if (twdBVal->valid) {
val = static_cast<int16_t>(std::round(twdBVal->value * 1000)); // Shift value to store decimals in int16_t); val = static_cast<int16_t>(std::round(twdBVal->value * 1000)); // Shift value to store decimals in int16_t);
if (val < hstryMinVal || val > twdHstryMax) { if (val < hstryMinVal || val > twdHstryMax) {
val = INT16_MIN; // Add invalid value - to be fixed later val = INT16_MIN; // Add invalid value
}
} else {
val = INT16_MIN;
} }
twdHstry.add(val); twdHstry.add(val);
}
if (twsBVal->valid) { if (twsBVal->valid) {
val = static_cast<int16_t>(twsBVal->value * 10); // Shift value to store decimals in int16_t val = static_cast<int16_t>(twsBVal->value * 10); // Shift value to store decimals in int16_t
if (val < hstryMinVal || val > twsHstryMax) { if (val < hstryMinVal || val > twsHstryMax) {
val = INT16_MIN; // Add invalid value val = INT16_MIN; // Add invalid value
} }
} else {
val = INT16_MIN;
}
twsHstry.add(val); twsHstry.add(val);
}
if (dbtBVal->valid) { if (dbtBVal->valid) {
val = static_cast<int16_t>(dbtBVal->value * 10); // Shift value to store decimals in int16_t val = static_cast<int16_t>(dbtBVal->value * 10); // Shift value to store decimals in int16_t
if (val < hstryMinVal || val > dbtHstryMax) { if (val < hstryMinVal || val > dbtHstryMax) {
val = INT16_MIN; // Add invalid value val = INT16_MIN; // Add invalid value
} }
} else {
val = INT16_MIN;
}
dbtHstry.add(val); dbtHstry.add(val);
}
int counttime = millis() - starttime20; int counttime = millis() - starttime20;
api->getLogger()->logDebug(GwLog::ERROR,"SensorTask write time: %d", counttime); api->getLogger()->logDebug(GwLog::ERROR,"SensorTask write time: %d", counttime);

109
lib/obp60task/PageWindPlot.cpp
View File

@ -7,15 +7,17 @@
#include <N2kMessages.h> // just for RadToDeg function #include <N2kMessages.h> // just for RadToDeg function
#include <vector> #include <vector>
static const float radToDeg = 180.0 / M_PI; // Conversion factor from radians to degrees static const double radToDeg = 180.0 / M_PI; // Conversion factor from radians to degrees
// #define radians(a) (a * 0.017453292519943295)
// #define degrees(a) (a * 57.29577951308232)
// Get maximum difference of last <amount> of TWD ringbuffer values to center chart // Get maximum difference of last <amount> of TWD ringbuffer values to center chart
int getRng(const RingBuffer<int16_t>& windDirHstry, int center, size_t amount) int getRng(const RingBuffer<int16_t>& windDirHstry, int center, size_t amount)
{ {
int minVal = windDirHstry.getMinVal(); int minVal = windDirHstry.getMinVal();
size_t count = windDirHstry.getCurrentSize(); size_t count = windDirHstry.getCurrentSize();
size_t capacity = windDirHstry.getCapacity(); // size_t capacity = windDirHstry.getCapacity();
size_t last = windDirHstry.getLastIdx(); // size_t last = windDirHstry.getLastIdx();
if (windDirHstry.isEmpty() || amount <= 0) { if (windDirHstry.isEmpty() || amount <= 0) {
return minVal; return minVal;
@ -28,7 +30,8 @@ int getRng(const RingBuffer<int16_t>& windDirHstry, int center, size_t amount)
int maxRng = minVal; int maxRng = minVal;
// Start from the newest value (last) and go backwards x times // Start from the newest value (last) and go backwards x times
for (size_t i = 0; i < amount; i++) { for (size_t i = 0; i < amount; i++) {
value = windDirHstry.get(((last - i) % capacity + capacity) % capacity); // value = windDirHstry.get(((last - i) % capacity + capacity) % capacity);
value = windDirHstry.get(count - 1 - i);
if (value == minVal) { if (value == minVal) {
continue; continue;
@ -47,18 +50,18 @@ int getRng(const RingBuffer<int16_t>& windDirHstry, int center, size_t amount)
} }
void fillSimData(PageData& pageData) void fillSimData(PageData& pageData)
// Fill the TWD history buffer with simulated data // Fill part of the TWD history buffer with simulated data
{ {
int value = 20; int value = 20;
int16_t value2 = 0; int16_t value2 = 0;
for (int i = 0; i < 600; i++) { for (int i = 0; i < 900; i++) {
value += random(-20, 20); value += random(-20, 20);
if (value < 0) if (value < 0)
value += 360; value += 360;
if (value >= 360) if (value >= 360)
value -= 360; value -= 360;
value2 = static_cast<int16_t>(DegToRad(value) * 1000.0); value2 = static_cast<int16_t>(DegToRad(value) * 1000.0);
pageData.boatHstry.twdHstry->add(value2); // Fill the buffer with some test data pageData.boatHstry.twdHstry->add(value2);
} }
} }
@ -67,18 +70,18 @@ void fillTstBuffer(PageData& pageData)
float value = 0; float value = 0;
int value2 = 0; int value2 = 0;
for (int i = 0; i < 60; i++) { for (int i = 0; i < 60; i++) {
pageData.boatHstry.twdHstry->add(-10); // Fill the buffer with some test data pageData.boatHstry.twdHstry->add(-10); // -> irregular data
} }
for (int i = 0; i < 20; i++) { for (int i = 0; i < 20; i++) {
for (int j = 0; j < 20; j++) { for (int j = 0; j < 20; j++) {
value += 10; value += 10;
value2 = static_cast<int>(DegToRad(value) * 1000.0); value2 = static_cast<int>(DegToRad(value) * 1000.0);
pageData.boatHstry.twdHstry->add(value2); // Fill the buffer with some test data pageData.boatHstry.twdHstry->add(value2);
} }
for (int j = 0; j < 20; j++) { for (int j = 0; j < 20; j++) {
value -= 10; value -= 10;
value2 = static_cast<int>(DegToRad(value) * 1000.0); value2 = static_cast<int>(DegToRad(value) * 1000.0);
pageData.boatHstry.twdHstry->add(value2); // Fill the buffer with some test data pageData.boatHstry.twdHstry->add(value2);
} }
} }
} }
@ -172,10 +175,9 @@ public:
static const int yOffset = 48; // Offset for y coordinates of chart area static const int yOffset = 48; // Offset for y coordinates of chart area
static int cHeight; // height of chart area static int cHeight; // height of chart area
static int bufSize; // History buffer size: 960 values for appox. 16 min. history chart static int bufSize; // History buffer size: 960 values for appox. 16 min. history chart
int intvBufSize; // Buffer size used for currently selected time interval static int intvBufSize; // Buffer size used for currently selected time interval
int count; // current size of buffer int count; // current size of buffer
int numWndVals; // number of wind values available for current interval selection static int numWndVals; // number of wind values available for current interval selection
static int linesToShow; // current number of lines to display on chart
static int bufStart; // 1st data value in buffer to show static int bufStart; // 1st data value in buffer to show
int numAddedBufVals; // Number of values added to buffer since last display int numAddedBufVals; // Number of values added to buffer since last display
size_t currIdx; // Current index in TWD history buffer size_t currIdx; // Current index in TWD history buffer
@ -223,7 +225,6 @@ public:
simTws = 0; simTws = 0;
twsValue = 0; twsValue = 0;
bufStart = 0; bufStart = 0;
linesToShow = 0;
oldDataIntv = 0; oldDataIntv = 0;
numAddedBufVals, currIdx, lastIdx = 0; numAddedBufVals, currIdx, lastIdx = 0;
lastAddedIdx = pageData.boatHstry.twdHstry->getLastIdx(); lastAddedIdx = pageData.boatHstry.twdHstry->getLastIdx();
@ -247,43 +248,38 @@ public:
simTwd -= 360.0; simTwd -= 360.0;
int16_t z = static_cast<int16_t>(DegToRad(simTwd) * 1000.0); int16_t z = static_cast<int16_t>(DegToRad(simTwd) * 1000.0);
LOG_DEBUG(GwLog::ERROR, "PageWindPlot Simulation: getLast TWD: %.0f, lastIdx: %d", pageData.boatHstry.twdHstry->getLast() / 1000.0 * RAD_TO_DEG, pageData.boatHstry.twdHstry->getLastIdx());
pageData.boatHstry.twdHstry->add(z); // Fill the buffer with some test data pageData.boatHstry.twdHstry->add(z); // Fill the buffer with some test data
LOG_DEBUG(GwLog::ERROR, "PageWindPlot Simulation: getAdded TWD: %.0f, lastIdx: %d", pageData.boatHstry.twdHstry->getLast() / 1000.0 * RAD_TO_DEG, pageData.boatHstry.twdHstry->getLastIdx());
simTws += random(-20, 20); // TWS value in knots simTws += random(-200, 150) / 10.0; // TWS value in knots
simTws = constrain(simTws, 0.0f, 50.0f); // Ensure TWS is between 0 and 50 knots simTws = constrain(simTws, 0.0f, 50.0f); // Ensure TWS is between 0 and 50 knots
twsValue = simTws; twsValue = simTws;
LOG_DEBUG(GwLog::ERROR, "PageWindPlot Simulation: simTwd: %f, twsValue: %f", simTwd, twsValue);
} else { } else {
twsValue = pageData.boatHstry.twsHstry->getLast() / 10.0 * 1.94384; // TWS value in knots twsValue = pageData.boatHstry.twsHstry->getLast() / 10.0 * 1.94384; // TWS value in knots
} }
// Identify buffer size and buffer start position for chart // Identify buffer size and buffer start position for chart
intvBufSize = cHeight * dataIntv;
count = pageData.boatHstry.twdHstry->getCurrentSize(); count = pageData.boatHstry.twdHstry->getCurrentSize();
numWndVals = min(count, intvBufSize);
currIdx = pageData.boatHstry.twdHstry->getLastIdx(); currIdx = pageData.boatHstry.twdHstry->getLastIdx();
numAddedBufVals = (currIdx - lastAddedIdx + bufSize) % bufSize; // Number of values added to buffer since last display numAddedBufVals = (currIdx - lastAddedIdx + bufSize) % bufSize; // Number of values added to buffer since last display
if (dataIntv != oldDataIntv) { if (dataIntv != oldDataIntv) {
// new data interval selected by user // new data interval selected by user
linesToShow = min(numWndVals / dataIntv, cHeight - 60); intvBufSize = cHeight * dataIntv;
bufStart = max(0, count - (linesToShow * dataIntv)); numWndVals = min(count, (cHeight - 60) * dataIntv);
currIdx++; // eliminate current added value for bufStart calculation bufStart = max(0, count - numWndVals);
lastAddedIdx = currIdx;
oldDataIntv = dataIntv; oldDataIntv = dataIntv;
} else { } else {
if (numAddedBufVals >= dataIntv) { numWndVals = numWndVals + numAddedBufVals;
linesToShow += (numAddedBufVals / dataIntv); // Number of lines to show on chart
LOG_DEBUG(GwLog::ERROR, "PageWindPlot bufStart: bufStart: %d, numAddedBufVals: %d, linesToShow: %d, count %d, bufSize %d, Cnt=Size: %d", bufStart, numAddedBufVals, linesToShow, count, bufSize, count == bufSize);
lastAddedIdx = currIdx; lastAddedIdx = currIdx;
} if (count == bufSize) {
if (count == bufSize && currIdx != lastIdx) { bufStart = max(0, bufStart - numAddedBufVals);
int numVals = (currIdx - lastIdx + bufSize) % bufSize;
bufStart = ((bufStart - numVals) % bufSize + bufSize) % bufSize; // keep 1st chart value constant in a rolling buffer when new data is added
lastIdx = currIdx;
} }
} }
LOG_DEBUG(GwLog::ERROR, "PageWindPlot Dataset: TWD: %.1f, TWS: %.1f, DBT: %.1f, count: %d, intvBufSize: %d, numWndVals: %d, bufStart: %d, linesToShow: %d, numAddedBufVals: %d, lastIdx: %d", LOG_DEBUG(GwLog::ERROR, "PageWindPlot Dataset: TWD: %.0f, TWS: %.1f, DBT: %.1f, count: %d, intvBufSize: %d, numWndVals: %d, bufStart: %d, numAddedBufVals: %d, lastIdx: %d",
pageData.boatHstry.twdHstry->getLast() / 1000.0 * radToDeg, pageData.boatHstry.twsHstry->getLast() / 10.0 * 1.94384, pageData.boatHstry.dbtHstry->getLast() / 10.0, pageData.boatHstry.twdHstry->getLast() / 1000.0 * radToDeg, pageData.boatHstry.twsHstry->getLast() / 10.0 * 1.94384, pageData.boatHstry.dbtHstry->getLast() / 10.0,
count, intvBufSize, numWndVals, bufStart, linesToShow, numAddedBufVals, lastIdx); count, intvBufSize, numWndVals, bufStart, numAddedBufVals, pageData.boatHstry.twdHstry->getLastIdx());
// initialize chart range values // initialize chart range values
if (wndCenter == INT_MIN) { if (wndCenter == INT_MIN) {
@ -309,7 +305,7 @@ public:
if (wndRight >= 360) if (wndRight >= 360)
wndRight -= 360; wndRight -= 360;
LOG_DEBUG(GwLog::DEBUG, "PageWindPlot FirstVal: %f, LastVal: %d, count: %d, diffRng: %d, chartRng: %d, Center: %d, scale: %f", pageData.boatHstry.twdHstry->getFirst() / 1000.0 * radToDeg, LOG_DEBUG(GwLog::DEBUG, "PageWindPlot FirstVal: %f, LastVal: %d, count: %d, diffRng: %d, chartRng: %d, Center: %d, scale: %f", pageData.boatHstry.twdHstry->getFirst() / 1000.0 * radToDeg,
pageData.boatHstry.twdHstry->get(linesToShow) / 1000.0 * radToDeg, count, diffRng, chrtRng, wndCenter, chrtScl); pageData.boatHstry.twdHstry->getLast() / 1000.0 * radToDeg, count, diffRng, chrtRng, wndCenter, chrtScl);
// Draw page // Draw page
//*********************************************************************** //***********************************************************************
@ -324,7 +320,7 @@ public:
// chart labels // chart labels
char sWndLbl[4]; // char buffer for Wind angle label char sWndLbl[4]; // char buffer for Wind angle label
getdisplay().setFont(&Ubuntu_Bold12pt7b); getdisplay().setFont(&Ubuntu_Bold12pt8b);
getdisplay().setCursor(xCenter - 88, yOffset - 3); getdisplay().setCursor(xCenter - 88, yOffset - 3);
getdisplay().print("TWD"); // Wind name getdisplay().print("TWD"); // Wind name
// getdisplay().setCursor(xCenter - 20, yOffset - 3); // getdisplay().setCursor(xCenter - 20, yOffset - 3);
@ -344,7 +340,7 @@ public:
getdisplay().drawCircle(width - 5, yOffset - 17, 2, commonData->fgcolor); // <degree> symbol getdisplay().drawCircle(width - 5, yOffset - 17, 2, commonData->fgcolor); // <degree> symbol
getdisplay().drawCircle(width - 5, yOffset - 17, 3, commonData->fgcolor); // <degree> symbol getdisplay().drawCircle(width - 5, yOffset - 17, 3, commonData->fgcolor); // <degree> symbol
if (pageData.boatHstry.twdHstry->getMax() == twdLowest) { if (pageData.boatHstry.twdHstry->getMax() == pageData.boatHstry.twdHstry->getMinVal()) {
// only <INT16_MIN> values in buffer -> no valid wind data available // only <INT16_MIN> values in buffer -> no valid wind data available
wndDataValid = false; wndDataValid = false;
} else { } else {
@ -353,8 +349,8 @@ public:
// Draw wind values in chart // Draw wind values in chart
//*********************************************************************** //***********************************************************************
if (wndDataValid) { if (wndDataValid) {
for (int i = 0; i < linesToShow; i++) { for (int i = 0; i < (numWndVals / dataIntv); i++) {
chrtVal = static_cast<int>(pageData.boatHstry.twdHstry->get((bufStart + (i * dataIntv)) % bufSize)); // show the latest wind values in buffer; keep 1st value constant in a rolling buffer chrtVal = static_cast<int>(pageData.boatHstry.twdHstry->get(bufStart + (i * dataIntv))); // show the latest wind values in buffer; keep 1st value constant in a rolling buffer
if (chrtVal == INT16_MIN) { if (chrtVal == INT16_MIN) {
chrtPrevVal = INT16_MIN; chrtPrevVal = INT16_MIN;
/* if (i == linesToShow - 1) { /* if (i == linesToShow - 1) {
@ -373,8 +369,9 @@ public:
chrtVal = (chrtVal / 1000.0 * radToDeg) + 0.5; // Convert to degrees and round chrtVal = (chrtVal / 1000.0 * radToDeg) + 0.5; // Convert to degrees and round
x = ((chrtVal - wndLeft + 360) % 360) * chrtScl; x = ((chrtVal - wndLeft + 360) % 360) * chrtScl;
y = yOffset + cHeight - i; // Position in chart area y = yOffset + cHeight - i; // Position in chart area
if (i > linesToShow - 30)
LOG_DEBUG(GwLog::ERROR, "PageWindPlot Chart: i: %d, chrtVal: %d, bufStart: %d count: %d, linesToShow: %d", i, chrtVal, bufStart, count, linesToShow); if (i >= (numWndVals / dataIntv) - 10)
LOG_DEBUG(GwLog::ERROR, "PageWindPlot Chart: i: %d, chrtVal: %d, bufStart: %d count: %d, linesToShow: %d", i, chrtVal, bufStart, count, (numWndVals / dataIntv));
if ((i == 0) || (chrtPrevVal == INT16_MIN)) { if ((i == 0) || (chrtPrevVal == INT16_MIN)) {
// just a dot for 1st chart point or after some invalid values // just a dot for 1st chart point or after some invalid values
@ -403,10 +400,8 @@ public:
} }
// Reaching chart area top end // Reaching chart area top end
if (i >= (cHeight - 1)) { if (i >= (cHeight - 1)) {
linesToShow -= min(60, cHeight); // free top 40 lines of chart for new values oldDataIntv = 0; // force reset of buffer start and number of values to show in next display loop
if (count >= numWndVals) {
bufStart = (bufStart + (60 * dataIntv)) % bufSize; // next start value in buffer to show
}
int minWndDir = pageData.boatHstry.twdHstry->getMin(numWndVals) / 1000.0 * radToDeg; int minWndDir = pageData.boatHstry.twdHstry->getMin(numWndVals) / 1000.0 * radToDeg;
int maxWndDir = pageData.boatHstry.twdHstry->getMax(numWndVals) / 1000.0 * radToDeg; int maxWndDir = pageData.boatHstry.twdHstry->getMax(numWndVals) / 1000.0 * radToDeg;
LOG_DEBUG(GwLog::ERROR, "PageWindPlot FreeTop: Minimum: %d, Maximum: %d, OldwndCenter: %d", minWndDir, maxWndDir, wndCenter); LOG_DEBUG(GwLog::ERROR, "PageWindPlot FreeTop: Minimum: %d, Maximum: %d, OldwndCenter: %d", minWndDir, maxWndDir, wndCenter);
@ -417,7 +412,7 @@ public:
wndCenter = int((midWndDir + (midWndDir >= 0 ? 5 : -5)) / 10) * 10; // Set new center value; round to nearest 10 degree value wndCenter = int((midWndDir + (midWndDir >= 0 ? 5 : -5)) / 10) * 10; // Set new center value; round to nearest 10 degree value
} }
} }
LOG_DEBUG(GwLog::ERROR, "PageWindPlot FreeTop: cHeight: %d, LinesToShow: %d, bufStart: %d, numWndVals: %d, wndCenter: %d", cHeight, linesToShow, bufStart, numWndVals, wndCenter); LOG_DEBUG(GwLog::ERROR, "PageWindPlot FreeTop: cHeight: %d, bufStart: %d, numWndVals: %d, wndCenter: %d", cHeight, bufStart, numWndVals, wndCenter);
break; break;
} }
} }
@ -425,7 +420,7 @@ public:
} else { } else {
// No valid data available // No valid data available
LOG_DEBUG(GwLog::LOG, "PageWindPlot: No valid data available"); LOG_DEBUG(GwLog::LOG, "PageWindPlot: No valid data available");
getdisplay().setFont(&Ubuntu_Bold10pt7b); getdisplay().setFont(&Ubuntu_Bold10pt8b);
getdisplay().fillRect(xCenter - 66, height / 2 - 20, 146, 24, commonData->bgcolor); // Clear area for TWS value getdisplay().fillRect(xCenter - 66, height / 2 - 20, 146, 24, commonData->bgcolor); // Clear area for TWS value
drawTextCenter(xCenter, height / 2 - 10, "No sensor data"); drawTextCenter(xCenter, height / 2 - 10, "No sensor data");
} }
@ -438,11 +433,8 @@ public:
int xPosTws; int xPosTws;
static const int yPosTws = yOffset + 40; static const int yPosTws = yOffset + 40;
// xPosTws = flipTws ? 30 : width - 145;
xPosTws = flipTws ? 20 : width - 138; xPosTws = flipTws ? 20 : width - 138;
currentZone = (y >= yPosTws - 38) && (y <= yPosTws + 6) && (x >= xPosTws - 4) && (x <= xPosTws + 146) ? 1 : 0; // Define current zone for TWS value currentZone = (y >= yPosTws - 38) && (y <= yPosTws + 6) && (x >= xPosTws - 4) && (x <= xPosTws + 146) ? 1 : 0; // Define current zone for TWS value
// currentZone = (x >= xPosTws - 4) && (x <= xPosTws + 142) ? 1 : 0; // Define current zone for TWS value
// LOG_DEBUG(GwLog::DEBUG, "PageWindPlot TWS: xPos: %d, yPos: %d, x: %d y: %d, currZone: %d, lastZone: %d", xPosTws, yPosTws, x, y, currentZone, lastZone);
if (currentZone != lastZone) { if (currentZone != lastZone) {
// Only flip when x moves to a different zone // Only flip when x moves to a different zone
if ((y >= yPosTws - 38) && (y <= yPosTws + 6) && (x >= xPosTws - 4) && (x <= xPosTws + 146)) { if ((y >= yPosTws - 38) && (y <= yPosTws + 6) && (x >= xPosTws - 4) && (x <= xPosTws + 146)) {
@ -455,16 +447,19 @@ public:
getdisplay().fillRect(xPosTws - 4, yPosTws - 38, 142, 44, commonData->bgcolor); // Clear area for TWS value getdisplay().fillRect(xPosTws - 4, yPosTws - 38, 142, 44, commonData->bgcolor); // Clear area for TWS value
getdisplay().setFont(&DSEG7Classic_BoldItalic16pt7b); getdisplay().setFont(&DSEG7Classic_BoldItalic16pt7b);
getdisplay().setCursor(xPosTws, yPosTws); getdisplay().setCursor(xPosTws, yPosTws);
// twsValue = pageData.boatHstry.twsHstry->getLast() / 10.0 * 1.94384; // TWS value in knots
if (twsValue < 0 || twsValue >= 100) { if (twsValue < 0 || twsValue >= 100) {
getdisplay().print("--.-"); getdisplay().print("--.-");
} else { } else {
getdisplay().printf("%2.1f", twsValue); // Value if (twsValue < 10.0) {
getdisplay().printf("!%3.1f", twsValue); // Value
} else {
getdisplay().printf("%4.1f", twsValue); // Value}
} }
getdisplay().setFont(&Ubuntu_Bold12pt7b); }
getdisplay().setFont(&Ubuntu_Bold12pt8b);
getdisplay().setCursor(xPosTws + 82, yPosTws - 14); getdisplay().setCursor(xPosTws + 82, yPosTws - 14);
getdisplay().print("TWS"); // Name getdisplay().print("TWS"); // Name
getdisplay().setFont(&Ubuntu_Bold8pt7b); getdisplay().setFont(&Ubuntu_Bold8pt8b);
getdisplay().setCursor(xPosTws + 78, yPosTws + 1); getdisplay().setCursor(xPosTws + 78, yPosTws + 1);
getdisplay().printf(" kn"); // Unit getdisplay().printf(" kn"); // Unit
} }
@ -472,7 +467,7 @@ public:
// chart Y axis labels; print at last to overwrite potential chart lines in label area // chart Y axis labels; print at last to overwrite potential chart lines in label area
int yPos; int yPos;
int chrtLbl; int chrtLbl;
getdisplay().setFont(&Ubuntu_Bold8pt7b); getdisplay().setFont(&Ubuntu_Bold8pt8b);
for (int i = 1; i <= 3; i++) { for (int i = 1; i <= 3; i++) {
yPos = yOffset + (i * 60); yPos = yOffset + (i * 60);
getdisplay().fillRect(0, yPos, width, 1, commonData->fgcolor); getdisplay().fillRect(0, yPos, width, 1, commonData->fgcolor);
@ -483,16 +478,13 @@ public:
chrtLbl = ((i - 1 + (prevY < yOffset + 30)) * dataIntv) * -1; // change label if last data point is more than 30 lines (= seconds) from chart line chrtLbl = ((i - 1 + (prevY < yOffset + 30)) * dataIntv) * -1; // change label if last data point is more than 30 lines (= seconds) from chart line
} else { } else {
int j = 3 - i; int j = 3 - i;
// chrtLbl = (int((((count / dataIntv) - 50) * dataIntv / 60) + 1) - ((j - 1) * dataIntv)) * -1; // 50 lines left below last chart line chrtLbl = (int((((numWndVals / dataIntv) - 50) * dataIntv / 60) + 1) - (j * dataIntv)) * -1; // 50 lines left below last chart line
chrtLbl = (int(((linesToShow - 50) * dataIntv / 60) + 1) - (j * dataIntv)) * -1; // 50 lines left below last chart line
} }
// if (chrtLbl <= 0) {
getdisplay().printf("%3d", chrtLbl); // Wind value label getdisplay().printf("%3d", chrtLbl); // Wind value label
// }
} }
unsigned long finish = millis() - start; unsigned long finish = millis() - start;
LOG_DEBUG(GwLog::ERROR, "PageWindPlot Time: %lu", finish); // LOG_DEBUG(GwLog::ERROR, "PageWindPlot Time: %lu", finish);
// Update display // Update display
getdisplay().nextPage(); // Partial update (fast) getdisplay().nextPage(); // Partial update (fast)
}; };
@ -513,7 +505,8 @@ PageDescription registerPageWindPlot(
"WindPlot", // Page name "WindPlot", // Page name
createPage, // Action createPage, // Action
0, // Number of bus values depends on selection in Web configuration 0, // Number of bus values depends on selection in Web configuration
{ "TWD", "TWA", "TWS", "HDM", "AWA", "AWS", "STW", "COG", "SOG" }, // Bus values we need in the page // { "TWD", "TWA", "TWS", "HDM", "AWA", "AWS", "STW", "COG", "SOG" }, // Bus values we need in the page
{ }, // Bus values we need in the page
true // Show display header on/off true // Show display header on/off
); );