Nyaaori/rockbox
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity
rockbox/apps/plugins/cube.c
Thomas Martitz 249bba03f1 Initial commit of the Samsung YP-R0 port. 
This port is a hybrid native/RaaA port. It runs on a embedded linux system,
but is the only application. It therefore can implement lots of stuff that
native targets also implement, while leveraging the underlying linux kernel.

The port is quite advanced. User interface, audio playback, plugins work
mostly fine. Missing is e.g. power mangement and USB (see SamsungYPR0 wiki page).

Included in utils/ypr0tools are scripts and programs required to generate
a patched firmware. The patched firmware has the rootfs modified to load
Rockbox. It includes a early/safe USB mode.

This port needs a new toolchain, one that includes glibc headers and libraries.
rockboxdev.sh can generate it, but e.g. codesourcey and distro packages may
also work.

Most of the initial effort is done by Lorenzo Miori and others (on ABI),
including reverse engineering and patching of the original firmware,
initial drivers, and more. Big thanks to you.

Flyspray: FS#12348
Author: Lorenzo Miori, myself

Merry christmas to ypr0 owners! :)

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@31415 a1c6a512-1295-4272-9138-f99709370657
2011-12-24 11:56:46 +00:00

903 lines
26 KiB
C
Raw Blame History

/***************************************************************************
* __________ __ ___.
* 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 "lib/playergfx.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"
#include "lib/fixedpoint.h"
/* Loops that the values are displayed */
#define DISP_TIME 30
/* variable button definitions */
#if CONFIG_KEYPAD == RECORDER_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_F1
#define CUBE_PAUSE BUTTON_PLAY
#define CUBE_HIGHSPEED BUTTON_ON
#elif CONFIG_KEYPAD == ARCHOS_AV300_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_F1
#define CUBE_PAUSE BUTTON_SELECT
#define CUBE_HIGHSPEED BUTTON_ON
#elif CONFIG_KEYPAD == PLAYER_PAD
#define CUBE_QUIT BUTTON_STOP
#define CUBE_INC BUTTON_RIGHT
#define CUBE_DEC BUTTON_LEFT
#define CUBE_NEXT (BUTTON_ON | BUTTON_RIGHT)
#define CUBE_PREV (BUTTON_ON | BUTTON_LEFT)
#define CUBE_MODE BUTTON_MENU
#define CUBE_PAUSE BUTTON_PLAY
#define CUBE_HIGHSPEED_PRE BUTTON_ON
#define CUBE_HIGHSPEED (BUTTON_ON | BUTTON_REL)
#elif CONFIG_KEYPAD == ONDIO_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_PRE BUTTON_MENU
#define CUBE_MODE (BUTTON_MENU | BUTTON_REL)
#define CUBE_PAUSE (BUTTON_MENU | BUTTON_LEFT)
#define CUBE_HIGHSPEED (BUTTON_MENU | BUTTON_RIGHT)
#elif (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 == 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_YH_PAD
#define CUBE_QUIT BUTTON_REC
#define CUBE_NEXT BUTTON_RIGHT
#define CUBE_PREV BUTTON_LEFT
#define CUBE_INC BUTTON_UP
#define CUBE_DEC BUTTON_DOWN
#define CUBE_MODE BUTTON_REW
#define CUBE_PAUSE BUTTON_PLAY
#define CUBE_HIGHSPEED 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_REC
#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
#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
#ifdef HAVE_LCD_BITMAP
#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
#else /* !LCD_BITMAP */
#define MYLCD(fn) pgfx_ ## fn
#define DIST 9
static int x_off = 10;
static int y_off = 7;
#define ASPECT 300 /* = 1.175 */
#endif /* !LCD_BITMAP */
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();
#elif defined HAVE_LCD_CHARCELLS
pgfx_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);
#ifdef HAVE_LCD_BITMAP
#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);
#else /* LCD_CHARCELLS */
if (!pgfx_init(4, 2))
{
rb->splash(HZ*2, "Old LCD :(");
return PLUGIN_OK;
}
pgfx_display(0, 0);
#endif
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;
}
#ifdef HAVE_LCD_BITMAP
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;
}
#else
if (t_disp > 0)
{
if (t_disp == DISP_TIME)
{
rb->lcd_puts(5, 0, axes[curr].label);
rb->lcd_putsf(5, 1, "%d %c",
paused ? axes[curr].angle : axes[curr].speed,
highspeed ? 'H' : ' ');
}
t_disp--;
if (t_disp == 0)
{
rb->lcd_clear_display();
pgfx_display(0, 0);
}
}
#endif
#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:
exit(EXIT_SUCCESS);
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;
}
Reference in a new issue View git blame Copy permalink