rockbox/apps/plugins/cube.c

923 lines
28 KiB
C

/***************************************************************************
* __________ __ ___.
* 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 == 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 == 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_LINUX_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
#elif CONFIG_KEYPAD == FIIO_M3K_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_MENU
#define CUBE_PAUSE BUTTON_PLAY
#define CUBE_HIGHSPEED BUTTON_BACK
#elif CONFIG_KEYPAD == SHANLING_Q1_PAD
/* use touchscreen */
#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;
}