apps/plugins/cube.c

   1 /***************************************************************************
   2 *             __________               __   ___.
   3 *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4 *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5 *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6 *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7 *                     \/            \/     \/    \/            \/
   8 * $Id$
   9 *
  10 * Copyright (C) 2002 Damien Teney
  11 * modified to use int instead of float math by Andreas Zwirtes
  12 * heavily extended by Jens Arnold
  13 *
  14 * This program is free software; you can redistribute it and/or
  15 * modify it under the terms of the GNU General Public License
  16 * as published by the Free Software Foundation; either version 2
  17 * of the License, or (at your option) any later version.
  18 *
  19 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  20 * KIND, either express or implied.
  21 *
  22 ***************************************************************************/
  23 #include "plugin.h"
  24 #include "lib/grey.h"
  25 #include "lib/playergfx.h"
  26 #include "lib/xlcd.h"
  27 #include "lib/fixedpoint.h"
  28
  29 PLUGIN_HEADER
  30
  31 /* Loops that the values are displayed */
  32 #define DISP_TIME 30
  33
  34 /* variable button definitions */
  35 #if CONFIG_KEYPAD == RECORDER_PAD
  36 #define CUBE_QUIT          BUTTON_OFF
  37 #define CUBE_NEXT          BUTTON_RIGHT
  38 #define CUBE_PREV          BUTTON_LEFT
  39 #define CUBE_INC           BUTTON_UP
  40 #define CUBE_DEC           BUTTON_DOWN
  41 #define CUBE_MODE          BUTTON_F1
  42 #define CUBE_PAUSE         BUTTON_PLAY
  43 #define CUBE_HIGHSPEED     BUTTON_ON
  44
  45 #elif CONFIG_KEYPAD == ARCHOS_AV300_PAD
  46 #define CUBE_QUIT          BUTTON_OFF
  47 #define CUBE_NEXT          BUTTON_RIGHT
  48 #define CUBE_PREV          BUTTON_LEFT
  49 #define CUBE_INC           BUTTON_UP
  50 #define CUBE_DEC           BUTTON_DOWN
  51 #define CUBE_MODE          BUTTON_F1
  52 #define CUBE_PAUSE         BUTTON_SELECT
  53 #define CUBE_HIGHSPEED     BUTTON_ON
  54
  55 #elif CONFIG_KEYPAD == PLAYER_PAD
  56 #define CUBE_QUIT          BUTTON_STOP
  57 #define CUBE_INC           BUTTON_RIGHT
  58 #define CUBE_DEC           BUTTON_LEFT
  59 #define CUBE_NEXT          (BUTTON_ON | BUTTON_RIGHT)
  60 #define CUBE_PREV          (BUTTON_ON | BUTTON_LEFT)
  61 #define CUBE_MODE          BUTTON_MENU
  62 #define CUBE_PAUSE         BUTTON_PLAY
  63 #define CUBE_HIGHSPEED_PRE BUTTON_ON
  64 #define CUBE_HIGHSPEED     (BUTTON_ON | BUTTON_REL)
  65
  66 #elif CONFIG_KEYPAD == ONDIO_PAD
  67 #define CUBE_QUIT          BUTTON_OFF
  68 #define CUBE_NEXT          BUTTON_RIGHT
  69 #define CUBE_PREV          BUTTON_LEFT
  70 #define CUBE_INC           BUTTON_UP
  71 #define CUBE_DEC           BUTTON_DOWN
  72 #define CUBE_MODE_PRE      BUTTON_MENU
  73 #define CUBE_MODE          (BUTTON_MENU | BUTTON_REL)
  74 #define CUBE_PAUSE         (BUTTON_MENU | BUTTON_LEFT)
  75 #define CUBE_HIGHSPEED     (BUTTON_MENU | BUTTON_RIGHT)
  76
  77 #elif (CONFIG_KEYPAD == IRIVER_H100_PAD) || \
  78       (CONFIG_KEYPAD == IRIVER_H300_PAD)
  79 #define CUBE_QUIT          BUTTON_OFF
  80 #define CUBE_NEXT          BUTTON_RIGHT
  81 #define CUBE_PREV          BUTTON_LEFT
  82 #define CUBE_INC           BUTTON_UP
  83 #define CUBE_DEC           BUTTON_DOWN
  84 #define CUBE_MODE          BUTTON_MODE
  85 #define CUBE_PAUSE         BUTTON_ON
  86 #define CUBE_HIGHSPEED     BUTTON_SELECT
  87
  88 #define CUBE_RC_QUIT       BUTTON_RC_STOP
  89
  90 #elif (CONFIG_KEYPAD == IPOD_4G_PAD) || \
  91       (CONFIG_KEYPAD == IPOD_3G_PAD) || \
  92       (CONFIG_KEYPAD == IPOD_1G2G_PAD)
  93 #define CUBE_QUIT          (BUTTON_SELECT | BUTTON_MENU)
  94 #define CUBE_NEXT          BUTTON_RIGHT
  95 #define CUBE_PREV          BUTTON_LEFT
  96 #define CUBE_INC           BUTTON_SCROLL_FWD
  97 #define CUBE_DEC           BUTTON_SCROLL_BACK
  98 #define CUBE_MODE          BUTTON_MENU
  99 #define CUBE_PAUSE         BUTTON_PLAY
 100 #define CUBE_HIGHSPEED_PRE BUTTON_SELECT
 101 #define CUBE_HIGHSPEED     (BUTTON_SELECT | BUTTON_REL)
 102
 103 #elif CONFIG_KEYPAD == IRIVER_IFP7XX_PAD
 104 #define CUBE_QUIT          BUTTON_PLAY
 105 #define CUBE_NEXT          BUTTON_RIGHT
 106 #define CUBE_PREV          BUTTON_LEFT
 107 #define CUBE_INC           BUTTON_UP
 108 #define CUBE_DEC           BUTTON_DOWN
 109 #define CUBE_MODE          BUTTON_MODE
 110 #define CUBE_PAUSE         BUTTON_SELECT
 111 #define CUBE_HIGHSPEED     BUTTON_EQ
 112
 113 #elif (CONFIG_KEYPAD == IAUDIO_X5M5_PAD)
 114 #define CUBE_QUIT          BUTTON_POWER
 115 #define CUBE_NEXT          BUTTON_RIGHT
 116 #define CUBE_PREV          BUTTON_LEFT
 117 #define CUBE_INC           BUTTON_UP
 118 #define CUBE_DEC           BUTTON_DOWN
 119 #define CUBE_MODE          BUTTON_REC
 120 #define CUBE_PAUSE         BUTTON_PLAY
 121 #define CUBE_HIGHSPEED     BUTTON_SELECT
 122
 123 #elif (CONFIG_KEYPAD == GIGABEAT_PAD)
 124 #define CUBE_QUIT          BUTTON_POWER
 125 #define CUBE_NEXT          BUTTON_RIGHT
 126 #define CUBE_PREV          BUTTON_LEFT
 127 #define CUBE_INC           BUTTON_UP
 128 #define CUBE_DEC           BUTTON_DOWN
 129 #define CUBE_MODE          BUTTON_MENU
 130 #define CUBE_PAUSE         BUTTON_SELECT
 131 #define CUBE_HIGHSPEED     BUTTON_A
 132
 133 #elif (CONFIG_KEYPAD == SANSA_E200_PAD)
 134 #define CUBE_QUIT          BUTTON_POWER
 135 #define CUBE_NEXT          BUTTON_RIGHT
 136 #define CUBE_PREV          BUTTON_LEFT
 137 #define CUBE_INC           BUTTON_SCROLL_FWD
 138 #define CUBE_DEC           BUTTON_SCROLL_BACK
 139 #define CUBE_MODE          BUTTON_DOWN
 140 #define CUBE_PAUSE         BUTTON_UP
 141 #define CUBE_HIGHSPEED     BUTTON_SELECT
 142
 143 #elif (CONFIG_KEYPAD == SANSA_FUZE_PAD)
 144 #define CUBE_QUIT          (BUTTON_HOME|BUTTON_REPEAT)
 145 #define CUBE_NEXT          BUTTON_RIGHT
 146 #define CUBE_PREV          BUTTON_LEFT
 147 #define CUBE_INC           BUTTON_SCROLL_FWD
 148 #define CUBE_DEC           BUTTON_SCROLL_BACK
 149 #define CUBE_MODE          BUTTON_DOWN
 150 #define CUBE_PAUSE         BUTTON_UP
 151 #define CUBE_HIGHSPEED     BUTTON_SELECT
 152
 153 #elif (CONFIG_KEYPAD == SANSA_C200_PAD) || \
 154 (CONFIG_KEYPAD == SANSA_CLIP_PAD) || \
 155 (CONFIG_KEYPAD == SANSA_M200_PAD)
 156 #define CUBE_QUIT          BUTTON_POWER
 157 #define CUBE_NEXT          BUTTON_RIGHT
 158 #define CUBE_PREV          BUTTON_LEFT
 159 #define CUBE_INC           BUTTON_VOL_UP
 160 #define CUBE_DEC           BUTTON_VOL_DOWN
 161 #define CUBE_MODE          BUTTON_DOWN
 162 #define CUBE_PAUSE         BUTTON_UP
 163 #define CUBE_HIGHSPEED     BUTTON_SELECT
 164
 165
 166 #elif (CONFIG_KEYPAD == IRIVER_H10_PAD)
 167 #define CUBE_QUIT          BUTTON_POWER
 168 #define CUBE_NEXT          BUTTON_RIGHT
 169 #define CUBE_PREV          BUTTON_LEFT
 170 #define CUBE_INC           BUTTON_SCROLL_UP
 171 #define CUBE_DEC           BUTTON_SCROLL_DOWN
 172 #define CUBE_MODE          BUTTON_REW
 173 #define CUBE_PAUSE         BUTTON_PLAY
 174 #define CUBE_HIGHSPEED     BUTTON_FF
 175
 176 #elif CONFIG_KEYPAD == MROBE500_PAD
 177 #define CUBE_QUIT          BUTTON_POWER
 178
 179 #elif CONFIG_KEYPAD == GIGABEAT_S_PAD
 180 #define CUBE_QUIT          BUTTON_BACK
 181 #define CUBE_NEXT          BUTTON_RIGHT
 182 #define CUBE_PREV          BUTTON_LEFT
 183 #define CUBE_INC           BUTTON_UP
 184 #define CUBE_DEC           BUTTON_DOWN
 185 #define CUBE_MODE          BUTTON_MENU
 186 #define CUBE_PAUSE         BUTTON_PLAY
 187 #define CUBE_HIGHSPEED     BUTTON_SELECT
 188
 189 #elif (CONFIG_KEYPAD == MROBE100_PAD)
 190 #define CUBE_QUIT          BUTTON_POWER
 191 #define CUBE_NEXT          BUTTON_RIGHT
 192 #define CUBE_PREV          BUTTON_LEFT
 193 #define CUBE_INC           BUTTON_UP
 194 #define CUBE_DEC           BUTTON_DOWN
 195 #define CUBE_MODE          BUTTON_MENU
 196 #define CUBE_PAUSE         BUTTON_PLAY
 197 #define CUBE_HIGHSPEED     BUTTON_SELECT
 198
 199 #elif (CONFIG_KEYPAD == IAUDIO_M3_PAD)
 200 #define CUBE_QUIT          BUTTON_RC_REC
 201 #define CUBE_NEXT          BUTTON_RC_FF
 202 #define CUBE_PREV          BUTTON_RC_REW
 203 #define CUBE_INC           BUTTON_RC_VOL_UP
 204 #define CUBE_DEC           BUTTON_RC_VOL_DOWN
 205 #define CUBE_MODE          BUTTON_RC_MODE
 206 #define CUBE_PAUSE         BUTTON_RC_PLAY
 207 #define CUBE_HIGHSPEED     BUTTON_RC_MENU
 208
 209 #elif CONFIG_KEYPAD == COWON_D2_PAD
 210 #define CUBE_QUIT          BUTTON_POWER
 211
 212 #elif (CONFIG_KEYPAD == IAUDIO67_PAD)
 213 #define CUBE_QUIT          BUTTON_POWER
 214 #define CUBE_NEXT          BUTTON_RIGHT
 215 #define CUBE_PREV          BUTTON_LEFT
 216 #define CUBE_INC           BUTTON_VOLUP
 217 #define CUBE_DEC           BUTTON_VOLDOWN
 218 #define CUBE_MODE          BUTTON_MENU
 219 #define CUBE_PAUSE         BUTTON_PLAY
 220 #define CUBE_HIGHSPEED     BUTTON_STOP
 221
 222 #elif CONFIG_KEYPAD == CREATIVEZVM_PAD
 223 #define CUBE_QUIT          BUTTON_BACK
 224 #define CUBE_NEXT          BUTTON_RIGHT
 225 #define CUBE_PREV          BUTTON_LEFT
 226 #define CUBE_INC           BUTTON_UP
 227 #define CUBE_DEC           BUTTON_DOWN
 228 #define CUBE_MODE          BUTTON_MENU
 229 #define CUBE_PAUSE         BUTTON_PLAY
 230 #define CUBE_HIGHSPEED     BUTTON_SELECT
 231
 232 #elif CONFIG_KEYPAD == PHILIPS_HDD1630_PAD
 233 #define CUBE_QUIT          BUTTON_POWER
 234 #define CUBE_NEXT          BUTTON_RIGHT
 235 #define CUBE_PREV          BUTTON_LEFT
 236 #define CUBE_INC           BUTTON_UP
 237 #define CUBE_DEC           BUTTON_DOWN
 238 #define CUBE_MODE          BUTTON_MENU
 239 #define CUBE_PAUSE         BUTTON_SELECT
 240 #define CUBE_HIGHSPEED     BUTTON_VIEW
 241
 242 #elif CONFIG_KEYPAD == PHILIPS_SA9200_PAD
 243 #define CUBE_QUIT          BUTTON_POWER
 244 #define CUBE_NEXT          BUTTON_NEXT
 245 #define CUBE_PREV          BUTTON_PREV
 246 #define CUBE_INC           BUTTON_UP
 247 #define CUBE_DEC           BUTTON_DOWN
 248 #define CUBE_MODE          BUTTON_MENU
 249 #define CUBE_PAUSE         BUTTON_PLAY
 250 #define CUBE_HIGHSPEED     BUTTON_RIGHT
 251
 252 #elif CONFIG_KEYPAD == ONDAVX747_PAD
 253 #define CUBE_QUIT          BUTTON_POWER
 254 #elif CONFIG_KEYPAD == ONDAVX777_PAD
 255 #define CUBE_QUIT          BUTTON_POWER
 256
 257 #elif CONFIG_KEYPAD == SAMSUNG_YH_PAD
 258 #define CUBE_QUIT          BUTTON_REC
 259 #define CUBE_NEXT          BUTTON_RIGHT
 260 #define CUBE_PREV          BUTTON_LEFT
 261 #define CUBE_INC           BUTTON_UP
 262 #define CUBE_DEC           BUTTON_DOWN
 263 #define CUBE_MODE          BUTTON_REW
 264 #define CUBE_PAUSE         BUTTON_PLAY
 265 #define CUBE_HIGHSPEED     BUTTON_FFWD
 266
 267 #elif CONFIG_KEYPAD == PBELL_VIBE500_PAD
 268 #define CUBE_QUIT          BUTTON_REC
 269 #define CUBE_NEXT          BUTTON_NEXT
 270 #define CUBE_PREV          BUTTON_PREV
 271 #define CUBE_INC           BUTTON_UP
 272 #define CUBE_DEC           BUTTON_DOWN
 273 #define CUBE_MODE          BUTTON_MENU
 274 #define CUBE_PAUSE         BUTTON_PLAY
 275 #define CUBE_HIGHSPEED     BUTTON_OK
 276
 277 #elif CONFIG_KEYPAD == MPIO_HD200_PAD
 278 #define CUBE_QUIT          (BUTTON_REC | BUTTON_PLAY)
 279 #define CUBE_NEXT          BUTTON_NEXT
 280 #define CUBE_PREV          BUTTON_PREV
 281 #define CUBE_INC           BUTTON_VOL_UP
 282 #define CUBE_DEC           BUTTON_VOL_DOWN
 283 #define CUBE_MODE          BUTTON_REC
 284 #define CUBE_PAUSE         BUTTON_PLAY
 285 #define CUBE_HIGHSPEED     BUTTON_SELECT
 286
 287 #else
 288 #error No keymap defined!
 289 #endif
 290
 291 #ifdef HAVE_TOUCHSCREEN
 292 #ifndef CUBE_QUIT
 293 #define CUBE_QUIT          BUTTON_TOPLEFT
 294 #endif
 295 #ifndef CUBE_NEXT
 296 #define CUBE_NEXT          BUTTON_MIDRIGHT
 297 #endif
 298 #ifndef CUBE_PREV
 299 #define CUBE_PREV          BUTTON_MIDLEFT
 300 #endif
 301 #ifndef CUBE_INC
 302 #define CUBE_INC           BUTTON_TOPMIDDLE
 303 #endif
 304 #ifndef CUBE_DEC
 305 #define CUBE_DEC           BUTTON_BOTTOMMIDDLE
 306 #endif
 307 #ifndef CUBE_MODE
 308 #define CUBE_MODE          BUTTON_TOPRIGHT
 309 #endif
 310 #ifndef CUBE_PAUSE
 311 #define CUBE_PAUSE         BUTTON_CENTER
 312 #endif
 313 #ifndef CUBE_HIGHSPEED
 314 #define CUBE_HIGHSPEED     BUTTON_BOTTOMRIGHT
 315 #endif
 316 #endif
 317
 318
 319 #ifdef HAVE_LCD_BITMAP
 320
 321 #define DIST (10 * MIN(LCD_HEIGHT, LCD_WIDTH) / 16)
 322 static int x_off = LCD_WIDTH/2;
 323 static int y_off = LCD_HEIGHT/2;
 324
 325 #if LCD_DEPTH == 1
 326 #define USEGSLIB
 327 GREY_INFO_STRUCT
 328 struct my_lcd {
 329     void (*update)(void);
 330     void (*clear_display)(void);
 331     void (*drawline)(int x1, int y1, int x2, int y2);
 332     void (*putsxy)(int x, int y, const unsigned char *string);
 333 };
 334
 335 static struct my_lcd greyfuncs = {
 336     grey_update, grey_clear_display, grey_drawline, grey_putsxy
 337 };
 338 static struct my_lcd lcdfuncs; /* initialised at runtime */
 339 static struct my_lcd *mylcd = &greyfuncs;
 340
 341 #define MYLCD(fn) mylcd->fn
 342 #define MY_FILLTRIANGLE(x1, y1, x2, y2, x3, y3) grey_filltriangle(x1, y1, x2, y2, x3, y3)
 343 #define MY_SET_FOREGROUND(fg) grey_set_foreground(fg)
 344 #define MY_GET_FOREGROUND() grey_get_foreground()
 345
 346 #else
 347 #define MYLCD(fn) rb->lcd_ ## fn
 348 #define MY_FILLTRIANGLE(x1, y1, x2, y2, x3, y3) xlcd_filltriangle(x1, y1, x2, y2, x3, y3)
 349 #define MY_SET_FOREGROUND(fg) rb->lcd_set_foreground(fg)
 350 #define MY_GET_FOREGROUND() rb->lcd_get_foreground()
 351 #endif
 352
 353 #if CONFIG_LCD == LCD_SSD1815
 354 #define ASPECT 320 /* = 1.25 (fixed point 24.8) */
 355 #else
 356 #define ASPECT 256 /* = 1.00 */
 357 #endif
 358
 359 #else /* !LCD_BITMAP */
 360
 361 #define MYLCD(fn) pgfx_ ## fn
 362 #define DIST 9
 363 static int x_off = 10;
 364 static int y_off = 7;
 365 #define ASPECT 300 /* = 1.175 */
 366
 367 #endif /* !LCD_BITMAP */
 368
 369 struct point_3D {
 370     long x, y, z;
 371 };
 372
 373 struct point_2D {
 374     long x, y;
 375 };
 376
 377 struct line {
 378     int start, end;
 379 };
 380
 381 struct face {
 382     int corner[4];
 383     int line[4];
 384 };
 385
 386 /* initial, unrotated cube corners */
 387 static const struct point_3D sommet[8] =
 388 {
 389     {-DIST, -DIST, -DIST},
 390     { DIST, -DIST, -DIST},
 391     { DIST,  DIST, -DIST},
 392     {-DIST,  DIST, -DIST},
 393     {-DIST, -DIST,  DIST},
 394     { DIST, -DIST,  DIST},
 395     { DIST,  DIST,  DIST},
 396     {-DIST,  DIST,  DIST}
 397 };
 398
 399 /* The 12 lines forming the edges */
 400 static const struct line lines[12] =
 401 {
 402     {0, 1}, {1, 2}, {2, 3}, {3, 0},
 403     {4, 7}, {7, 6}, {6, 5}, {5, 4},
 404     {0, 4}, {1, 5}, {2, 6}, {3, 7}
 405 };
 406
 407 static bool lines_drawn[12];
 408
 409 /* The 6 faces of the cube; points are in clockwise order when viewed
 410    from the outside */
 411 static const struct face faces[6] =
 412 {
 413     {{0, 1, 2, 3}, {0, 1, 2, 3}},
 414     {{4, 7, 6, 5}, {4, 5, 6, 7}},
 415     {{0, 4, 5, 1}, {8, 7, 9, 0}},
 416     {{2, 6, 7, 3}, {10, 5, 11, 2}},
 417     {{0, 3, 7, 4}, {3, 11, 4, 8}},
 418     {{1, 5, 6, 2}, {9, 6, 10, 1}}
 419 };
 420
 421 #if LCD_DEPTH > 1 || defined(USEGSLIB)
 422 static const unsigned face_colors[6] =
 423 {
 424 #ifdef HAVE_LCD_COLOR
 425     LCD_RGBPACK(255, 0, 0), LCD_RGBPACK(255, 0, 0), LCD_RGBPACK(0, 255, 0),
 426     LCD_RGBPACK(0, 255, 0), LCD_RGBPACK(0, 0, 255), LCD_RGBPACK(0, 0, 255)
 427 #elif defined(USEGSLIB)
 428 #ifdef MROBE_100
 429     GREY_LIGHTGRAY, GREY_LIGHTGRAY, GREY_DARKGRAY,
 430     GREY_DARKGRAY,  GREY_WHITE,     GREY_WHITE
 431 #else
 432     GREY_LIGHTGRAY, GREY_LIGHTGRAY, GREY_DARKGRAY,
 433     GREY_DARKGRAY,  GREY_BLACK,     GREY_BLACK
 434 #endif
 435 #else
 436     LCD_LIGHTGRAY, LCD_LIGHTGRAY, LCD_DARKGRAY,
 437     LCD_DARKGRAY,  LCD_BLACK,     LCD_BLACK
 438 #endif
 439 };
 440 #endif
 441
 442 enum {
 443 #if LCD_DEPTH > 1 || defined(USEGSLIB)
 444     SOLID,
 445 #endif
 446     HIDDEN_LINES,
 447     WIREFRAME,
 448     NUM_MODES
 449 };
 450
 451 static int mode = 0;
 452
 453 struct counter {
 454     const char *label;
 455     short speed;
 456     short angle;
 457 };
 458
 459 static struct counter axes[] = {
 460     {"x-axis", 1, 0},
 461     {"y-axis", 3, 0},
 462     {"z-axis", 2, 0}
 463 };
 464
 465 static struct point_3D point3D[8];
 466 static struct point_2D point2D[8];
 467 static long matrice[3][3];
 468
 469 static const int nb_points = 8;
 470 static long z_off = 600;
 471
 472 static void cube_rotate(int xa, int ya, int za)
 473 {
 474     int i;
 475     /* Just to prevent unnecessary lookups */
 476     long sxa, cxa, sya, cya, sza, cza;
 477
 478     sxa = fp14_sin(xa);
 479     cxa = fp14_cos(xa);
 480     sya = fp14_sin(ya);
 481     cya = fp14_cos(ya);
 482     sza = fp14_sin(za);
 483     cza = fp14_cos(za);
 484
 485     /* calculate overall translation matrix */
 486     matrice[0][0] = (cza * cya) >> 14;
 487     matrice[1][0] = (sza * cya) >> 14;
 488     matrice[2][0] = -sya;
 489
 490     matrice[0][1] = (((cza * sya) >> 14) * sxa - sza * cxa) >> 14;
 491     matrice[1][1] = (((sza * sya) >> 14) * sxa + cxa * cza) >> 14;
 492     matrice[2][1] = (sxa * cya) >> 14;
 493
 494     matrice[0][2] = (((cza * sya) >> 14) * cxa + sza * sxa) >> 14;
 495     matrice[1][2] = (((sza * sya) >> 14) * cxa - cza * sxa) >> 14;
 496     matrice[2][2] = (cxa * cya) >> 14;
 497
 498     /* apply translation matrix to all points */
 499     for (i = 0; i < nb_points; i++)
 500     {
 501         point3D[i].x = matrice[0][0] * sommet[i].x + matrice[1][0] * sommet[i].y
 502                      + matrice[2][0] * sommet[i].z;
 503
 504         point3D[i].y = matrice[0][1] * sommet[i].x + matrice[1][1] * sommet[i].y
 505                      + matrice[2][1] * sommet[i].z;
 506
 507         point3D[i].z = matrice[0][2] * sommet[i].x + matrice[1][2] * sommet[i].y
 508                      + matrice[2][2] * sommet[i].z;
 509     }
 510 }
 511
 512 static void cube_viewport(void)
 513 {
 514     int i;
 515
 516     /* Do viewport transformation for all points */
 517     for (i = 0; i < nb_points; i++)
 518     {
 519 #if ASPECT != 256
 520         point2D[i].x = (point3D[i].x * ASPECT) / (point3D[i].z + (z_off << 14))
 521                      + x_off;
 522 #else
 523         point2D[i].x = (point3D[i].x << 8) / (point3D[i].z + (z_off << 14))
 524                      + x_off;
 525 #endif
 526         point2D[i].y = (point3D[i].y << 8) / (point3D[i].z + (z_off << 14))
 527                      + y_off;
 528     }
 529 }
 530
 531 static void cube_draw(void)
 532 {
 533     int i, j, line;
 534 #if LCD_DEPTH > 1 || defined(USEGSLIB)
 535     unsigned old_foreground;
 536 #endif
 537
 538     switch (mode)
 539     {
 540 #if LCD_DEPTH > 1 || defined(USEGSLIB)
 541       case SOLID:
 542
 543         old_foreground = MY_GET_FOREGROUND();
 544         for (i = 0; i < 6; i++)
 545         {
 546             /* backface culling; if the shape winds counter-clockwise, we are
 547              * looking at the backface, and the (simplified) cross product
 548              * is < 0. Do not draw it. */
 549             if (0 >= (point2D[faces[i].corner[1]].x - point2D[faces[i].corner[0]].x)
 550                    * (point2D[faces[i].corner[2]].y - point2D[faces[i].corner[1]].y)
 551                    - (point2D[faces[i].corner[1]].y - point2D[faces[i].corner[0]].y)
 552                    * (point2D[faces[i].corner[2]].x - point2D[faces[i].corner[1]].x))
 553                 continue;
 554
 555             MY_SET_FOREGROUND(face_colors[i]);
 556             MY_FILLTRIANGLE(point2D[faces[i].corner[0]].x,
 557                             point2D[faces[i].corner[0]].y,
 558                             point2D[faces[i].corner[1]].x,
 559                             point2D[faces[i].corner[1]].y,
 560                             point2D[faces[i].corner[2]].x,
 561                             point2D[faces[i].corner[2]].y);
 562             MY_FILLTRIANGLE(point2D[faces[i].corner[0]].x,
 563                             point2D[faces[i].corner[0]].y,
 564                             point2D[faces[i].corner[2]].x,
 565                             point2D[faces[i].corner[2]].y,
 566                             point2D[faces[i].corner[3]].x,
 567                             point2D[faces[i].corner[3]].y);
 568
 569         }
 570         MY_SET_FOREGROUND(old_foreground);
 571         break;
 572 #endif /* (LCD_DEPTH > 1) || GSLIB */
 573
 574       case HIDDEN_LINES:
 575
 576         rb->memset(lines_drawn, 0, sizeof(lines_drawn));
 577         for (i = 0; i < 6; i++)
 578         {
 579             /* backface culling; if the shape winds counter-clockwise, we are
 580              * looking at the backface, and the (simplified) cross product
 581              * is < 0. Do not draw it. */
 582             if (0 >= (point2D[faces[i].corner[1]].x - point2D[faces[i].corner[0]].x)
 583                    * (point2D[faces[i].corner[2]].y - point2D[faces[i].corner[1]].y)
 584                    - (point2D[faces[i].corner[1]].y - point2D[faces[i].corner[0]].y)
 585                    * (point2D[faces[i].corner[2]].x - point2D[faces[i].corner[1]].x))
 586                 continue;
 587
 588             for (j = 0; j < 4; j++)
 589             {
 590                 line = faces[i].line[j];
 591                 if (!lines_drawn[line])
 592                 {
 593                     lines_drawn[line] = true;
 594                     MYLCD(drawline)(point2D[lines[line].start].x,
 595                                     point2D[lines[line].start].y,
 596                                     point2D[lines[line].end].x,
 597                                     point2D[lines[line].end].y);
 598                 }
 599             }
 600         }
 601         break;
 602
 603       case WIREFRAME:
 604
 605         for (i = 0; i < 12; i++)
 606             MYLCD(drawline)(point2D[lines[i].start].x,
 607                             point2D[lines[i].start].y,
 608                             point2D[lines[i].end].x,
 609                             point2D[lines[i].end].y);
 610         break;
 611     }
 612 }
 613
 614 void cleanup(void *parameter)
 615 {
 616     (void)parameter;
 617
 618 #ifdef USEGSLIB
 619     grey_release();
 620 #elif defined HAVE_LCD_CHARCELLS
 621     pgfx_release();
 622 #endif
 623 }
 624
 625 enum plugin_status plugin_start(const void* parameter)
 626 {
 627     char buffer[30];
 628     int t_disp = 0;
 629 #ifdef USEGSLIB
 630     unsigned char *gbuf;
 631     size_t gbuf_size = 0;
 632     bool mode_switch = true;
 633 #endif
 634
 635     int button;
 636     int lastbutton = BUTTON_NONE;
 637     int curr = 0;
 638     bool highspeed = false;
 639     bool paused = false;
 640     bool redraw = true;
 641     bool exit = false;
 642
 643     (void)(parameter);
 644
 645 #ifdef HAVE_LCD_BITMAP
 646 #if defined(USEGSLIB)
 647     gbuf = (unsigned char *)rb->plugin_get_buffer(&gbuf_size);
 648     if (!grey_init(gbuf, gbuf_size, GREY_BUFFERED,
 649                    LCD_WIDTH, LCD_HEIGHT, NULL))
 650     {
 651         rb->splash(HZ, "Couldn't init greyscale display");
 652         return PLUGIN_ERROR;
 653     }
 654     /* init lcd_ function pointers */
 655     lcdfuncs.update =        rb->lcd_update;
 656     lcdfuncs.clear_display = rb->lcd_clear_display;
 657     lcdfuncs.drawline =      rb->lcd_drawline;
 658     lcdfuncs.putsxy =        rb->lcd_putsxy;
 659
 660 #ifdef MROBE_100
 661     grey_set_background(GREY_BLACK);
 662 #endif
 663
 664     grey_setfont(FONT_SYSFIXED);
 665 #endif
 666     rb->lcd_setfont(FONT_SYSFIXED);
 667 #else /* LCD_CHARCELLS */
 668     if (!pgfx_init(4, 2))
 669     {
 670         rb->splash(HZ*2, "Old LCD :(");
 671         return PLUGIN_OK;
 672     }
 673     pgfx_display(0, 0);
 674 #endif
 675
 676     while(!exit)
 677     {
 678         if (redraw)
 679         {
 680             MYLCD(clear_display)();
 681             cube_rotate(axes[0].angle, axes[1].angle, axes[2].angle);
 682             cube_viewport();
 683             cube_draw();
 684             redraw = false;
 685         }
 686
 687 #ifdef HAVE_LCD_BITMAP
 688         if (t_disp > 0)
 689         {
 690             t_disp--;
 691             rb->snprintf(buffer, sizeof(buffer), "%s: %d %s",
 692                          axes[curr].label,
 693                          paused ? axes[curr].angle : axes[curr].speed,
 694                          highspeed ? "(hs)" : "");
 695             MYLCD(putsxy)(0, LCD_HEIGHT-8, buffer);
 696             if (t_disp == 0)
 697                 redraw = true;
 698         }
 699 #else
 700         if (t_disp > 0)
 701         {
 702             if (t_disp == DISP_TIME)
 703             {
 704                 rb->lcd_puts(5, 0, axes[curr].label);
 705                 rb->snprintf(buffer, sizeof(buffer), "%d %c",
 706                              paused ? axes[curr].angle : axes[curr].speed,
 707                              highspeed ? 'H' : ' ');
 708                 rb->lcd_puts(5, 1, buffer);
 709             }
 710             t_disp--;
 711             if (t_disp == 0)
 712             {
 713                 rb->lcd_clear_display();
 714                 pgfx_display(0, 0);
 715             }
 716         }
 717 #endif
 718 #ifdef USEGSLIB
 719         if (mode_switch)
 720         {
 721             grey_show(mode == SOLID);
 722             mode_switch = false;
 723         }
 724 #endif
 725         MYLCD(update)();
 726
 727         if (!paused)
 728         {
 729             int i;
 730
 731             for (i = 0; i < 3; i++)
 732             {
 733                 axes[i].angle += axes[i].speed;
 734                 if (axes[i].angle > 359)
 735                     axes[i].angle -= 360;
 736                 else if (axes[i].angle < 0)
 737                     axes[i].angle += 360;
 738             }
 739             redraw = true;
 740
 741             if (highspeed)
 742                 rb->yield();
 743             else
 744                 rb->sleep(HZ/25);
 745             button = rb->button_get(false);
 746         }
 747         else
 748         {
 749             button = rb->button_get_w_tmo(HZ/25);
 750         }
 751
 752         switch (button)
 753         {
 754             case CUBE_INC:
 755             case CUBE_INC|BUTTON_REPEAT:
 756                 if (!paused)
 757                 {
 758                     if (axes[curr].speed < 10)
 759                         axes[curr].speed++;
 760                 }
 761                 else
 762                 {
 763                     if (++axes[curr].angle > 359)
 764                         axes[curr].angle -= 360;
 765                 }
 766                 t_disp = DISP_TIME;
 767                 redraw = true;
 768                 break;
 769
 770             case CUBE_DEC:
 771             case CUBE_DEC|BUTTON_REPEAT:
 772                 if (!paused)
 773                 {
 774                     if (axes[curr].speed > -10)
 775                         axes[curr].speed--;
 776                 }
 777                 else
 778                 {
 779                     if (--axes[curr].angle < 0)
 780                         axes[curr].angle += 360;
 781                 }
 782                 t_disp = DISP_TIME;
 783                 redraw = true;
 784                 break;
 785
 786             case CUBE_NEXT:
 787                 if (++curr > 2)
 788                     curr = 0;
 789                 t_disp = DISP_TIME;
 790                 break;
 791
 792             case CUBE_PREV:
 793                 if (--curr < 0)
 794                     curr = 2;
 795                 t_disp = DISP_TIME;
 796                 break;
 797
 798             case CUBE_MODE:
 799 #ifdef CUBE_MODE_PRE
 800                 if (lastbutton != CUBE_MODE_PRE)
 801                     break;
 802 #endif
 803                 if (++mode >= NUM_MODES)
 804                     mode = 0;
 805 #ifdef USEGSLIB
 806                 mylcd = (mode == SOLID) ? &greyfuncs : &lcdfuncs;
 807                 mode_switch = true;
 808 #endif
 809                 redraw = true;
 810                 break;
 811
 812             case CUBE_PAUSE:
 813 #ifdef CUBE_PAUSE_PRE
 814                 if (lastbutton != CUBE_PAUSE_PRE)
 815                     break;
 816 #endif
 817                 paused = !paused;
 818                 break;
 819
 820             case CUBE_HIGHSPEED:
 821 #ifdef CUBE_HIGHSPEED_PRE
 822                 if (lastbutton != CUBE_HIGHSPEED_PRE)
 823                     break;
 824 #endif
 825                 highspeed = !highspeed;
 826                 t_disp = DISP_TIME;
 827                 break;
 828
 829 #ifdef CUBE_RC_QUIT
 830             case CUBE_RC_QUIT:
 831 #endif
 832             case CUBE_QUIT:
 833                 exit = true;
 834                 break;
 835
 836             default:
 837                 if (rb->default_event_handler_ex(button, cleanup, NULL)
 838                     == SYS_USB_CONNECTED)
 839                     return PLUGIN_USB_CONNECTED;
 840                 break;
 841         }
 842         if (button != BUTTON_NONE)
 843             lastbutton = button;
 844     }
 845
 846 #ifdef USEGSLIB
 847     grey_release();
 848 #elif defined(HAVE_LCD_CHARCELLS)
 849     pgfx_release();
 850 #endif
 851     return PLUGIN_OK;
 852 }
 853
 854