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