Subversion Repositories DashDisplay

Rev

Rev 5 | Rev 7 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 5 Rev 6
Line 7... Line 7...
7
#include "stm32f1xx_hal.h"
7
#include "stm32f1xx_hal.h"
8
#include "ap_math.h"
8
#include "ap_math.h"
9
#include "font.h"
9
#include "font.h"
10
#include "SSD1306.h"
10
#include "SSD1306.h"
11
 
11
 
12
static uint16_t  a1 = 120;
12
static uint16_t a1 = 90;
13
static uint8_t  xo=64;
13
static uint8_t xo = 64;
14
static uint8_t  yo=64;
14
static uint8_t yo = 64;
15
static uint8_t siz=32;
15
static uint8_t siz = 32;
16
 
-
 
17
 
-
 
18
 
16
 
19
/* percent is integer from 0 to 100 */
17
/* percent is integer from 0 to 100 */
-
 
18
void
20
void dial_draw_needle(uint16_t percent)
19
dial_draw_needle (uint16_t percent)
21
{
20
{
22
  int ang  = ((percent - 50)* a1) / 50 ;
21
  int ang = ((percent - 50) * a1) / 50;
23
 
22
 
24
  int si = ap_sin(ang);
23
  int si = ap_sin (ang);
25
  int co = ap_cos(ang);
24
  int co = ap_cos (ang);
26
 
25
 
27
  /* calculate a shift for a second side of the needle */
26
  /* calculate a shift for a second side of the needle */
28
  int xs = ap_sin(ang-90);
27
  int xs = ap_sin (ang - 90);
29
  int ys = ap_cos(ang-90);
28
  int ys = ap_cos (ang - 90);
30
 
-
 
31
  int si2 = siz+2;
-
 
32
  int si3 = siz/2;
-
 
33
 
29
 
-
 
30
  int si2 = siz + 2;
-
 
31
  int si3 = siz / 2;
34
 
32
 
35
  drawLine(AP_SCALE(si*si2-xs)+xo,yo-AP_SCALE(co*si2-ys),
33
  drawLine (AP_SCALE(si*si2-xs) + xo, yo - AP_SCALE(co * si2 - ys),
36
 
34
 
-
 
35
  AP_SCALE(si*si3-xs) + xo,
37
                   AP_SCALE(si*si3-xs)+xo,yo-AP_SCALE(co*si3-ys), INVERT);
36
            yo - AP_SCALE(co * si3 - ys), INVERT);
38
  drawLine(AP_SCALE(si*si2+xs)+xo,yo-AP_SCALE(co*si2+ys),
37
  drawLine (AP_SCALE(si*si2+xs) + xo, yo - AP_SCALE(co * si2 + ys),
39
 
38
 
-
 
39
  AP_SCALE(si*si3+xs) + xo,
40
                   AP_SCALE(si*si3+xs)+xo,yo-AP_SCALE(co*si3+ys), INVERT);
40
            yo - AP_SCALE(co * si3 + ys), INVERT);
41
 
41
 
42
}
42
}
43
 
43
 
44
 
-
 
45
 
-
 
46
/* initialise */
44
/* initialise */
-
 
45
void
47
void dial_size(uint8_t size)
46
dial_size (uint8_t size)
48
{
47
{
49
        siz=size;
48
  siz = size;
50
}
49
}
51
 
50
 
-
 
51
void
52
void dial_draw_scale(uint8_t low, uint8_t high,uint8_t width, uint8_t num_step)
52
dial_draw_scale (uint8_t low, uint8_t high, uint8_t width, uint8_t num_step)
53
{
53
{
54
        int sz;
54
  int sz;
55
        int ang;
55
  int ang;
56
        int step = a1*2 / (4 * (high-low));
56
  int step = 256 * a1 * 2 / (4 * (high - low));
57
        int t;
57
  int t;
58
        ang = -a1;
58
  ang = -a1 * 256;
59
        for(t=low*4; t <= high* 4 ; t++)
59
  for (t = low * 4; t <= high * 4; t++)
60
        {
60
    {
61
                int si = ap_sin(ang);
61
      int si = ap_sin (ang / 256);
62
                int co = ap_cos(ang);
62
      int co = ap_cos (ang / 256);
63
 
-
 
64
                int len;
-
 
65
                switch(t % 4)
-
 
66
                {
-
 
67
                case 0:
-
 
68
                        {
-
 
69
                                uint8_t v = t/4;
-
 
70
//                              if((v % num_step) ==  0)
-
 
71
//                              {
-
 
72
//                                 char buff[2];
-
 
73
//                                 char * p = buff+1;
-
 
74
//                                 int d = 1;
-
 
75
//                                 buff[1] = v %10 + '0';
-
 
76
//                                 if(v>=10)
-
 
77
//                                 {
-
 
78
//                                         p = buff;
-
 
79
//                                         d= 2;
-
 
80
//                                         buff[0] = v/10 + '0';
-
 
81
//                                 }
-
 
82
//
-
 
83
//                                 print_large_string(p,AP_SCALE((siz-width/2-3)*si)+xo - d *4,
-
 
84
//                                                 yo - AP_SCALE((siz - width / 2 ) * co), d);
-
 
85
//
-
 
86
//                              }
-
 
87
                        len=2;
-
 
88
                        }
-
 
89
                        break;
-
 
90
                        case 1:
-
 
91
                        case 3:
-
 
92
                                len = width/4;
-
 
93
                                break;
-
 
94
                        case 2:
-
 
95
                                len = width/2;
-
 
96
                                break;
-
 
97
                        }
-
 
98
 
-
 
99
 
-
 
100
                        drawLine(AP_SCALE((siz)*si) + xo, yo - AP_SCALE((siz)*co),
-
 
101
                                         AP_SCALE((siz-len)*si) +xo, yo - AP_SCALE((siz-len)*co), 1);
-
 
102
                        ang += step;
-
 
103
                }
-
 
104
 
-
 
105
 
63
 
-
 
64
      int len;
-
 
65
      switch (t % 4)
-
 
66
        {
-
 
67
        case 0:
-
 
68
          len = width;
-
 
69
          break;
-
 
70
        case 1:
-
 
71
        case 3:
-
 
72
          len = width / 4;
-
 
73
          break;
-
 
74
        case 2:
-
 
75
          len = width / 2;
-
 
76
          break;
106
        }
77
        }
107
 
78
 
-
 
79
      drawLine (AP_SCALE((siz)*si) + xo, yo - AP_SCALE((siz) * co),
-
 
80
      AP_SCALE((siz-len)*si) + xo,
-
 
81
                yo - AP_SCALE((siz - len) * co), 1);
-
 
82
      ang += step;
-
 
83
    }
-
 
84
 
-
 
85
  font_gotoxy (0, 7);
-
 
86
  int d = low / 10;
-
 
87
  if (d)
-
 
88
    {
-
 
89
      font_putchar (d + '0');
-
 
90
    }
-
 
91
  else
-
 
92
    {
-
 
93
      font_putchar (' ');
-
 
94
    }
-
 
95
  d = low % 10;
-
 
96
  font_putchar (d + '0');
-
 
97
 
-
 
98
  font_gotoxy (19, 7);
-
 
99
  d = high / 10;
-
 
100
  if (d)
-
 
101
    {
-
 
102
      font_putchar (d + '0');
-
 
103
    }
-
 
104
  else
-
 
105
    {
-
 
106
      font_putchar (' ');
-
 
107
    }
-
 
108
  d = high % 10;
-
 
109
  font_putchar (d + '0');
108
 
110
 
-
 
111
}
109
 
112
 
-
 
113
void
110
void dial_origin(uint8_t x, uint8_t y)
114
dial_origin (uint8_t x, uint8_t y)
111
{
115
{
-
 
116
  xo = x;
112
        xo=x; yo=y;
117
  yo = y;
113
}
118
}