97 lines
3.1 KiB
C++
97 lines
3.1 KiB
C++
/*
|
|
* Copyright (C) OpenTX
|
|
*
|
|
* Based on code named
|
|
* th9x - http://code.google.com/p/th9x
|
|
* er9x - http://code.google.com/p/er9x
|
|
* gruvin9x - http://code.google.com/p/gruvin9x
|
|
*
|
|
* License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*/
|
|
|
|
#include "../../opentx.h"
|
|
|
|
coord_t getCurveYCoord(FnFuncP fn, int x, int width)
|
|
{
|
|
return limit(-width, -divRoundClosest(fn(divRoundClosest(x * RESX, width)) * width, RESX), +width);
|
|
}
|
|
|
|
void drawFunction(FnFuncP fn, int x, int y, int width)
|
|
{
|
|
int left = x - width;
|
|
int right = x + width;
|
|
|
|
// Axis
|
|
lcdDrawSolidHorizontalLine(left, y, width*2+1, CURVE_AXIS_COLOR);
|
|
lcdDrawSolidVerticalLine(x, y-width, width*2, CURVE_AXIS_COLOR);
|
|
|
|
// Extra lines
|
|
lcdDrawVerticalLine(left+width/2, y-width, width*2, STASHED, CURVE_AXIS_COLOR);
|
|
lcdDrawVerticalLine(right-width/2, y-width, width*2, STASHED, CURVE_AXIS_COLOR);
|
|
lcdDrawHorizontalLine(left, y-width/2, width*2+1, STASHED, CURVE_AXIS_COLOR);
|
|
lcdDrawHorizontalLine(left, y+width/2, width*2+1, STASHED, CURVE_AXIS_COLOR);
|
|
|
|
// Outside border
|
|
lcdDrawSolidVerticalLine(left, y-width, width*2, TEXT_COLOR);
|
|
lcdDrawSolidVerticalLine(right, y-width, width*2, TEXT_COLOR);
|
|
lcdDrawSolidHorizontalLine(left, y-width, width*2+1, TEXT_COLOR);
|
|
lcdDrawSolidHorizontalLine(left, y+width, width*2+1, TEXT_COLOR);
|
|
|
|
coord_t prev_yv = (coord_t)-1;
|
|
|
|
for (int xv=-width; xv<=width; xv+=1) {
|
|
coord_t yv = y + getCurveYCoord(fn, xv, width);
|
|
if (prev_yv != (coord_t)-1) {
|
|
if (prev_yv < yv) {
|
|
for (int y=prev_yv; y<=yv; y+=1) {
|
|
lcdDrawBitmapPattern(x+xv-2, y-2, LBM_POINT, TEXT_COLOR);
|
|
}
|
|
}
|
|
else {
|
|
for (int y=yv; y<=prev_yv; y+=1) {
|
|
lcdDrawBitmapPattern(x+xv-2, y-2, LBM_POINT, TEXT_COLOR);
|
|
}
|
|
}
|
|
}
|
|
prev_yv = yv;
|
|
}
|
|
}
|
|
|
|
void drawCurveVerticalScale(int x)
|
|
{
|
|
for (int i=0; i<=20; i++) {
|
|
lcdDrawSolidHorizontalLine(x, CURVE_CENTER_Y-CURVE_SIDE_WIDTH+i*CURVE_SIDE_WIDTH/10, 10, TEXT_COLOR);
|
|
}
|
|
}
|
|
|
|
void drawCurveHorizontalScale()
|
|
{
|
|
for (int i=0; i<=20; i++) {
|
|
lcdDrawSolidVerticalLine(CURVE_CENTER_X-CURVE_SIDE_WIDTH+i*CURVE_SIDE_WIDTH/10, CURVE_CENTER_Y+CURVE_SIDE_WIDTH+5, 10, TEXT_COLOR);
|
|
}
|
|
}
|
|
|
|
void drawCurveCoord(int x, int y, const char * text, bool active)
|
|
{
|
|
lcdDrawSolidFilledRect(x, y, CURVE_COORD_WIDTH, CURVE_COORD_HEIGHT, CURVE_CURSOR_COLOR);
|
|
lcdDrawText(x+3+(CURVE_COORD_WIDTH-1-getTextWidth(text, SMLSIZE))/2, y+1, text, LEFT|SMLSIZE|TEXT_BGCOLOR);
|
|
if (active) {
|
|
lcdDrawBitmapPattern(x, y, LBM_CURVE_COORD_SHADOW, TEXT_COLOR);
|
|
}
|
|
}
|
|
|
|
void drawCurvePoint(int x, int y, LcdFlags color)
|
|
{
|
|
lcdDrawBitmapPattern(x, y, LBM_CURVE_POINT, color);
|
|
lcdDrawBitmapPattern(x, y, LBM_CURVE_POINT_CENTER, TEXT_BGCOLOR);
|
|
}
|