/*************************************************************************** * __________ __ ___. * Open \______ \ ____ ____ | | _\_ |__ _______ ___ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ * \/ \/ \/ \/ \/ * $Id$ * * Copyright (C) 2002 Damien Teney * modified to use int instead of float math by Andreas Zwirtes * heavily extended by Jens Arnold * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version 2 * of the License, or (at your option) any later version. * * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY * KIND, either express or implied. * ***************************************************************************/ #include "plugin.h" #include "fixedpoint.h" #include "lib/pluginlib_exit.h" #if LCD_DEPTH > 1 #include "lib/mylcd.h" /* MYLCD_CFG_RB_XLCD or MYLCD_CFG_PGFX */ #include "lib/grey.h" #else #include "lib/grey.h" #include "lib/mylcd.h" /* MYLCD_CFG_GREYLIB or MYLCD_CFG_PGFX */ #endif #include "lib/xlcd.h" /* Loops that the values are displayed */ #define DISP_TIME 30 /* variable button definitions */ #if (CONFIG_KEYPAD == IRIVER_H100_PAD) || \ (CONFIG_KEYPAD == IRIVER_H300_PAD) #define CUBE_QUIT BUTTON_OFF #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MODE #define CUBE_PAUSE BUTTON_ON #define CUBE_HIGHSPEED BUTTON_SELECT #define CUBE_RC_QUIT BUTTON_RC_STOP #elif (CONFIG_KEYPAD == IPOD_4G_PAD) || \ (CONFIG_KEYPAD == IPOD_3G_PAD) || \ (CONFIG_KEYPAD == IPOD_1G2G_PAD) #define CUBE_QUIT (BUTTON_SELECT | BUTTON_MENU) #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_SCROLL_FWD #define CUBE_DEC BUTTON_SCROLL_BACK #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED_PRE BUTTON_SELECT #define CUBE_HIGHSPEED (BUTTON_SELECT | BUTTON_REL) #elif CONFIG_KEYPAD == IRIVER_IFP7XX_PAD #define CUBE_QUIT BUTTON_PLAY #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MODE #define CUBE_PAUSE BUTTON_SELECT #define CUBE_HIGHSPEED BUTTON_EQ #elif (CONFIG_KEYPAD == IAUDIO_X5M5_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_REC #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_SELECT #elif (CONFIG_KEYPAD == GIGABEAT_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_SELECT #define CUBE_HIGHSPEED BUTTON_A #elif (CONFIG_KEYPAD == SANSA_E200_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_SCROLL_FWD #define CUBE_DEC BUTTON_SCROLL_BACK #define CUBE_MODE BUTTON_DOWN #define CUBE_PAUSE BUTTON_UP #define CUBE_HIGHSPEED BUTTON_SELECT #elif (CONFIG_KEYPAD == SANSA_FUZE_PAD) #define CUBE_QUIT (BUTTON_HOME|BUTTON_REPEAT) #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_SCROLL_FWD #define CUBE_DEC BUTTON_SCROLL_BACK #define CUBE_MODE BUTTON_DOWN #define CUBE_PAUSE BUTTON_UP #define CUBE_HIGHSPEED BUTTON_SELECT #elif (CONFIG_KEYPAD == SANSA_C200_PAD) || \ (CONFIG_KEYPAD == SANSA_CLIP_PAD) || \ (CONFIG_KEYPAD == SANSA_M200_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_VOL_UP #define CUBE_DEC BUTTON_VOL_DOWN #define CUBE_MODE BUTTON_DOWN #define CUBE_PAUSE BUTTON_UP #define CUBE_HIGHSPEED BUTTON_SELECT #elif (CONFIG_KEYPAD == IRIVER_H10_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_SCROLL_UP #define CUBE_DEC BUTTON_SCROLL_DOWN #define CUBE_MODE BUTTON_REW #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_FF #elif CONFIG_KEYPAD == MROBE500_PAD #define CUBE_QUIT BUTTON_POWER #elif CONFIG_KEYPAD == GIGABEAT_S_PAD #define CUBE_QUIT BUTTON_BACK #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_SELECT #elif (CONFIG_KEYPAD == MROBE100_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_SELECT #elif (CONFIG_KEYPAD == IAUDIO_M3_PAD) #define CUBE_QUIT BUTTON_RC_REC #define CUBE_NEXT BUTTON_RC_FF #define CUBE_PREV BUTTON_RC_REW #define CUBE_INC BUTTON_RC_VOL_UP #define CUBE_DEC BUTTON_RC_VOL_DOWN #define CUBE_MODE BUTTON_RC_MODE #define CUBE_PAUSE BUTTON_RC_PLAY #define CUBE_HIGHSPEED BUTTON_RC_MENU #elif CONFIG_KEYPAD == COWON_D2_PAD #define CUBE_QUIT BUTTON_POWER #elif (CONFIG_KEYPAD == IAUDIO67_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_VOLUP #define CUBE_DEC BUTTON_VOLDOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_STOP #elif CONFIG_KEYPAD == CREATIVEZVM_PAD #define CUBE_QUIT BUTTON_BACK #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_SELECT #elif CONFIG_KEYPAD == CREATIVE_ZENXFI3_PAD #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_UP #define CUBE_PREV BUTTON_DOWN #define CUBE_INC BUTTON_VOL_UP #define CUBE_DEC BUTTON_VOL_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE (BUTTON_PLAY|BUTTON_REL) #define CUBE_HIGHSPEED BUTTON_BACK #elif CONFIG_KEYPAD == PHILIPS_HDD1630_PAD #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_SELECT #define CUBE_HIGHSPEED BUTTON_VIEW #elif CONFIG_KEYPAD == PHILIPS_HDD6330_PAD #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_NEXT #define CUBE_PREV BUTTON_PREV #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_RIGHT #elif CONFIG_KEYPAD == PHILIPS_SA9200_PAD #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_NEXT #define CUBE_PREV BUTTON_PREV #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_RIGHT #elif CONFIG_KEYPAD == ONDAVX747_PAD #define CUBE_QUIT BUTTON_POWER #elif CONFIG_KEYPAD == ONDAVX777_PAD #define CUBE_QUIT BUTTON_POWER #elif (CONFIG_KEYPAD == SAMSUNG_YH820_PAD) || \ (CONFIG_KEYPAD == SAMSUNG_YH92X_PAD) #define CUBE_QUIT BUTTON_REW #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE (BUTTON_FFWD|BUTTON_REL) #define CUBE_MODE_PRE BUTTON_FFWD #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED (BUTTON_FFWD|BUTTON_REPEAT) #define CUBE_HIGHSPEED_PRE BUTTON_FFWD #elif CONFIG_KEYPAD == PBELL_VIBE500_PAD #define CUBE_QUIT BUTTON_REC #define CUBE_NEXT BUTTON_NEXT #define CUBE_PREV BUTTON_PREV #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_OK #elif CONFIG_KEYPAD == MPIO_HD200_PAD #define CUBE_QUIT (BUTTON_REC | BUTTON_PLAY) #define CUBE_NEXT BUTTON_FF #define CUBE_PREV BUTTON_REW #define CUBE_INC BUTTON_VOL_UP #define CUBE_DEC BUTTON_VOL_DOWN #define CUBE_MODE BUTTON_REC #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_FUNC #elif CONFIG_KEYPAD == MPIO_HD300_PAD #define CUBE_QUIT (BUTTON_MENU | BUTTON_REPEAT) #define CUBE_NEXT BUTTON_FF #define CUBE_PREV BUTTON_REW #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED BUTTON_ENTER #elif CONFIG_KEYPAD == SANSA_FUZEPLUS_PAD #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_SELECT #define CUBE_PAUSE BUTTON_PLAYPAUSE #define CUBE_HIGHSPEED BUTTON_BACK #elif CONFIG_KEYPAD == SANSA_CONNECT_PAD #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_NEXT #define CUBE_PREV BUTTON_PREV #define CUBE_INC BUTTON_VOL_UP #define CUBE_DEC BUTTON_VOL_DOWN #define CUBE_MODE BUTTON_SELECT #define CUBE_PAUSE BUTTON_DOWN #define CUBE_HIGHSPEED BUTTON_LEFT #elif (CONFIG_KEYPAD == SAMSUNG_YPR0_PAD) #define CUBE_QUIT BUTTON_BACK #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_USER #define CUBE_HIGHSPEED BUTTON_SELECT #elif (CONFIG_KEYPAD == HM60X_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE (BUTTON_SELECT|BUTTON_POWER) #define CUBE_PAUSE BUTTON_SELECT #define CUBE_HIGHSPEED (BUTTON_UP|BUTTON_POWER) #elif (CONFIG_KEYPAD == HM801_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_PREV #define CUBE_PAUSE BUTTON_SELECT #define CUBE_HIGHSPEED BUTTON_NEXT #elif (CONFIG_KEYPAD == SONY_NWZ_PAD) #define CUBE_QUIT BUTTON_BACK #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE (BUTTON_POWER|BUTTON_UP) #define CUBE_PAUSE BUTTON_PLAY #define CUBE_HIGHSPEED (BUTTON_POWER|BUTTON_DOWN) #elif (CONFIG_KEYPAD == CREATIVE_ZEN_PAD) #define CUBE_QUIT BUTTON_BACK #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_UP #define CUBE_DEC BUTTON_DOWN #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_PLAYPAUSE #define CUBE_HIGHSPEED BUTTON_SHORTCUT #elif (CONFIG_KEYPAD == DX50_PAD) #define CUBE_QUIT (BUTTON_POWER|BUTTON_REL) #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_VOL_UP #define CUBE_DEC BUTTON_VOL_DOWN #define CUBE_MODE BUTTON_PLAY #elif CONFIG_KEYPAD == CREATIVE_ZENXFI2_PAD #define CUBE_QUIT BUTTON_POWER #elif (CONFIG_KEYPAD == AGPTEK_ROCKER_PAD) #define CUBE_QUIT (BUTTON_POWER|BUTTON_REL) #define CUBE_NEXT BUTTON_RIGHT #define CUBE_PREV BUTTON_LEFT #define CUBE_INC BUTTON_VOLUP #define CUBE_DEC BUTTON_VOLDOWN #define CUBE_MODE BUTTON_SELECT #define CUBE_HIGHSPEED (BUTTON_SELECT | BUTTON_REPEAT) #define CUBE_PAUSE (BUTTON_LEFT | BUTTON_REPEAT) #elif (CONFIG_KEYPAD == XDUOO_X3_PAD) || (CONFIG_KEYPAD == XDUOO_X3II_PAD) || (CONFIG_KEYPAD == XDUOO_X20_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_NEXT #define CUBE_PREV BUTTON_PREV #define CUBE_INC BUTTON_VOL_UP #define CUBE_DEC BUTTON_VOL_DOWN #define CUBE_MODE BUTTON_OPTION #define CUBE_PAUSE BUTTON_HOME #define CUBE_HIGHSPEED BUTTON_PLAY #elif (CONFIG_KEYPAD == FIIO_M3K_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_NEXT #define CUBE_PREV BUTTON_PREV #define CUBE_INC BUTTON_VOL_UP #define CUBE_DEC BUTTON_VOL_DOWN #define CUBE_MODE BUTTON_OPTION #define CUBE_PAUSE BUTTON_HOME #define CUBE_HIGHSPEED BUTTON_PLAY #elif (CONFIG_KEYPAD == IHIFI_770_PAD) || (CONFIG_KEYPAD == IHIFI_800_PAD) #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_NEXT #define CUBE_PREV BUTTON_PREV #define CUBE_INC BUTTON_VOL_UP #define CUBE_DEC BUTTON_VOL_DOWN #define CUBE_MODE (BUTTON_HOME | BUTTON_POWER) #define CUBE_PAUSE BUTTON_HOME #define CUBE_HIGHSPEED BUTTON_PLAY #elif CONFIG_KEYPAD == EROSQ_PAD #define CUBE_QUIT BUTTON_POWER #define CUBE_NEXT BUTTON_NEXT #define CUBE_PREV BUTTON_PREV #define CUBE_INC BUTTON_SCROLL_FWD #define CUBE_DEC BUTTON_SCROLL_BACK #define CUBE_MODE BUTTON_MENU #define CUBE_PAUSE BUTTON_BACK #define CUBE_HIGHSPEED BUTTON_PLAY #else #error No keymap defined! #endif #ifdef HAVE_TOUCHSCREEN #ifndef CUBE_QUIT #define CUBE_QUIT BUTTON_TOPLEFT #endif #ifndef CUBE_NEXT #define CUBE_NEXT BUTTON_MIDRIGHT #endif #ifndef CUBE_PREV #define CUBE_PREV BUTTON_MIDLEFT #endif #ifndef CUBE_INC #define CUBE_INC BUTTON_TOPMIDDLE #endif #ifndef CUBE_DEC #define CUBE_DEC BUTTON_BOTTOMMIDDLE #endif #ifndef CUBE_MODE #define CUBE_MODE BUTTON_TOPRIGHT #endif #ifndef CUBE_PAUSE #define CUBE_PAUSE BUTTON_CENTER #endif #ifndef CUBE_HIGHSPEED #define CUBE_HIGHSPEED BUTTON_BOTTOMRIGHT #endif #endif #define DIST (10 * MIN(LCD_HEIGHT, LCD_WIDTH) / 16) static int x_off = LCD_WIDTH/2; static int y_off = LCD_HEIGHT/2; #if LCD_DEPTH == 1 #define USEGSLIB GREY_INFO_STRUCT struct my_lcd { void (*update)(void); void (*clear_display)(void); void (*drawline)(int x1, int y1, int x2, int y2); void (*putsxy)(int x, int y, const unsigned char *string); }; static struct my_lcd greyfuncs = { grey_update, grey_clear_display, grey_drawline, grey_putsxy }; static struct my_lcd lcdfuncs; /* initialised at runtime */ static struct my_lcd *mylcd = &greyfuncs; #define MYLCD(fn) mylcd->fn #else #define MYLCD(fn) rb->lcd_ ## fn #endif #if CONFIG_LCD == LCD_SSD1815 #define ASPECT 320 /* = 1.25 (fixed point 24.8) */ #else #define ASPECT 256 /* = 1.00 */ #endif struct point_3D { long x, y, z; }; struct point_2D { long x, y; }; struct line { int start, end; }; struct face { int corner[4]; int line[4]; }; /* initial, unrotated cube corners */ static const struct point_3D sommet[8] = { {-DIST, -DIST, -DIST}, { DIST, -DIST, -DIST}, { DIST, DIST, -DIST}, {-DIST, DIST, -DIST}, {-DIST, -DIST, DIST}, { DIST, -DIST, DIST}, { DIST, DIST, DIST}, {-DIST, DIST, DIST} }; /* The 12 lines forming the edges */ static const struct line lines[12] = { {0, 1}, {1, 2}, {2, 3}, {3, 0}, {4, 7}, {7, 6}, {6, 5}, {5, 4}, {0, 4}, {1, 5}, {2, 6}, {3, 7} }; static bool lines_drawn[12]; /* The 6 faces of the cube; points are in clockwise order when viewed from the outside */ static const struct face faces[6] = { {{0, 1, 2, 3}, {0, 1, 2, 3}}, {{4, 7, 6, 5}, {4, 5, 6, 7}}, {{0, 4, 5, 1}, {8, 7, 9, 0}}, {{2, 6, 7, 3}, {10, 5, 11, 2}}, {{0, 3, 7, 4}, {3, 11, 4, 8}}, {{1, 5, 6, 2}, {9, 6, 10, 1}} }; #if LCD_DEPTH > 1 || defined(USEGSLIB) static const unsigned face_colors[6] = { #ifdef HAVE_LCD_COLOR LCD_RGBPACK(255, 0, 0), LCD_RGBPACK(255, 0, 0), LCD_RGBPACK(0, 255, 0), LCD_RGBPACK(0, 255, 0), LCD_RGBPACK(0, 0, 255), LCD_RGBPACK(0, 0, 255) #elif defined(USEGSLIB) #ifdef MROBE_100 GREY_LIGHTGRAY, GREY_LIGHTGRAY, GREY_DARKGRAY, GREY_DARKGRAY, GREY_WHITE, GREY_WHITE #else GREY_LIGHTGRAY, GREY_LIGHTGRAY, GREY_DARKGRAY, GREY_DARKGRAY, GREY_BLACK, GREY_BLACK #endif #else LCD_LIGHTGRAY, LCD_LIGHTGRAY, LCD_DARKGRAY, LCD_DARKGRAY, LCD_BLACK, LCD_BLACK #endif }; #endif enum { #if LCD_DEPTH > 1 || defined(USEGSLIB) SOLID, #endif HIDDEN_LINES, WIREFRAME, NUM_MODES }; static int mode = 0; struct counter { const char *label; short speed; short angle; }; static struct counter axes[] = { {"x-axis", 1, 0}, {"y-axis", 3, 0}, {"z-axis", 2, 0} }; static struct point_3D point3D[8]; static struct point_2D point2D[8]; static long matrice[3][3]; static const int nb_points = 8; static long z_off = 600; static void cube_rotate(int xa, int ya, int za) { int i; /* Just to prevent unnecessary lookups */ long sxa, cxa, sya, cya, sza, cza; sxa = fp14_sin(xa); cxa = fp14_cos(xa); sya = fp14_sin(ya); cya = fp14_cos(ya); sza = fp14_sin(za); cza = fp14_cos(za); /* calculate overall translation matrix */ matrice[0][0] = (cza * cya) >> 14; matrice[1][0] = (sza * cya) >> 14; matrice[2][0] = -sya; matrice[0][1] = (((cza * sya) >> 14) * sxa - sza * cxa) >> 14; matrice[1][1] = (((sza * sya) >> 14) * sxa + cxa * cza) >> 14; matrice[2][1] = (sxa * cya) >> 14; matrice[0][2] = (((cza * sya) >> 14) * cxa + sza * sxa) >> 14; matrice[1][2] = (((sza * sya) >> 14) * cxa - cza * sxa) >> 14; matrice[2][2] = (cxa * cya) >> 14; /* apply translation matrix to all points */ for (i = 0; i < nb_points; i++) { point3D[i].x = matrice[0][0] * sommet[i].x + matrice[1][0] * sommet[i].y + matrice[2][0] * sommet[i].z; point3D[i].y = matrice[0][1] * sommet[i].x + matrice[1][1] * sommet[i].y + matrice[2][1] * sommet[i].z; point3D[i].z = matrice[0][2] * sommet[i].x + matrice[1][2] * sommet[i].y + matrice[2][2] * sommet[i].z; } } static void cube_viewport(void) { int i; /* Do viewport transformation for all points */ for (i = 0; i < nb_points; i++) { #if ASPECT != 256 point2D[i].x = (point3D[i].x * ASPECT) / (point3D[i].z + (z_off << 14)) + x_off; #else point2D[i].x = (point3D[i].x << 8) / (point3D[i].z + (z_off << 14)) + x_off; #endif point2D[i].y = (point3D[i].y << 8) / (point3D[i].z + (z_off << 14)) + y_off; } } static void cube_draw(void) { int i, j, line; #if LCD_DEPTH > 1 || defined(USEGSLIB) unsigned old_foreground; #endif switch (mode) { #if LCD_DEPTH > 1 || defined(USEGSLIB) case SOLID: old_foreground = mylcd_get_foreground(); for (i = 0; i < 6; i++) { /* backface culling; if the shape winds counter-clockwise, we are * looking at the backface, and the (simplified) cross product * is < 0. Do not draw it. */ if (0 >= (point2D[faces[i].corner[1]].x - point2D[faces[i].corner[0]].x) * (point2D[faces[i].corner[2]].y - point2D[faces[i].corner[1]].y) - (point2D[faces[i].corner[1]].y - point2D[faces[i].corner[0]].y) * (point2D[faces[i].corner[2]].x - point2D[faces[i].corner[1]].x)) continue; mylcd_set_foreground(face_colors[i]); mylcd_filltriangle(point2D[faces[i].corner[0]].x, point2D[faces[i].corner[0]].y, point2D[faces[i].corner[1]].x, point2D[faces[i].corner[1]].y, point2D[faces[i].corner[2]].x, point2D[faces[i].corner[2]].y); mylcd_filltriangle(point2D[faces[i].corner[0]].x, point2D[faces[i].corner[0]].y, point2D[faces[i].corner[2]].x, point2D[faces[i].corner[2]].y, point2D[faces[i].corner[3]].x, point2D[faces[i].corner[3]].y); } mylcd_set_foreground(old_foreground); break; #endif /* (LCD_DEPTH > 1) || GSLIB */ case HIDDEN_LINES: rb->memset(lines_drawn, 0, sizeof(lines_drawn)); for (i = 0; i < 6; i++) { /* backface culling; if the shape winds counter-clockwise, we are * looking at the backface, and the (simplified) cross product * is < 0. Do not draw it. */ if (0 >= (point2D[faces[i].corner[1]].x - point2D[faces[i].corner[0]].x) * (point2D[faces[i].corner[2]].y - point2D[faces[i].corner[1]].y) - (point2D[faces[i].corner[1]].y - point2D[faces[i].corner[0]].y) * (point2D[faces[i].corner[2]].x - point2D[faces[i].corner[1]].x)) continue; for (j = 0; j < 4; j++) { line = faces[i].line[j]; if (!lines_drawn[line]) { lines_drawn[line] = true; MYLCD(drawline)(point2D[lines[line].start].x, point2D[lines[line].start].y, point2D[lines[line].end].x, point2D[lines[line].end].y); } } } break; case WIREFRAME: for (i = 0; i < 12; i++) MYLCD(drawline)(point2D[lines[i].start].x, point2D[lines[i].start].y, point2D[lines[i].end].x, point2D[lines[i].end].y); break; } } static void cleanup(void) { #ifdef USEGSLIB grey_release(); #endif } enum plugin_status plugin_start(const void* parameter) { int t_disp = 0; #ifdef USEGSLIB unsigned char *gbuf; size_t gbuf_size = 0; bool mode_switch = true; #endif int button; #if defined(CUBE_MODE_PRE) || \ defined(CUBE_PAUSE_PRE) || \ defined(CUBE_HIGHSPEED_PRE) int lastbutton = BUTTON_NONE; #endif int curr = 0; bool highspeed = false; bool paused = false; bool redraw = true; bool quit = false; (void)(parameter); #if defined(USEGSLIB) gbuf = (unsigned char *)rb->plugin_get_buffer(&gbuf_size); if (!grey_init(gbuf, gbuf_size, GREY_BUFFERED, LCD_WIDTH, LCD_HEIGHT, NULL)) { rb->splash(HZ, "Couldn't init greyscale display"); return PLUGIN_ERROR; } /* init lcd_ function pointers */ lcdfuncs.update = rb->lcd_update; lcdfuncs.clear_display = rb->lcd_clear_display; lcdfuncs.drawline = rb->lcd_drawline; lcdfuncs.putsxy = rb->lcd_putsxy; #ifdef MROBE_100 grey_set_background(GREY_BLACK); #endif grey_setfont(FONT_SYSFIXED); #endif rb->lcd_setfont(FONT_SYSFIXED); atexit(cleanup); while(!quit) { if (redraw) { MYLCD(clear_display)(); cube_rotate(axes[0].angle, axes[1].angle, axes[2].angle); cube_viewport(); cube_draw(); redraw = false; } if (t_disp > 0) { char buffer[30]; t_disp--; rb->snprintf(buffer, sizeof(buffer), "%s: %d %s", axes[curr].label, paused ? axes[curr].angle : axes[curr].speed, highspeed ? "(hs)" : ""); MYLCD(putsxy)(0, LCD_HEIGHT-8, buffer); if (t_disp == 0) redraw = true; } #ifdef USEGSLIB if (mode_switch) { grey_show(mode == SOLID); mode_switch = false; } #endif MYLCD(update)(); if (!paused) { int i; for (i = 0; i < 3; i++) { axes[i].angle += axes[i].speed; if (axes[i].angle > 359) axes[i].angle -= 360; else if (axes[i].angle < 0) axes[i].angle += 360; } redraw = true; if (highspeed) rb->yield(); else rb->sleep(HZ/25); button = rb->button_get(false); } else { button = rb->button_get_w_tmo(HZ/25); } switch (button) { case CUBE_INC: case CUBE_INC|BUTTON_REPEAT: if (!paused) { if (axes[curr].speed < 10) axes[curr].speed++; } else { if (++axes[curr].angle > 359) axes[curr].angle -= 360; } t_disp = DISP_TIME; redraw = true; break; case CUBE_DEC: case CUBE_DEC|BUTTON_REPEAT: if (!paused) { if (axes[curr].speed > -10) axes[curr].speed--; } else { if (--axes[curr].angle < 0) axes[curr].angle += 360; } t_disp = DISP_TIME; redraw = true; break; case CUBE_NEXT: if (++curr > 2) curr = 0; t_disp = DISP_TIME; break; case CUBE_PREV: if (--curr < 0) curr = 2; t_disp = DISP_TIME; break; case CUBE_MODE: #ifdef CUBE_MODE_PRE if (lastbutton != CUBE_MODE_PRE) break; #endif if (++mode >= NUM_MODES) mode = 0; #ifdef USEGSLIB mylcd = (mode == SOLID) ? &greyfuncs : &lcdfuncs; mode_switch = true; #endif redraw = true; break; case CUBE_PAUSE: #ifdef CUBE_PAUSE_PRE if (lastbutton != CUBE_PAUSE_PRE) break; #endif paused = !paused; break; case CUBE_HIGHSPEED: #ifdef CUBE_HIGHSPEED_PRE if (lastbutton != CUBE_HIGHSPEED_PRE) break; #endif highspeed = !highspeed; t_disp = DISP_TIME; break; #ifdef CUBE_RC_QUIT case CUBE_RC_QUIT: #endif case CUBE_QUIT: quit = true; break; default: exit_on_usb(button); break; } #if defined(CUBE_MODE_PRE) || \ defined(CUBE_PAUSE_PRE) || \ defined(CUBE_HIGHSPEED_PRE) if (button != BUTTON_NONE) lastbutton = button; #endif } return PLUGIN_OK; }