Subversion Repositories libOLED

Rev

Rev 15 | Rev 17 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * dials.c
  3.  *
  4.  *  Created on: 22 Jan 2016
  5.  *      Author: Mike
  6.  */
  7.  
  8. #include "libOLED/ap_math.H"
  9. #include "libOLED/displayclass.H"
  10. #include "libOLED/fontclass.H"
  11. #include "libOLED/displayDial.H"
  12. #include <string.h>
  13.  
  14. static ap_math math;
  15.  
  16. displayDial_t::displayDial_t(display_t &display, uint8_t x, uint8_t y, uint8_t siz, int16_t angle_low, int16_t angle_high) : m_display(display),
  17.                                                                                                                              m_xo(x), m_yo(y), m_siz(siz), m_angleLow(angle_low), m_angleRange(angle_high - angle_low), m_unitStr(nullptr)
  18. {
  19. }
  20.  
  21. displayDial_t::displayDial_t(display_t &display, uint8_t x, uint8_t y, uint8_t siz, uint16_t angle_) : m_display(display), m_xo(x), m_yo(y), m_siz(siz), m_angleLow(-angle_), m_angleRange(2 * angle_), m_unitStr(nullptr)
  22. {
  23. }
  24.  
  25. /* position is integer from 0 to SINE_STEPS */
  26. void displayDial_t::draw_needle(int16_t position)
  27. {
  28.   // int ang = math.SINE_SCALING * ((position - (math.SINE_STEPS / 2)) * m_a1) / (math.SINE_STEPS / 2);
  29.   int ang = (math.SINE_SCALING * position * m_angleRange) / math.SINE_STEPS + m_angleLow * math.SINE_SCALING;
  30.   int si = math.ap_sin(ang);
  31.   int co = math.ap_cos(ang);
  32.  
  33.   /* calculate an orthogonal XY shift for a second side of the needle */
  34.   int xl = math.ap_sin(ang - math.SINE_STEPS);
  35.   int yl = math.ap_cos(ang - math.SINE_STEPS);
  36.  
  37.   int si2 = m_siz + 2;
  38.   int si3 = 2 * m_siz / 3;
  39.  
  40.   int xs, ys;
  41.   // three parallel lines
  42.   xs = -xl;
  43.   ys = -yl;
  44.   int step;
  45.   for (step = 0; step < 3; step++)
  46.   {
  47.     m_display.drawLine(math.AP_SCALE(si * si2 - xs) + m_xo, m_yo - math.AP_SCALE(co * si2 - ys),
  48.                        math.AP_SCALE(si * si3 - xs) + m_xo, m_yo - math.AP_SCALE(co * si3 - ys), INVERT);
  49.     xs += xl;
  50.     ys += yl;
  51.   }
  52. }
  53.  
  54. void displayDial_t::draw_scale(int16_t low, int16_t high, uint8_t width, uint8_t num_step, int16_t scale)
  55. {
  56.  
  57.   int ang;
  58.   m_low = low;
  59.   m_high = high;
  60.   int sc_low = low / scale;
  61.   int sc_high = high / scale;
  62.   int step = 256 * m_angleRange / (4 * (sc_high - sc_low));
  63.   int t;
  64.   ang = m_angleLow * 256;
  65.   int d = sc_low < sc_high ? 1 : -1;
  66.   t = sc_low * 4;
  67.   while (1)
  68.   {
  69.     int si = math.ap_sin((ang * math.SINE_SCALING) / 256);
  70.     int co = math.ap_cos((ang * math.SINE_SCALING) / 256);
  71.  
  72.     int len;
  73.     switch (t % 4)
  74.     {
  75.     case 0:
  76.       len = width;
  77.       break;
  78.     case 1:
  79.     case 3:
  80.     case -1:
  81.     case -3:
  82.       len = width / 4;
  83.       break;
  84.     case 2:
  85.     case -2:
  86.       len = width / 2;
  87.       break;
  88.     }
  89.  
  90.     m_display.drawLine(math.AP_SCALE((m_siz)*si) + m_xo, m_yo - math.AP_SCALE((m_siz)*co),
  91.                        math.AP_SCALE((m_siz - len) * si) + m_xo,
  92.                        m_yo - math.AP_SCALE((m_siz - len) * co), WHITE);
  93.  
  94.     if (t == sc_high * 4)
  95.       break;
  96.  
  97.     ang += step;
  98.     t += d;
  99.   }
  100. }
  101.  
  102. void displayDial_t::draw_value_items(int val, int dpCode, int width, int x, int y)
  103. {
  104.  
  105.   m_display.gotoxy(x, y);
  106.   m_display.fontDigits(large_font, width, dpCode, val, WHITE);
  107.   m_display.gotoxy(x, y+16);
  108.   if (m_unitStr)
  109.   {
  110.     int l = strlen(m_unitStr);
  111.     if (l > 4)
  112.       l = 4;
  113.     m_display.printString(small_font, m_unitStr, l);
  114.     m_display.printString(small_font, "     ", 4 - l);
  115.   }
  116.   else
  117.   {
  118.     m_display.printString(small_font, "     ", 4);
  119.   }
  120. }
  121.  
  122. ////////////////////////////////////////////////////////////////////////////////
  123. displayFullDial_t::displayFullDial_t(display_t &display) : displayDial_t(display, 64, 60, 60, 90)
  124. {
  125. }
  126.  
  127. void displayFullDial_t::draw_limits()
  128. {
  129.   m_display.fontSigDigits(small_font, 0, 56, 0, 10, m_low, WHITE);
  130.   m_display.fontSigDigits(small_font, 120, 56, 1, 10, m_high, WHITE);
  131. }
  132.  
  133. void displayFullDial_t ::draw_value(int val, int dp)
  134. {
  135.   draw_value_items(val, dp, 4, 30, 32);
  136. }
  137.  
  138. ////////////////////////////////////////////////////////////////////////////////
  139. displayLeftQuadrantDial_t::displayLeftQuadrantDial_t(display_t &display) : displayDial_t(display, 0, 60, 60, 90, 0){};
  140.  
  141. void displayLeftQuadrantDial_t::draw_limits()
  142. {
  143.   m_display.fontSigDigits(small_font, 0, 10, false, display_t::NO_DECIMAL, m_high, WHITE);
  144.   m_display.fontSigDigits(small_font, 56, 56, true, display_t::NO_DECIMAL, m_low, WHITE);
  145. }
  146.  
  147. void displayLeftQuadrantDial_t ::draw_value(int val, int dp)
  148. {
  149.   draw_value_items(val, dp, 3, 0, 32);
  150. }
  151.  
  152. ////////////////////////////////////////////////////////////////////////////////
  153. displayRightQuadrantDial_t::displayRightQuadrantDial_t(display_t &display) : displayDial_t(display, 127, 60, 60, -90, 0){};
  154.  
  155. void displayRightQuadrantDial_t::draw_limits()
  156. {
  157.   m_display.fontSigDigits(small_font, 128, 10, true, display_t::NO_DECIMAL, m_high, WHITE);
  158.   m_display.fontSigDigits(small_font, 128 - 56, 56, false, display_t::NO_DECIMAL, m_low, WHITE);
  159. }
  160.  
  161. void displayRightQuadrantDial_t::draw_value(int val, int dp)
  162. {
  163.   draw_value_items(val, dp, 3, 90, 32);
  164. }
  165.