diff options
Diffstat (limited to '3rdparty/bubbles/main.c')
| -rw-r--r-- | 3rdparty/bubbles/main.c | 194 |
1 files changed, 194 insertions, 0 deletions
diff --git a/3rdparty/bubbles/main.c b/3rdparty/bubbles/main.c new file mode 100644 index 00000000..81c5dbe3 --- /dev/null +++ b/3rdparty/bubbles/main.c @@ -0,0 +1,194 @@ +/* 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 + */ + +#include <math.h> +#include "ch.h" +#include "hal.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], color_t 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 = sqrtf(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], color_t 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]; +color_t col[N]; + + +int main (void) +{ + int pass = 0; + + halInit(); + chSysInit(); + gdispInit(); + + chThdSleepMilliseconds (10); + gdispClear (background); /* glitches.. */ + chThdSleepMilliseconds (10); + gdispClear (background); /* glitches.. */ + chThdSleepMilliseconds (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; + } +} + +/* ---------------------------------------------------------------------- */ |