mirror of
https://github.com/dborth/snes9xgx.git
synced 2024-12-04 08:24:19 +01:00
819 lines
16 KiB
C++
819 lines
16 KiB
C++
/****************************************************************************
|
|
* Snes9x 1.50
|
|
*
|
|
* Nintendo Gamecube Screen Font Driver
|
|
*
|
|
* Uses libfreetype 2.2.1 compiled for GC with TTF support only.
|
|
* TTF only reduces the library by some 900k bytes!
|
|
*
|
|
* Visit - http://www.freetype.org !
|
|
*
|
|
* **WARNING***
|
|
*
|
|
* ONLY USE GUARANTEED PATENT FREE FONTS.
|
|
* THOSE IN YOUR WINDOWS\FONTS DIRECTORY ARE COPYRIGHT
|
|
* AND MAY NOT BE DISTRIBUTED!
|
|
*
|
|
* softdev July 2006
|
|
* crunchy2 June 2007
|
|
****************************************************************************/
|
|
#include <gccore.h>
|
|
#include <ogcsys.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <math.h>
|
|
#include <ft2build.h>
|
|
#include FT_FREETYPE_H
|
|
#include "video.h"
|
|
#include "ftfont.h"
|
|
#include "dkpro.h"
|
|
#include "tempgfx.h"
|
|
|
|
#include "aram.h"
|
|
#include <zlib.h>
|
|
|
|
/*** Globals ***/
|
|
FT_Library ftlibrary;
|
|
FT_Face face;
|
|
FT_GlyphSlot slot;
|
|
FT_UInt glyph_index;
|
|
static unsigned int fonthi, fontlo;
|
|
|
|
extern char fontface[]; /*** From fontface.s ***/
|
|
extern int fontsize; /*** From fontface.s ***/
|
|
extern int screenheight;
|
|
extern unsigned int *xfb[2];
|
|
extern int whichfb;
|
|
|
|
/**
|
|
* Unpack the devkit pro logo
|
|
*/
|
|
static u32 *dkproraw;
|
|
static u32 *backdrop; /*** Permanent backdrop ***/
|
|
static void unpackbackdrop ();
|
|
unsigned int getcolour (u8 r1, u8 g1, u8 b1);
|
|
void DrawLineFast( int startx, int endx, int y, u8 r, u8 g, u8 b );
|
|
u32 getrgb( u32 ycbr, u32 low );
|
|
|
|
/**
|
|
* Initialisation of libfreetype
|
|
*/
|
|
int
|
|
FT_Init ()
|
|
{
|
|
|
|
int err;
|
|
|
|
err = FT_Init_FreeType (&ftlibrary);
|
|
if (err)
|
|
return 1;
|
|
|
|
err =
|
|
FT_New_Memory_Face (ftlibrary, (FT_Byte *) fontface, fontsize, 0, &face);
|
|
if (err)
|
|
return 1;
|
|
|
|
setfontsize (16);
|
|
|
|
slot = face->glyph;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
/**
|
|
* setfontsize
|
|
*
|
|
* Set the screen font size in pixels
|
|
*/
|
|
void
|
|
setfontsize (int pixelsize)
|
|
{
|
|
int err;
|
|
|
|
err = FT_Set_Pixel_Sizes (face, 0, pixelsize);
|
|
|
|
if (err)
|
|
printf ("Error setting pixel sizes!");
|
|
}
|
|
|
|
static void
|
|
DrawCharacter (FT_Bitmap * bmp, FT_Int x, FT_Int y)
|
|
{
|
|
FT_Int i, j, p, q;
|
|
FT_Int x_max = x + bmp->width;
|
|
FT_Int y_max = y + bmp->rows;
|
|
int spos;
|
|
unsigned int pixel;
|
|
int c;
|
|
|
|
for (i = x, p = 0; i < x_max; i++, p++)
|
|
{
|
|
for (j = y, q = 0; j < y_max; j++, q++)
|
|
{
|
|
if (i < 0 || j < 0 || i >= 640 || j >= screenheight)
|
|
continue;
|
|
|
|
/*** Convert pixel position to GC int sizes ***/
|
|
spos = (j * 320) + (i >> 1);
|
|
|
|
pixel = xfb[whichfb][spos];
|
|
c = bmp->buffer[q * bmp->width + p];
|
|
|
|
/*** Cool Anti-Aliasing doesn't work too well at hires on GC ***/
|
|
if (c > 128)
|
|
{
|
|
if (i & 1)
|
|
pixel = (pixel & 0xffff0000) | fontlo;
|
|
else
|
|
pixel = ((pixel & 0xffff) | fonthi);
|
|
|
|
xfb[whichfb][spos] = pixel;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* DrawText
|
|
*
|
|
* Place the font bitmap on the screen
|
|
*/
|
|
void
|
|
DrawText (int x, int y, char *text)
|
|
{
|
|
int px, n;
|
|
int i;
|
|
int err;
|
|
int value, count;
|
|
|
|
n = strlen (text);
|
|
if (n == 0)
|
|
return;
|
|
|
|
/*** x == -1, auto centre ***/
|
|
if (x == -1)
|
|
{
|
|
value = 0;
|
|
px = 0;
|
|
}
|
|
else
|
|
{
|
|
value = 1;
|
|
px = x;
|
|
}
|
|
|
|
for (count = value; count < 2; count++)
|
|
{
|
|
/*** Draw the string ***/
|
|
for (i = 0; i < n; i++)
|
|
{
|
|
err = FT_Load_Char (face, text[i], FT_LOAD_RENDER);
|
|
|
|
if (err)
|
|
{
|
|
printf ("Error %c %d\n", text[i], err);
|
|
continue; /*** Skip unprintable characters ***/
|
|
}
|
|
|
|
if (count)
|
|
DrawCharacter (&slot->bitmap, px + slot->bitmap_left,
|
|
y - slot->bitmap_top);
|
|
|
|
px += slot->advance.x >> 6;
|
|
}
|
|
|
|
px = (640 - px) >> 1;
|
|
|
|
}
|
|
}
|
|
|
|
/**
|
|
* setfontcolour
|
|
*
|
|
* Uses RGB triple values.
|
|
*/
|
|
void
|
|
setfontcolour (u8 r, u8 g, u8 b)
|
|
{
|
|
u32 fontcolour;
|
|
|
|
fontcolour = getcolour (r, g, b);
|
|
fonthi = fontcolour & 0xffff0000;
|
|
fontlo = fontcolour & 0xffff;
|
|
}
|
|
|
|
/**
|
|
* Licence Information
|
|
*
|
|
* THIS MUST NOT BE REMOVED IN ANY DERIVATIVE WORK.
|
|
*/
|
|
void
|
|
licence ()
|
|
{
|
|
|
|
int ypos = ((screenheight - (282 + dkpro_HEIGHT)) >> 1);
|
|
|
|
if (screenheight == 480)
|
|
ypos += 42;
|
|
else
|
|
ypos += 24;
|
|
|
|
setfontcolour (0x00, 0x00, 0x00);
|
|
|
|
DrawText (-1, ypos += 40, "Snes9x - Copyright (c) Snes9x Team 1996 - 2006");
|
|
|
|
DrawText (-1, ypos += 40, "This is free software, and you are welcome to");
|
|
DrawText (-1, ypos += 20, "redistribute it under the conditions of the");
|
|
DrawText (-1, ypos += 20, "GNU GENERAL PUBLIC LICENSE Version 2");
|
|
DrawText (-1, ypos +=
|
|
20, "Additionally, the developers of this port disclaims");
|
|
DrawText (-1, ypos +=
|
|
20, "all copyright interests in the Nintendo GameCube");
|
|
DrawText (-1, ypos +=
|
|
20, "porting code. You are free to use it as you wish");
|
|
|
|
DrawText (-1, ypos += 40, "Developed with DevkitPPC and libOGC");
|
|
DrawText (-1, ypos += 20, "http://www.devkitpro.org");
|
|
|
|
}
|
|
|
|
/**
|
|
* dkunpack
|
|
*
|
|
* Support function to expand the DevkitPro logo
|
|
*/
|
|
int
|
|
dkunpack ()
|
|
{
|
|
unsigned long res, inbytes, outbytes;
|
|
|
|
inbytes = dkpro_COMPRESSED;
|
|
outbytes = dkpro_RAW;
|
|
dkproraw = (u32 *) malloc (dkpro_RAW + 16);
|
|
|
|
res = uncompress ((Bytef *) dkproraw, &outbytes, (Bytef *) dkpro, inbytes);
|
|
|
|
if (res == Z_OK)
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* showdklogo
|
|
*
|
|
* Display the DevkitPro logo
|
|
*/
|
|
void
|
|
showdklogo ()
|
|
{
|
|
int w, h, p, dispoffset;
|
|
p = 0;
|
|
dispoffset =
|
|
((screenheight != 480 ? 360 : 350) * 320) + ((640 - dkpro_WIDTH) >> 2);
|
|
|
|
dkunpack ();
|
|
|
|
for (h = 0; h < dkpro_HEIGHT; h++)
|
|
{
|
|
for (w = 0; w < dkpro_WIDTH >> 1; w++)
|
|
{
|
|
if (dkproraw[p] != 0x00800080)
|
|
xfb[whichfb][dispoffset + w] = dkproraw[p++];
|
|
else
|
|
p++;
|
|
}
|
|
|
|
dispoffset += 320;
|
|
}
|
|
|
|
free (dkproraw);
|
|
}
|
|
|
|
/**
|
|
* getcolour
|
|
*
|
|
* Simply converts RGB to Y1CbY2Cr format
|
|
*
|
|
* I got this from a pastebin, so thanks to whoever originally wrote it!
|
|
*/
|
|
|
|
unsigned int
|
|
getcolour (u8 r1, u8 g1, u8 b1)
|
|
{
|
|
int y1, cb1, cr1, y2, cb2, cr2, cb, cr;
|
|
u8 r2, g2, b2;
|
|
|
|
r2 = r1;
|
|
g2 = g1;
|
|
b2 = b1;
|
|
|
|
y1 = (299 * r1 + 587 * g1 + 114 * b1) / 1000;
|
|
cb1 = (-16874 * r1 - 33126 * g1 + 50000 * b1 + 12800000) / 100000;
|
|
cr1 = (50000 * r1 - 41869 * g1 - 8131 * b1 + 12800000) / 100000;
|
|
|
|
y2 = (299 * r2 + 587 * g2 + 114 * b2) / 1000;
|
|
cb2 = (-16874 * r2 - 33126 * g2 + 50000 * b2 + 12800000) / 100000;
|
|
cr2 = (50000 * r2 - 41869 * g2 - 8131 * b2 + 12800000) / 100000;
|
|
|
|
cb = (cb1 + cb2) >> 1;
|
|
cr = (cr1 + cr2) >> 1;
|
|
|
|
return ((y1 << 24) | (cb << 16) | (y2 << 8) | cr);
|
|
}
|
|
|
|
/**
|
|
* Unpackbackdrop
|
|
*/
|
|
void
|
|
unpackbackdrop ()
|
|
{
|
|
unsigned long res, inbytes, outbytes;
|
|
unsigned int colour;
|
|
int offset;
|
|
int i;
|
|
|
|
backdrop = (unsigned int *) malloc (screenheight * 1280);
|
|
colour = getcolour (0x00, 0x00, 0x00);
|
|
|
|
/*** Fill with black for now ***/
|
|
for (i = 0; i < (320 * screenheight); i++)
|
|
backdrop[i] = colour;
|
|
|
|
/*** If it's PAL50, need to move down a few lines ***/
|
|
offset = ((screenheight - 480) >> 1) * 320;
|
|
inbytes = tempgfx_COMPRESSED;
|
|
outbytes = tempgfx_RAW;
|
|
|
|
res =
|
|
uncompress ((Bytef *) backdrop + offset, &outbytes, (Bytef *) tempgfx,
|
|
inbytes);
|
|
|
|
/*** Now store the backdrop in ARAM ***/
|
|
ARAMPut ((char *) backdrop, (char *) AR_BACKDROP, 640 * screenheight * 2);
|
|
|
|
free (backdrop);
|
|
|
|
}
|
|
|
|
/**
|
|
* Display legal copyright and licence
|
|
*/
|
|
void
|
|
legal ()
|
|
{
|
|
unpackbackdrop ();
|
|
clearscreen ();
|
|
licence ();
|
|
showdklogo ();
|
|
showscreen ();
|
|
}
|
|
|
|
/**
|
|
* Wait for user to press A
|
|
*/
|
|
void
|
|
WaitButtonA ()
|
|
{
|
|
while (PAD_ButtonsDown (0) & PAD_BUTTON_A);
|
|
while (!(PAD_ButtonsDown (0) & PAD_BUTTON_A));
|
|
}
|
|
|
|
/**
|
|
* Wait for user to press A or B. Returns 0 = B; 1 = A
|
|
*/
|
|
int
|
|
WaitButtonAB ()
|
|
{
|
|
int btns;
|
|
|
|
while ( (PAD_ButtonsDown (0) & (PAD_BUTTON_A | PAD_BUTTON_B)) );
|
|
|
|
while ( TRUE )
|
|
{
|
|
btns = PAD_ButtonsDown (0);
|
|
if ( btns & PAD_BUTTON_A )
|
|
return 1;
|
|
else if ( btns & PAD_BUTTON_B )
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Show a prompt
|
|
*/
|
|
void
|
|
WaitPrompt (char *msg)
|
|
{
|
|
int ypos = (screenheight - 64) >> 1;
|
|
|
|
if (screenheight == 480)
|
|
ypos += 52;
|
|
else
|
|
ypos += 32;
|
|
|
|
clearscreen ();
|
|
DrawText (-1, ypos, msg);
|
|
ypos += 30;
|
|
DrawText (-1, ypos, "Press A to continue");
|
|
showscreen ();
|
|
WaitButtonA ();
|
|
}
|
|
|
|
/**
|
|
* Show a prompt with choice of two options. Returns 1 if A button was pressed
|
|
and 0 if B button was pressed.
|
|
*/
|
|
int
|
|
WaitPromptChoice (char *msg, char *bmsg, char *amsg)
|
|
{
|
|
int ypos = (screenheight - 64) >> 1;
|
|
|
|
if (screenheight == 480)
|
|
ypos += 37;
|
|
else
|
|
ypos += 17;
|
|
|
|
clearscreen ();
|
|
DrawText (-1, ypos, msg);
|
|
ypos += 60;
|
|
char txt[80];
|
|
sprintf (txt, "B = %s : A = %s", bmsg, amsg);
|
|
DrawText (-1, ypos, txt);
|
|
showscreen ();
|
|
return WaitButtonAB ();
|
|
}
|
|
|
|
/**
|
|
* Show an action in progress
|
|
*/
|
|
void
|
|
ShowAction (char *msg)
|
|
{
|
|
int ypos = (screenheight - 30) >> 1;
|
|
|
|
if (screenheight == 480)
|
|
ypos += 52;
|
|
else
|
|
ypos += 32;
|
|
|
|
clearscreen ();
|
|
DrawText (-1, ypos, msg);
|
|
showscreen ();
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Generic Menu Routines
|
|
****************************************************************************/
|
|
void
|
|
DrawMenu (char items[][20], char *title, int maxitems, int selected)
|
|
{
|
|
int i, w;
|
|
int ypos;
|
|
|
|
#if 0
|
|
int bounding[] = { 80, 40, 600, 40, 560, 94, 40, 94 };
|
|
int base[] = { 80, screenheight - 90, 600, screenheight - 90,
|
|
560, screenheight - 40, 40, screenheight - 40
|
|
};
|
|
#endif
|
|
|
|
ypos = (screenheight - (maxitems * 32)) >> 1;
|
|
|
|
if (screenheight == 480)
|
|
ypos += 52;
|
|
else
|
|
ypos += 32;
|
|
|
|
clearscreen ();
|
|
|
|
#if 0
|
|
DrawPolygon (4, bounding, 0x00, 0x00, 0xc0);
|
|
DrawPolygon (4, base, 0x00, 0x00, 0xc0);
|
|
setfontsize (32);
|
|
DrawText (-1, 80, title);
|
|
DrawText (-1, screenheight - 50, "Snes9x - GX 2.0");
|
|
#endif
|
|
|
|
setfontsize (24);
|
|
setfontcolour (0, 0, 0);
|
|
|
|
for (i = 0; i < maxitems; i++)
|
|
{
|
|
if (i == selected)
|
|
{
|
|
for( w = 0; w < 32; w++ )
|
|
DrawLineFast( 30, 610, (i << 5) + (ypos-26) + w, 0x80, 0x80, 0x80 );
|
|
|
|
setfontcolour (0xff, 0xff, 0xff);
|
|
DrawText (-1, (i << 5) + ypos, items[i]);
|
|
setfontcolour (0x00, 0x00, 0x00);
|
|
}
|
|
else
|
|
DrawText (-1, i * 32 + ypos, items[i]);
|
|
}
|
|
|
|
showscreen ();
|
|
|
|
}
|
|
|
|
/****************************************************************************
|
|
* RunMenu
|
|
*
|
|
* Call this with the menu array defined in menu.cpp
|
|
* It's here to keep all the font / interface stuff together.
|
|
****************************************************************************/
|
|
int menu = 0;
|
|
int
|
|
RunMenu (char items[][20], int maxitems, char *title)
|
|
{
|
|
int redraw = 1;
|
|
int quit = 0;
|
|
short p;
|
|
int ret = 0;
|
|
signed char a;
|
|
|
|
//while (!(PAD_ButtonsDown (0) & PAD_BUTTON_B) && (quit == 0))
|
|
while (quit == 0)
|
|
{
|
|
if (redraw)
|
|
{
|
|
DrawMenu (&items[0], title, maxitems, menu);
|
|
redraw = 0;
|
|
}
|
|
|
|
p = PAD_ButtonsDown (0);
|
|
a = PAD_StickY (0);
|
|
|
|
/*** Look for up ***/
|
|
if ((p & PAD_BUTTON_UP) || (a > 70))
|
|
{
|
|
redraw = 1;
|
|
menu--;
|
|
}
|
|
|
|
/*** Look for down ***/
|
|
if ((p & PAD_BUTTON_DOWN) || (a < -70))
|
|
{
|
|
redraw = 1;
|
|
menu++;
|
|
}
|
|
|
|
if (p & PAD_BUTTON_A)
|
|
{
|
|
quit = 1;
|
|
ret = menu;
|
|
}
|
|
|
|
if (p & PAD_BUTTON_B)
|
|
{
|
|
quit = -1;
|
|
ret = -1;
|
|
}
|
|
|
|
if (menu == maxitems)
|
|
menu = 0;
|
|
|
|
if (menu < 0)
|
|
menu = maxitems - 1;
|
|
}
|
|
|
|
if (PAD_ButtonsDown (0) & PAD_BUTTON_B)
|
|
{
|
|
/*** Wait for B button to be released before proceeding ***/
|
|
while (PAD_ButtonsDown (0) & PAD_BUTTON_B)
|
|
VIDEO_WaitVSync();
|
|
return -1;
|
|
}
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
/****************************************************************************
|
|
* DrawLine
|
|
*
|
|
* Quick'n'Dirty Bresenham line drawing routine.
|
|
****************************************************************************/
|
|
#define SIGN(x) ((x<0)?-1:((x>0)?1:0))
|
|
|
|
void
|
|
DrawLine (int x1, int y1, int x2, int y2, u8 r, u8 g, u8 b)
|
|
{
|
|
u32 colour, pixel;
|
|
u32 colourhi, colourlo;
|
|
int i, dx, dy, sdx, sdy, dxabs, dyabs, x, y, px, py;
|
|
int sp;
|
|
|
|
colour = getcolour (r, g, b);
|
|
colourhi = colour & 0xffff0000;
|
|
colourlo = colour & 0xffff;
|
|
|
|
dx = x2 - x1; /*** Horizontal distance ***/
|
|
dy = y2 - y1; /*** Vertical distance ***/
|
|
|
|
dxabs = abs (dx);
|
|
dyabs = abs (dy);
|
|
sdx = SIGN (dx);
|
|
sdy = SIGN (dy);
|
|
x = dyabs >> 1;
|
|
y = dxabs >> 1;
|
|
px = x1;
|
|
py = y1;
|
|
|
|
sp = (py * 320) + (px >> 1);
|
|
pixel = xfb[whichfb][sp];
|
|
/*** Plot this pixel ***/
|
|
if (px & 1)
|
|
xfb[whichfb][sp] = (pixel & 0xffff0000) | colourlo;
|
|
else
|
|
xfb[whichfb][sp] = (pixel & 0xffff) | colourhi;
|
|
|
|
if (dxabs >= dyabs) /*** Mostly horizontal ***/
|
|
{
|
|
for (i = 0; i < dxabs; i++)
|
|
{
|
|
y += dyabs;
|
|
if (y >= dxabs)
|
|
{
|
|
y -= dxabs;
|
|
py += sdy;
|
|
}
|
|
|
|
px += sdx;
|
|
|
|
sp = (py * 320) + (px >> 1);
|
|
pixel = xfb[whichfb][sp];
|
|
|
|
if (px & 1)
|
|
xfb[whichfb][sp] = (pixel & 0xffff0000) | colourlo;
|
|
else
|
|
xfb[whichfb][sp] = (pixel & 0xffff) | colourhi;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
for (i = 0; i < dyabs; i++)
|
|
{
|
|
x += dxabs;
|
|
if (x >= dyabs)
|
|
{
|
|
x -= dyabs;
|
|
px += sdx;
|
|
}
|
|
|
|
py += sdy;
|
|
|
|
sp = (py * 320) + (px >> 1);
|
|
pixel = xfb[whichfb][sp];
|
|
|
|
if (px & 1)
|
|
xfb[whichfb][sp] = (pixel & 0xffff0000) | colourlo;
|
|
else
|
|
xfb[whichfb][sp] = (pixel & 0xffff) | colourhi;
|
|
}
|
|
}
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Progress Bar
|
|
*
|
|
* Show the user what's happening
|
|
****************************************************************************/
|
|
void
|
|
ShowProgress (char *msg, int done, int total)
|
|
{
|
|
int ypos = (screenheight - 30) >> 1;
|
|
|
|
if (screenheight == 480)
|
|
ypos += 52;
|
|
else
|
|
ypos += 32;
|
|
|
|
int xpos;
|
|
int i;
|
|
|
|
clearscreen ();
|
|
DrawText (-1, ypos, msg);
|
|
|
|
/*** Draw a white outline box ***/
|
|
for (i = 380; i < 401; i++)
|
|
DrawLine (100, i, 540, i, 0xff, 0xff, 0xff);
|
|
|
|
/*** Show progess ***/
|
|
xpos = (int) (((float) done / (float) total) * 438);
|
|
|
|
for (i = 381; i < 400; i++)
|
|
DrawLine (101, i, 101 + xpos, i, 0x00, 0x00, 0x80);
|
|
|
|
showscreen ();
|
|
}
|
|
|
|
/****************************************************************************
|
|
* DrawPolygon
|
|
****************************************************************************/
|
|
void
|
|
DrawPolygon (int vertices, int varray[], u8 r, u8 g, u8 b)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < vertices - 1; i++)
|
|
{
|
|
DrawLine (varray[(i << 1)], varray[(i << 1) + 1], varray[(i << 1) + 2],
|
|
varray[(i << 1) + 3], r, g, b);
|
|
}
|
|
|
|
DrawLine (varray[0], varray[1], varray[(vertices << 1) - 2],
|
|
varray[(vertices << 1) - 1], r, g, b);
|
|
}
|
|
|
|
/*****************************************************************************
|
|
* Draw Line Fast
|
|
*
|
|
* This routine requires that start and endx are 32bit aligned.
|
|
* It tries to perform a semi-transparency over the existing image.
|
|
*****************************************************************************/
|
|
|
|
#define SRCWEIGHT 0.7f
|
|
#define DSTWEIGHT (1.0f - SRCWEIGHT)
|
|
|
|
static inline u8 c_adjust( u8 c , float weight )
|
|
{
|
|
return (u8)((float)c * weight);
|
|
}
|
|
|
|
void DrawLineFast( int startx, int endx, int y, u8 r, u8 g, u8 b )
|
|
{
|
|
int width;
|
|
u32 offset;
|
|
int i;
|
|
u32 colour, clo, chi;
|
|
u32 lo,hi;
|
|
u8 *s, *d;
|
|
|
|
//colour = getcolour(r, g, b);
|
|
colour = ( r << 16 | g << 8 | b );
|
|
d = (u8 *)&colour;
|
|
d[1] = c_adjust(d[1], DSTWEIGHT);
|
|
d[2] = c_adjust(d[2], DSTWEIGHT);
|
|
d[3] = c_adjust(d[3], DSTWEIGHT);
|
|
|
|
width = ( endx - startx ) >> 1;
|
|
offset = ( y << 8 ) + ( y << 6 ) + ( startx >> 1 );
|
|
|
|
for ( i = 0; i < width; i++ )
|
|
{
|
|
lo = getrgb(xfb[whichfb][offset], 0);
|
|
hi = getrgb(xfb[whichfb][offset], 1);
|
|
|
|
s = (u8 *)&hi;
|
|
s[1] = ( ( c_adjust(s[1],SRCWEIGHT) ) + d[1] );
|
|
s[2] = ( ( c_adjust(s[2],SRCWEIGHT) ) + d[2] );
|
|
s[3] = ( ( c_adjust(s[3],SRCWEIGHT) ) + d[3] );
|
|
|
|
s = (u8 *)&lo;
|
|
s[1] = ( ( c_adjust(s[1],SRCWEIGHT) ) + d[1] );
|
|
s[2] = ( ( c_adjust(s[2],SRCWEIGHT) ) + d[2] );
|
|
s[3] = ( ( c_adjust(s[3],SRCWEIGHT) ) + d[3] );
|
|
|
|
clo = getcolour( s[1], s[2], s[3] );
|
|
s = (u8 *)&hi;
|
|
chi = getcolour( s[1], s[2], s[3] );
|
|
|
|
xfb[whichfb][offset++] = (chi & 0xffff0000 ) | ( clo & 0xffff) ;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Ok, I'm useless with Y1CBY2CR colour.
|
|
* So convert back to RGB so I can work with it -;)
|
|
*/
|
|
u32 getrgb( u32 ycbr, u32 low )
|
|
{
|
|
u8 r,g,b;
|
|
u32 y;
|
|
s8 cb,cr;
|
|
|
|
if ( low )
|
|
y = ( ycbr & 0xff00 ) >> 8;
|
|
else
|
|
y = ( ycbr & 0xff000000 ) >> 24;
|
|
|
|
cr = ycbr & 0xff;
|
|
cb = ( ycbr & 0xff0000 ) >> 16;
|
|
|
|
cr -= 128;
|
|
cb -= 128;
|
|
|
|
r = (u8)((float)y + 1.371 * (float)cr);
|
|
g = (u8)((float)y - 0.698 * (float)cr - 0.336 * (float)cb);
|
|
b = (u8)((float)y + 1.732 * (float)cb);
|
|
|
|
return (u32)( r << 16 | g << 8 | b );
|
|
|
|
}
|
|
|
|
|