1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
|
/* Microcontroller graphic demo by Pascal Piazzalunga
* admin@serveurperso.com http://www.serveurperso.com
* https://www.youtube.com/watch?v=wyuJ-dqS2to
* Ported to stm32/ChibiOS/glx by Chris Baird.
* It's spinnin' bubbles, man.
* --
* Licencing? Ask Pascal. Let's assume it is freely-distributable and
* modifiable, provided his name is kept in the source.
* --
* Chris Baird,, <cjb@brushtail.apana.org.au> April 2013
*
* Modified Andrew Hannam (inmarket) 2013-04-29 New GFX calls
*/
#include <math.h>
#include "gfx.h"
/* ---------------------------------------------------------------------- */
#define N 1024 /* Number of dots */
#define SCALE 8192
#define INCREMENT 512 /* INCREMENT = SCALE / sqrt(N) * 2 */
#define PI2 6.283185307179586476925286766559
#define background RGB2COLOR(0,0,0)
uint16_t width, height;
int16_t sine[SCALE+(SCALE/4)];
int16_t *cosi = &sine[SCALE/4]; /* cos(x) = sin(x+90d)... */
void initialize (void)
{
uint16_t i;
/* if you change the SCALE*1.25 back to SCALE, the program will
* occassionally overrun the cosi array -- however this actually
* produces some interesting effects as the BUBBLES LOSE CONTROL!!!!
*/
for (i = 0; i < SCALE+(SCALE/4); i++)
//sine[i] = (-SCALE/2) + (int)(sinf(PI2 * i / SCALE) * sinf(PI2 * i / SCALE) * SCALE);
sine[i] = (int)(sinf(PI2 * i / SCALE) * SCALE);
}
void matrix (int16_t xyz[3][N], gColor col[N])
{
static uint32_t t = 0;
int16_t x = -SCALE, y = -SCALE;
uint16_t i, s, d;
uint8_t red,grn,blu;
#define RED_COLORS (32)
#define GREEN_COLORS (64)
#define BLUE_COLORS (32)
for (i = 0; i < N; i++)
{
xyz[0][i] = x;
xyz[1][i] = y;
d = sqrt(x * x + y * y); /* originally a fastsqrt() call */
s = sine[(t * 30) % SCALE] + SCALE;
xyz[2][i] = sine[(d + s) % SCALE] * sine[(t * 10) % SCALE] / SCALE / 2;
red = (cosi[xyz[2][i] + SCALE / 2] + SCALE) *
(RED_COLORS - 1) / SCALE / 2;
grn = (cosi[(xyz[2][i] + SCALE / 2 + 2 * SCALE / 3) % SCALE] + SCALE) *
(GREEN_COLORS - 1) / SCALE / 2;
blu = (cosi[(xyz[2][i] + SCALE / 2 + SCALE / 3) % SCALE] + SCALE) *
(BLUE_COLORS - 1) / SCALE / 2;
col[i] = ((red << 11) + (grn << 5) + blu);
x += INCREMENT;
if (x >= SCALE) x = -SCALE, y += INCREMENT;
}
t++;
}
void rotate (int16_t xyz[3][N], uint16_t angleX, uint16_t angleY, uint16_t angleZ)
{
uint16_t i;
int16_t tmpX, tmpY;
int16_t sinx = sine[angleX], cosx = cosi[angleX];
int16_t siny = sine[angleY], cosy = cosi[angleY];
int16_t sinz = sine[angleZ], cosz = cosi[angleZ];
for (i = 0; i < N; i++)
{
tmpX = (xyz[0][i] * cosx - xyz[2][i] * sinx) / SCALE;
xyz[2][i] = (xyz[0][i] * sinx + xyz[2][i] * cosx) / SCALE;
xyz[0][i] = tmpX;
tmpY = (xyz[1][i] * cosy - xyz[2][i] * siny) / SCALE;
xyz[2][i] = (xyz[1][i] * siny + xyz[2][i] * cosy) / SCALE;
xyz[1][i] = tmpY;
tmpX = (xyz[0][i] * cosz - xyz[1][i] * sinz) / SCALE;
xyz[1][i] = (xyz[0][i] * sinz + xyz[1][i] * cosz) / SCALE;
xyz[0][i] = tmpX;
}
}
void draw(int16_t xyz[3][N], gColor col[N])
{
static uint16_t oldProjX[N] = {0};
static uint16_t oldProjY[N] = {0};
static uint8_t oldDotSize[N] = {0};
uint16_t i, projX, projY, projZ, dotSize;
for (i = 0; i < N; i++)
{
projZ = SCALE - (xyz[2][i] + SCALE) / 4;
projX = width / 2 + (xyz[0][i] * projZ / SCALE) / 25;
projY = height / 2 + (xyz[1][i] * projZ / SCALE) / 25;
dotSize = 3 - (xyz[2][i] + SCALE) * 2 / SCALE;
gdispDrawCircle (oldProjX[i], oldProjY[i], oldDotSize[i], background);
if (projX > dotSize &&
projY > dotSize &&
projX < width - dotSize &&
projY < height - dotSize)
{
gdispDrawCircle (projX, projY, dotSize, col[i]);
oldProjX[i] = projX;
oldProjY[i] = projY;
oldDotSize[i] = dotSize;
}
}
}
/* ---------------------------------------------------------------------- */
int16_t angleX = 0, angleY = 0, angleZ = 0;
int16_t speedX = 0, speedY = 0, speedZ = 0;
int16_t xyz[3][N];
gColor col[N];
int main (void)
{
int pass = 0;
gfxInit();
gfxSleepMilliseconds (10);
gdispClear (background); /* glitches.. */
gfxSleepMilliseconds (10);
gdispClear (background); /* glitches.. */
gfxSleepMilliseconds (10);
gdispClear (background); /* glitches.. */
width = (uint16_t)gdispGetWidth();
height = (uint16_t)gdispGetHeight();
initialize();
for (;;)
{
matrix(xyz, col);
rotate(xyz, angleX, angleY, angleZ);
draw(xyz, col);
angleX += speedX;
angleY += speedY;
angleZ += speedZ;
if (pass > 400) speedY = 1;
if (pass > 800) speedX = 1;
if (pass > 1200) speedZ = 1;
pass++;
if (angleX >= SCALE) angleX -= SCALE;
else if (angleX < 0) angleX += SCALE;
if (angleY >= SCALE) angleY -= SCALE;
else if (angleY < 0) angleY += SCALE;
if (angleZ >= SCALE) angleZ -= SCALE;
else if (angleZ < 0) angleZ += SCALE;
}
}
/* ---------------------------------------------------------------------- */
|
