1
/**
2
 * @file lv_math.c
3
 *
4
 */
5

6
/*********************
7
 *      INCLUDES
8
 *********************/
9
#include "lv_math.h"
10
#include <stdbool.h>
11

12
/*********************
13
 *      DEFINES
14
 *********************/
15

16
/**********************
17
 *      TYPEDEFS
18
 **********************/
19

20
/**********************
21
 *  STATIC PROTOTYPES
22
 **********************/
23

24
/**********************
25
 *  STATIC VARIABLES
26
 **********************/
27
static int16_t sin0_90_table[] = {
28
    0,     572,    1144,   1715,   2286,   2856,   3425,   3993,   4560,   5126,
29
    5690,  6252,   6813,   7371,   7927,   8481,   9032,   9580,   10126,  10668,
30
    11207, 11743,  12275,  12803,  13328,  13848,  14364,  14876,  15383,  15886,
31
    16383, 16876,  17364,  17846,  18323,  18794,  19260,  19720,  20173,  20621,
32
    21062, 21497,  21925,  22347,  22762,  23170,  23571,  23964,  24351,  24730,
33
    25101, 25465,  25821,  26169,  26509,  26841,  27165,  27481,  27788,  28087,
34
    28377, 28659,  28932,  29196,  29451,  29697,  29934,  30162,  30381,  30591,
35
    30791, 30982,  31163,  31335,  31498,  31650,  31794,  31927,  32051,  32165,
36
    32269, 32364,  32448,  32523,  32587,  32642,  32687,  32722,  32747,  32762,
37
	32767
38
};
39

40

41
/**********************
42
 *      MACROS
43
 **********************/
44

45
/**********************
46
 *   GLOBAL FUNCTIONS
47
 **********************/
48

49
/**
50
 * Convert a number to string
51
 * @param num a number
52
 * @param buf pointer to a `char` buffer. The result will be stored here (max 10 elements)
53
 * @return same as `buf` (just for convenience)
54
 */
55
char * lv_math_num_to_str(int32_t num, char * buf)
56
{
57
    char * buf_ori = buf;
58
    if(num == 0) {
59
        buf[0] = '0';
60
        buf[1] = '\0';
61
        return buf;
62
    } else if(num < 0) {
63
        (*buf) = '-';
64
        buf++;
65
        num = LV_MATH_ABS(num);
66
    }
67
    uint32_t output = 0;
68
    int8_t i;
69

70
    for(i = 31; i >= 0; i--) {
71
        if((output & 0xF) >= 5)
72
            output += 3;
73
        if(((output & 0xF0) >> 4) >= 5)
74
            output += (3 << 4);
75
        if(((output & 0xF00) >> 8) >= 5)
76
            output += (3 << 8);
77
        if(((output & 0xF000) >> 12) >= 5)
78
            output += (3 << 12);
79
        if(((output & 0xF0000) >> 16) >= 5)
80
            output += (3 << 16);
81
        if(((output & 0xF00000) >> 20) >= 5)
82
            output += (3 << 20);
83
        if(((output & 0xF000000) >> 24) >= 5)
84
            output += (3 << 24);
85
        if(((output & 0xF0000000) >> 28) >= 5)
86
            output += (3 << 28);
87
        output = (output << 1) | ((num >> i) & 1);
88
    }
89

90
    uint8_t digit;
91
    bool leading_zero_ready = false;
92
    for(i = 28; i >= 0; i -= 4) {
93
        digit = ((output >> i) & 0xF) + '0';
94
        if(digit == '0' && leading_zero_ready == false) continue;
95

96
        leading_zero_ready = true;
97
        (*buf) = digit;
98
        buf++;
99
    }
100

101
    (*buf) = '\0';
102

103
    return buf_ori;
104
}
105

106
/**
107
 * Return with sinus of an angle
108
 * @param angle
109
 * @return sinus of 'angle'. sin(-90) = -32767, sin(90) = 32767
110
 */
111
int16_t lv_trigo_sin(int16_t angle)
112
{
113
    int16_t ret = 0;
114
    angle = angle % 360;
115

116
    if(angle < 0) angle = 360 + angle;
117

118
    if(angle < 90) {
119
        ret = sin0_90_table[angle];
120
    } else if(angle >= 90 && angle < 180) {
121
        angle = 180 - angle;
122
        ret = sin0_90_table[angle];
123
    } else if(angle >= 180 && angle < 270) {
124
        angle = angle - 180;
125
        ret = - sin0_90_table[angle];
126
    } else { /*angle >=270*/
127
        angle = 360 - angle;
128
        ret = - sin0_90_table[angle];
129
    }
130

131
    return ret;
132
}
133

134
/**
135
 * Calculate a value of a Cubic Bezier function.
136
 * @param t time in range of [0..LV_BEZIER_VAL_MAX]
137
 * @param u0 start values in range of [0..LV_BEZIER_VAL_MAX]
138
 * @param u1 control value 1 values in range of [0..LV_BEZIER_VAL_MAX]
139
 * @param u2 control value 2 in range of [0..LV_BEZIER_VAL_MAX]
140
 * @param u3 end values in range of [0..LV_BEZIER_VAL_MAX]
141
 * @return the value calculated from the given parameters in range of [0..LV_BEZIER_VAL_MAX]
142
 */
143
int32_t lv_bezier3(uint32_t t, int32_t u0, int32_t u1, int32_t u2, int32_t u3)
144
{
145
    uint32_t t_rem = 1024 - t;
146
    uint32_t t_rem2 = (t_rem * t_rem) >> 10;
147
    uint32_t t_rem3 = (t_rem2 * t_rem) >> 10;
148
    uint32_t t2 = (t * t) >> 10;
149
    uint32_t t3 = (t2 * t) >> 10;
150

151

152
    uint32_t v1 = ((uint32_t)t_rem3 * u0) >> 10;
153
    uint32_t v2 = ((uint32_t)3 * t_rem2 * t * u1) >> 20;
154
    uint32_t v3 = ((uint32_t)3 * t_rem * t2 * u2) >> 20;
155
    uint32_t v4 = ((uint32_t)t3 * u3) >> 10;
156

157
    return v1 + v2 + v3 + v4;
158

159
}
160

161
/**********************
162
 *   STATIC FUNCTIONS
163
 **********************/
164

165

166

167