334 lines
14 KiB
C++
334 lines
14 KiB
C++
#if defined BOARD_OBP60S3 || defined BOARD_OBP40S3
|
|
|
|
#include "Pagedata.h"
|
|
#include "OBP60Extensions.h"
|
|
|
|
class PageRollPitch : public Page
|
|
{
|
|
public:
|
|
PageRollPitch(CommonData &common){
|
|
commonData = &common;
|
|
common.logger->logDebug(GwLog::LOG,"Instantiate PageRollPitch");
|
|
}
|
|
|
|
// Key functions
|
|
virtual int handleKey(int key){
|
|
// Code for keylock
|
|
if(key == 11){
|
|
commonData->keylock = !commonData->keylock;
|
|
return 0; // Commit the key
|
|
}
|
|
return key;
|
|
}
|
|
|
|
virtual void displayPage(PageData &pageData){
|
|
GwConfigHandler *config = commonData->config;
|
|
GwLog *logger = commonData->logger;
|
|
|
|
double value1 = 0;
|
|
double value2 = 0;
|
|
String svalue1 = "";
|
|
String svalue1old = "";
|
|
String svalue2 = "";
|
|
String svalue2old = "";
|
|
|
|
|
|
// Get config data
|
|
String lengthformat = config->getString(config->lengthFormat);
|
|
bool simulation = config->getBool(config->useSimuData);
|
|
bool holdvalues = config->getBool(config->holdvalues);
|
|
String flashLED = config->getString(config->flashLED);
|
|
String backlightMode = config->getString(config->backlight);
|
|
int rolllimit = config->getInt(config->rollLimit);
|
|
String roffset = config->getString(config->rollOffset);
|
|
double rolloffset = roffset.toFloat()/360*(2*PI);
|
|
String poffset = config->getString(config->pitchOffset);
|
|
double pitchoffset = poffset.toFloat()/360*(2*PI);
|
|
|
|
// Get boat values for roll
|
|
GwApi::BoatValue *bvalue1 = pageData.values[0]; // First element in list (xdrRoll)
|
|
String name1 = xdrDelete(bvalue1->getName()); // Value name
|
|
name1 = name1.substring(0, 6); // String length limit for value name
|
|
bool valid1 = bvalue1->valid; // Valid information
|
|
if(valid1 == true){
|
|
value1 = bvalue1->value + rolloffset; // Raw value for pitch
|
|
}
|
|
else{
|
|
if(simulation == true){
|
|
value1 = (20 + float(random(0, 50)) / 10.0)/360*2*PI;
|
|
}
|
|
else{
|
|
value1 = 0;
|
|
}
|
|
}
|
|
if(value1/(2*PI)*360 > -10 && value1/(2*PI)*360 < 10){
|
|
svalue1 = String(value1/(2*PI)*360,1); // Convert raw value to string
|
|
}
|
|
else{
|
|
svalue1 = String(value1/(2*PI)*360,0);
|
|
}
|
|
if(valid1 == true){
|
|
svalue1old = svalue1; // Save the old value
|
|
}
|
|
// Get boat values for pitch
|
|
GwApi::BoatValue *bvalue2 = pageData.values[1]; // Second element in list (xdrPitch)
|
|
String name2 = xdrDelete(bvalue2->getName()); // Value name
|
|
name2 = name2.substring(0, 6); // String length limit for value name
|
|
bool valid2 = bvalue2->valid; // Valid information
|
|
if(valid2 == true){
|
|
value2 = bvalue2->value + pitchoffset; // Raw value for pitch
|
|
}
|
|
else{
|
|
if(simulation == true){
|
|
value2 = (float(random(-5, 5)))/360*2*PI;
|
|
}
|
|
else{
|
|
value2 = 0;
|
|
}
|
|
}
|
|
if(value2/(2*PI)*360 > -10 && value2/(2*PI)*360 < 10){
|
|
svalue2 = String(value2/(2*PI)*360,1); // Convert raw value to string
|
|
}
|
|
else{
|
|
svalue2 = String(value2/(2*PI)*360,0);
|
|
}
|
|
if(valid2 == true){
|
|
svalue2old = svalue2; // Save the old value
|
|
}
|
|
|
|
// Optical warning by limit violation
|
|
if(String(flashLED) == "Limit Violation"){
|
|
// Limits for roll
|
|
if(value1*360/(2*PI) >= -1*rolllimit && value1*360/(2*PI) <= rolllimit){
|
|
setBlinkingLED(false);
|
|
setFlashLED(false);
|
|
}
|
|
else{
|
|
setBlinkingLED(true);
|
|
}
|
|
}
|
|
|
|
// Logging boat values
|
|
if (bvalue1 == NULL) return;
|
|
LOG_DEBUG(GwLog::LOG,"Drawing at PageRollPitch, %s:%f, %s:%f", name1.c_str(), value1, name2.c_str(), value2);
|
|
|
|
// Draw page
|
|
//***********************************************************
|
|
|
|
// Set display in partial refresh mode
|
|
getdisplay().setPartialWindow(0, 0, getdisplay().width(), getdisplay().height()); // Set partial update
|
|
|
|
getdisplay().setTextColor(commonData->fgcolor);
|
|
|
|
// Show roll limit
|
|
getdisplay().setFont(&DSEG7Classic_BoldItalic20pt7b);
|
|
getdisplay().setCursor(10, 65);
|
|
getdisplay().print(rolllimit); // Value
|
|
//getdisplay().print(svalue1); // Value
|
|
|
|
getdisplay().setFont(&Ubuntu_Bold12pt7b);
|
|
getdisplay().setCursor(10, 95);
|
|
getdisplay().print("Limit"); // Name
|
|
getdisplay().setFont(&Ubuntu_Bold8pt7b);
|
|
getdisplay().setCursor(10, 115);
|
|
getdisplay().print("DEG");
|
|
|
|
// Horizintal separator left
|
|
getdisplay().fillRect(0, 149, 60, 3, commonData->fgcolor);
|
|
|
|
// Show roll value
|
|
getdisplay().setFont(&DSEG7Classic_BoldItalic20pt7b);
|
|
getdisplay().setCursor(10, 270);
|
|
if(holdvalues == false) getdisplay().print(svalue1); // Value
|
|
else getdisplay().print(svalue1old);
|
|
getdisplay().setFont(&Ubuntu_Bold12pt7b);
|
|
getdisplay().setCursor(10, 220);
|
|
getdisplay().print(name1); // Name
|
|
getdisplay().setFont(&Ubuntu_Bold8pt7b);
|
|
getdisplay().setCursor(10, 190);
|
|
getdisplay().print("Deg");
|
|
|
|
// Horizintal separator right
|
|
getdisplay().fillRect(340, 149, 80, 3, commonData->fgcolor);
|
|
|
|
// Show pitch value
|
|
getdisplay().setFont(&DSEG7Classic_BoldItalic20pt7b);
|
|
getdisplay().setCursor(295, 270);
|
|
if(holdvalues == false) getdisplay().print(svalue2); // Value
|
|
else getdisplay().print(svalue2old);
|
|
getdisplay().setFont(&Ubuntu_Bold12pt7b);
|
|
getdisplay().setCursor(335, 220);
|
|
getdisplay().print(name2); // Name
|
|
getdisplay().setFont(&Ubuntu_Bold8pt7b);
|
|
getdisplay().setCursor(335, 190);
|
|
getdisplay().print("Deg");
|
|
|
|
//*******************************************************************************************
|
|
|
|
// Draw instrument
|
|
int rInstrument = 100; // Radius of instrument
|
|
float pi = 3.141592;
|
|
|
|
getdisplay().fillCircle(200, 150, rInstrument + 10, commonData->fgcolor); // Outer circle
|
|
getdisplay().fillCircle(200, 150, rInstrument + 7, commonData->bgcolor); // Outer circle
|
|
|
|
for(int i=0; i<360; i=i+10)
|
|
{
|
|
// Only scaling +/- 60 degrees
|
|
if((i >= 0 && i <= 60) || (i >= 300 && i <= 360)){
|
|
// Scaling values
|
|
float x = 200 + (rInstrument+25)*sin(i/180.0*pi); // x-coordinate dots
|
|
float y = 150 - (rInstrument+25)*cos(i/180.0*pi); // y-coordinate cots
|
|
const char *ii = "";
|
|
switch (i)
|
|
{
|
|
case 0: ii="0"; break;
|
|
case 20 : ii="20"; break;
|
|
case 40 : ii="40"; break;
|
|
case 60 : ii="60"; break;
|
|
case 300 : ii="60"; break;
|
|
case 320 : ii="40"; break;
|
|
case 340 : ii="20"; break;
|
|
default: break;
|
|
}
|
|
|
|
// Print text centered on position x, y
|
|
int16_t x1, y1; // Return values of getTextBounds
|
|
uint16_t w, h; // Return values of getTextBounds
|
|
getdisplay().getTextBounds(ii, int(x), int(y), &x1, &y1, &w, &h); // Calc width of new string
|
|
getdisplay().setCursor(x-w/2, y+h/2);
|
|
if(i % 20 == 0){
|
|
getdisplay().setFont(&Ubuntu_Bold8pt7b);
|
|
getdisplay().print(ii);
|
|
}
|
|
|
|
// Draw sub scale with dots
|
|
float x1c = 200 + rInstrument*sin(i/180.0*pi);
|
|
float y1c = 150 - rInstrument*cos(i/180.0*pi);
|
|
getdisplay().fillCircle((int)x1c, (int)y1c, 2, commonData->fgcolor);
|
|
float sinx=sin(i/180.0*pi);
|
|
float cosx=cos(i/180.0*pi);
|
|
|
|
// Draw sub scale with lines (two triangles)
|
|
if(i % 20 == 0){
|
|
float dx=2; // Line thickness = 2*dx+1
|
|
float xx1 = -dx;
|
|
float xx2 = +dx;
|
|
float yy1 = -(rInstrument-10);
|
|
float yy2 = -(rInstrument+10);
|
|
getdisplay().fillTriangle(200+(int)(cosx*xx1-sinx*yy1),150+(int)(sinx*xx1+cosx*yy1),
|
|
200+(int)(cosx*xx2-sinx*yy1),150+(int)(sinx*xx2+cosx*yy1),
|
|
200+(int)(cosx*xx1-sinx*yy2),150+(int)(sinx*xx1+cosx*yy2),commonData->fgcolor);
|
|
getdisplay().fillTriangle(200+(int)(cosx*xx2-sinx*yy1),150+(int)(sinx*xx2+cosx*yy1),
|
|
200+(int)(cosx*xx1-sinx*yy2),150+(int)(sinx*xx1+cosx*yy2),
|
|
200+(int)(cosx*xx2-sinx*yy2),150+(int)(sinx*xx2+cosx*yy2),commonData->fgcolor);
|
|
}
|
|
}
|
|
}
|
|
|
|
// Draw mast position pointer
|
|
float startwidth = 8; // Start width of pointer
|
|
|
|
// value1 = (2 * pi ) - value1; // Mirror coordiante system for pointer, keel and boat
|
|
|
|
if(valid1 == true || holdvalues == true || simulation == true){
|
|
float sinx=sin(value1 + pi);
|
|
float cosx=cos(value1 + pi);
|
|
// Normal pointer
|
|
// Pointer as triangle with center base 2*width
|
|
float xx1 = -startwidth;
|
|
float xx2 = startwidth;
|
|
float yy1 = -startwidth;
|
|
float yy2 = -(rInstrument * 0.7);
|
|
getdisplay().fillTriangle(200+(int)(cosx*xx1-sinx*yy1),150+(int)(sinx*xx1+cosx*yy1),
|
|
200+(int)(cosx*xx2-sinx*yy1),150+(int)(sinx*xx2+cosx*yy1),
|
|
200+(int)(cosx*0-sinx*yy2),150+(int)(sinx*0+cosx*yy2),commonData->fgcolor);
|
|
// Inverted pointer
|
|
// Pointer as triangle with center base 2*width
|
|
float endwidth = 2; // End width of pointer
|
|
float ix1 = endwidth;
|
|
float ix2 = -endwidth;
|
|
float iy1 = -(rInstrument * 0.7);
|
|
float iy2 = -endwidth;
|
|
getdisplay().fillTriangle(200+(int)(cosx*ix1-sinx*iy1),150+(int)(sinx*ix1+cosx*iy1),
|
|
200+(int)(cosx*ix2-sinx*iy1),150+(int)(sinx*ix2+cosx*iy1),
|
|
200+(int)(cosx*0-sinx*iy2),150+(int)(sinx*0+cosx*iy2),commonData->fgcolor);
|
|
|
|
// Draw counterweight
|
|
getdisplay().fillCircle(200+(int)(cosx*0-sinx*yy2),150+(int)(sinx*0+cosx*yy2), 5, commonData->fgcolor);
|
|
}
|
|
|
|
// Center circle
|
|
getdisplay().fillCircle(200, 150, startwidth + 22, commonData->bgcolor);
|
|
getdisplay().fillCircle(200, 150, startwidth + 20, commonData->fgcolor); // Boat circle
|
|
int x0 = 200;
|
|
int y0 = 150;
|
|
int x1 = x0 + 50*cos(value1);
|
|
int y1 = y0 + 50*sin(value1);
|
|
int x2 = x0 + 50*cos(value1 - pi/2);
|
|
int y2 = y0 + 50*sin(value1 - pi/2);
|
|
getdisplay().fillTriangle(x0, y0, x1, y1, x2, y2, commonData->bgcolor); // Clear half top side of boat circle (right triangle)
|
|
x1 = x0 + 50*cos(value1 + pi);
|
|
y1 = y0 + 50*sin(value1 + pi);
|
|
getdisplay().fillTriangle(x0, y0, x1, y1, x2, y2, commonData->bgcolor); // Clear half top side of boat circle (left triangle)
|
|
getdisplay().fillRect(150, 160, 100, 4, commonData->fgcolor); // Water line
|
|
|
|
// Draw roll pointer
|
|
startwidth = 4; // Start width of pointer
|
|
if(valid1 == true || holdvalues == true || simulation == true){
|
|
float sinx=sin(value1); // Roll
|
|
float cosx=cos(value1);
|
|
// Normal pointer
|
|
// Pointer as triangle with center base 2*width
|
|
float xx1 = -startwidth;
|
|
float xx2 = startwidth;
|
|
float yy1 = -startwidth;
|
|
float yy2 = -(rInstrument - 15);
|
|
getdisplay().fillTriangle(200+(int)(cosx*xx1-sinx*yy1),150+(int)(sinx*xx1+cosx*yy1),
|
|
200+(int)(cosx*xx2-sinx*yy1),150+(int)(sinx*xx2+cosx*yy1),
|
|
200+(int)(cosx*0-sinx*yy2),150+(int)(sinx*0+cosx*yy2),commonData->fgcolor);
|
|
// Inverted pointer
|
|
// Pointer as triangle with center base 2*width
|
|
float endwidth = 2; // End width of pointer
|
|
float ix1 = endwidth;
|
|
float ix2 = -endwidth;
|
|
float iy1 = -(rInstrument - 15);
|
|
float iy2 = -endwidth;
|
|
getdisplay().fillTriangle(200+(int)(cosx*ix1-sinx*iy1),150+(int)(sinx*ix1+cosx*iy1),
|
|
200+(int)(cosx*ix2-sinx*iy1),150+(int)(sinx*ix2+cosx*iy1),
|
|
200+(int)(cosx*0-sinx*iy2),150+(int)(sinx*0+cosx*iy2),commonData->fgcolor);
|
|
}
|
|
else{
|
|
// Print sensor info
|
|
getdisplay().setFont(&Ubuntu_Bold8pt7b);
|
|
getdisplay().setCursor(145, 200);
|
|
getdisplay().print("No sensor data"); // Info missing sensor
|
|
}
|
|
|
|
// Update display
|
|
getdisplay().nextPage(); // Partial update (fast)
|
|
|
|
};
|
|
};
|
|
|
|
static Page *createPage(CommonData &common){
|
|
return new PageRollPitch(common);
|
|
}
|
|
/**
|
|
* with the code below we make this page known to the PageTask
|
|
* we give it a type (name) that can be selected in the config
|
|
* we define which function is to be called
|
|
* and we provide the number of user parameters we expect (0 here)
|
|
* and will will provide the names of the fixed values we need
|
|
*/
|
|
PageDescription registerPageRollPitch(
|
|
"RollPitch", // Page name
|
|
createPage, // Action
|
|
2, // Number of bus values depends on selection in Web configuration
|
|
// {"xdrROLL", "xdrPTCH"},// Bus values we need in the page
|
|
//{"xdrRoll", "xdrPitch"},// Bus values we need in the page
|
|
true // Show display header on/off
|
|
);
|
|
|
|
#endif
|