radio/src/gui/480x272/curves.cpp

   1 /*
   2  * Copyright (C) OpenTX
   3  *
   4  * Based on code named
   5  *   th9x - http://code.google.com/p/th9x
   6  *   er9x - http://code.google.com/p/er9x
   7  *   gruvin9x - http://code.google.com/p/gruvin9x
   8  *
   9  * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  */
  20
  21 #include "opentx.h"
  22
  23 coord_t getCurveYCoord(FnFuncP fn, int x, int width)
  24 {
  25   return limit(-width, -divRoundClosest(fn(divRoundClosest(x * RESX, width)) * width, RESX), +width);
  26 }
  27
  28 void drawFunction(FnFuncP fn, int x, int y, int width)
  29 {
  30   int left = x - width;
  31   int right = x + width;
  32
  33   // Axis
  34   lcdDrawSolidHorizontalLine(left, y, width*2+1, CURVE_AXIS_COLOR);
  35   lcdDrawSolidVerticalLine(x, y-width, width*2, CURVE_AXIS_COLOR);
  36
  37   // Extra lines
  38   lcdDrawVerticalLine(left+width/2, y-width, width*2, STASHED, CURVE_AXIS_COLOR);
  39   lcdDrawVerticalLine(right-width/2, y-width, width*2, STASHED, CURVE_AXIS_COLOR);
  40   lcdDrawHorizontalLine(left, y-width/2, width*2+1, STASHED, CURVE_AXIS_COLOR);
  41   lcdDrawHorizontalLine(left, y+width/2, width*2+1, STASHED, CURVE_AXIS_COLOR);
  42
  43   // Outside border
  44   lcdDrawSolidVerticalLine(left, y-width, width*2, TEXT_COLOR);
  45   lcdDrawSolidVerticalLine(right, y-width, width*2, TEXT_COLOR);
  46   lcdDrawSolidHorizontalLine(left, y-width, width*2+1, TEXT_COLOR);
  47   lcdDrawSolidHorizontalLine(left, y+width, width*2+1, TEXT_COLOR);
  48
  49   coord_t prev_yv = (coord_t)-1;
  50
  51   for (int xv=-width; xv<=width; xv+=1) {
  52     coord_t yv = y + getCurveYCoord(fn, xv, width);
  53     if (prev_yv != (coord_t)-1) {
  54       if (prev_yv < yv) {
  55         for (int y=prev_yv; y<=yv; y+=1) {
  56           lcdDrawBitmapPattern(x+xv-2, y-2, LBM_POINT, TEXT_COLOR);
  57         }
  58       }
  59       else {
  60         for (int y=yv; y<=prev_yv; y+=1) {
  61           lcdDrawBitmapPattern(x+xv-2, y-2, LBM_POINT, TEXT_COLOR);
  62         }
  63       }
  64     }
  65     prev_yv = yv;
  66   }
  67 }
  68
  69 void drawCurveVerticalScale(int x)
  70 {
  71   for (int i=0; i<=20; i++) {
  72     lcdDrawSolidHorizontalLine(x, CURVE_CENTER_Y-CURVE_SIDE_WIDTH+i*CURVE_SIDE_WIDTH/10, 10, TEXT_COLOR);
  73   }
  74 }
  75
  76 void drawCurveHorizontalScale()
  77 {
  78   for (int i=0; i<=20; i++) {
  79     lcdDrawSolidVerticalLine(CURVE_CENTER_X-CURVE_SIDE_WIDTH+i*CURVE_SIDE_WIDTH/10, CURVE_CENTER_Y+CURVE_SIDE_WIDTH+5, 10, TEXT_COLOR);
  80   }
  81 }
  82
  83 void drawCurveCoord(int x, int y, const char * text, bool active)
  84 {
  85   lcd->drawSolidFilledRect(x, y, CURVE_COORD_WIDTH, CURVE_COORD_HEIGHT, CURVE_CURSOR_COLOR);
  86   lcdDrawText(x+3+(CURVE_COORD_WIDTH-1-getTextWidth(text, SMLSIZE))/2, y+1, text, LEFT|SMLSIZE|TEXT_BGCOLOR);
  87   if (active) {
  88     lcdDrawBitmapPattern(x, y, LBM_CURVE_COORD_SHADOW, TEXT_COLOR);
  89   }
  90 }
  91
  92 void drawCurvePoint(int x, int y, LcdFlags color)
  93 {
  94   lcdDrawBitmapPattern(x, y, LBM_CURVE_POINT, color);
  95   lcdDrawBitmapPattern(x, y, LBM_CURVE_POINT_CENTER, TEXT_BGCOLOR);
  96 }