romdev-mcp 0.1.1

package/src/platforms/gba/lib/libgba/src/disc_io/io_scsd_s.s

@@ -0,0 +1,139 @@
+@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
+@	io_scsd_s.s
+@
+@	Hardware Routines for reading a Secure Digital card
+@	using the SC SD
+@	
+@	Based on code supplied by Romman
+@
+@ Copyright (c) 2006 Michael "Chishm" Chisholm
+@	
+@ Redistribution and use in source and binary forms, with or without modification,
+@ are permitted provided that the following conditions are met:
+@
+@  1. Redistributions of source code must retain the above copyright notice,
+@     this list of conditions and the following disclaimer.
+@  2. Redistributions in binary form must reproduce the above copyright notice,
+@     this list of conditions and the following disclaimer in the documentation and/or
+@     other materials provided with the distribution.
+@  3. The name of the author may not be used to endorse or promote products derived
+@     from this software without specific prior written permission.
+@
+@ THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
+@ WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY
+@ AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE
+@ LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+@ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
+@ LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+@ THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+@ (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+@ EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+@
+@	2006-07-22 - Chishm
+@		* First release of stable code
+@
+@	2006-08-19 - Chishm
+@		* Added SuperCard Lite support
+@
+@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
+
+    .align 4
+	.arm
+	
+	.equ	REG_SCSD_DATAWRITE,	0x09000000
+	.equ	BYTES_PER_READ,	0x200
+	.equ	SCSD_STS_BUSY,	0x100
+	.equ	BUSY_WAIT_TIMEOUT, 0x10000
+	.equ	FALSE,	0
+	.equ	TRUE,	1
+
+@ bool _SCSD_writeData_s (u8 *data, u16* crc)
+
+    .global _SCSD_writeData_s
+	
+_SCSD_writeData_s:
+	stmfd   r13!, {r4-r5}
+	mov		r5, #BYTES_PER_READ
+	mov		r2, #REG_SCSD_DATAWRITE
+
+@ Wait for a free data buffer on the SD card
+	mov		r4, #BUSY_WAIT_TIMEOUT
+_SCSD_writeData_busy_wait:
+	@ Test for timeout
+	subs	r4, r4, #1
+	moveq	r0, #FALSE			@ return false on failure
+	beq		_SCSD_writeData_return
+	@ Check the busy bit of the status register
+	ldrh	r3, [r2]   
+	tst		r3,	#SCSD_STS_BUSY
+	beq		_SCSD_writeData_busy_wait
+
+	ldrh	r3, [r2]   			@ extra clock
+
+	mov		r3, #0 				@ start bit
+	strh	r3,[r2]
+	
+@ Check if the data buffer is aligned on a halfword boundary
+	tst		r0, #1
+	beq		_SCSD_writeData_data_loop
+	
+@ Used when the source data is unaligned
+_SCSD_writeData_data_loop_unaligned:
+		ldrb	r3, [r0], #1
+		ldrb	r4, [r0], #1
+		orr		r3, r3, r4, lsl #8
+		stmia   r2, {r3-r4}  
+	subs    r5, r5, #2                 
+    bne     _SCSD_writeData_data_loop_unaligned
+	b		_SCSD_writeData_crc
+	
+@ Write the data to the card
+@ 4 halfwords are transmitted to the Supercard at once, for timing purposes
+@ Only the first halfword needs to contain data for standard SuperCards
+@ For the SuperCard Lite, the data is split into 4 nibbles, one per halfword
+_SCSD_writeData_data_loop:
+		ldrh	r3, [r0], #2
+		
+@ This bit added for SCLite. Notice that the shift is not the same as in 
+@ the original (buggy) code supplied by Romman
+		add	r3, r3, r3, lsl #20
+		mov	r4, r3, lsr #8
+		
+		stmia   r2, {r3-r4}  
+		
+	subs    r5, r5, #2                 
+    bne     _SCSD_writeData_data_loop 
+	
+@ Send the data CRC
+_SCSD_writeData_crc:
+	cmp		r1, #0
+	movne	r0, r1
+	movne	r1, #0
+	movne	r5, #8
+	bne		_SCSD_writeData_data_loop 
+
+	mov		r3, #0xff 			@ end bit
+	strh	r3, [r2]
+
+@ Wait for the SD card to signal that it is finished recieving
+	mov		r4, #BUSY_WAIT_TIMEOUT
+_SCSD_writeData_finished_wait:
+	@ Test for timeout
+	subs	r4, r4, #1
+	moveq	r0, #FALSE			@ return false on failure
+	beq		_SCSD_writeData_return
+	@ Check the busy bit of the status register
+	ldrh	r3, [r2]   
+	tst		r3, #0x100
+	bne		_SCSD_writeData_finished_wait
+
+@ Send 8 more clocks, as required by the SD card
+	ldmia   r2, {r3-r4} 
+
+@ return true for success
+	mov 	r0, #TRUE
+	
+_SCSD_writeData_return:
+	ldmfd	r13!,{r4-r5}
+	bx      r14
+

package/src/platforms/gba/lib/libgba/src/disc_io/io_sd_common.c

@@ -0,0 +1,203 @@
+/*
+	io_sd_common.c
+
+	By chishm (Michael Chisholm)
+
+	Common SD card routines
+
+	SD routines partially based on sd.s by Romman 
+
+ Copyright (c) 2006 Michael "Chishm" Chisholm
+	
+ Redistribution and use in source and binary forms, with or without modification,
+ are permitted provided that the following conditions are met:
+
+  1. Redistributions of source code must retain the above copyright notice,
+     this list of conditions and the following disclaimer.
+  2. Redistributions in binary form must reproduce the above copyright notice,
+     this list of conditions and the following disclaimer in the documentation and/or
+     other materials provided with the distribution.
+  3. The name of the author may not be used to endorse or promote products derived
+     from this software without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
+ WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY
+ AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE
+ LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
+ LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#include "io_sd_common.h"
+
+#define MAX_STARTUP_TRIES 1000	// Arbitrary value, check if the card is ready 20 times before giving up
+#define RESPONSE_TIMEOUT 256	// Number of clocks sent to the SD card before giving up
+
+/*
+Improved CRC7 function provided by cory1492
+Calculates the CRC of an SD command, and includes the end bit in the byte
+*/
+u8 _SD_CRC7(u8* data, int cnt) {
+    int i, a;
+    u8 crc, temp;
+
+    crc = 0;
+    for (a = 0; a < cnt; a++)
+    {
+        temp = data[a];
+        for (i = 0; i < 8; i++)
+        {
+            crc <<= 1;
+            if ((temp & 0x80) ^ (crc & 0x80)) crc ^= 0x09;
+            temp <<= 1;
+        }
+    }
+    crc = (crc << 1) | 1;
+    return(crc);
+} 
+
+/*
+Calculates the CRC16 for a sector of data. Calculates it 
+as 4 separate lots, merged into one buffer. This is used
+for 4 SD data lines, not for 1 data line alone.
+*/
+void _SD_CRC16 (u8* buff, int buffLength, u8* crc16buff) {
+	u32 a, b, c, d;
+	int count;
+	u32 bitPattern = 0x80808080;	// r7
+	u32 crcConst = 0x1021;	// r8
+	u32 dataByte = 0;	// r2
+
+	a = 0;	// r3
+	b = 0;	// r4
+	c = 0;	// r5
+	d = 0;	// r6
+	
+	buffLength = buffLength * 8;
+	
+	
+	do {
+		if (bitPattern & 0x80) dataByte = *buff++;
+		
+		a = a << 1;
+		if ( a & 0x10000) a ^= crcConst;
+		if (dataByte & (bitPattern >> 24)) a ^= crcConst;
+		
+		b = b << 1;
+		if (b & 0x10000) b ^= crcConst;
+		if (dataByte & (bitPattern >> 25)) b ^= crcConst;
+	
+		c = c << 1;
+		if (c & 0x10000) c ^= crcConst;
+		if (dataByte & (bitPattern >> 26)) c ^= crcConst;
+		
+		d = d << 1;
+		if (d & 0x10000) d ^= crcConst;
+		if (dataByte & (bitPattern >> 27)) d ^= crcConst;
+		
+		bitPattern = (bitPattern >> 4) | (bitPattern << 28);
+	} while (buffLength-=4);
+	
+	count = 16;	// r8
+	
+	do {
+		bitPattern = bitPattern << 4;
+		if (a & 0x8000) bitPattern |= 8;
+		if (b & 0x8000) bitPattern |= 4;
+		if (c & 0x8000) bitPattern |= 2;
+		if (d & 0x8000) bitPattern |= 1;
+	
+		a = a << 1;
+		b = b << 1;
+		c = c << 1;
+		d = d << 1;
+		
+		count--;
+		
+		if (!(count & 0x01)) {
+			*crc16buff++ = (u8)(bitPattern & 0xff);
+		}
+	} while (count != 0);
+	
+	return;
+}
+
+/*
+Initialise the SD card, after it has been sent into an Idle state
+cmd_6byte_response: a pointer to a function that sends the SD card a command and gets a 6 byte response
+cmd_17byte_response: a pointer to a function that sends the SD card a command and gets a 17 byte response
+use4bitBus: initialise card to use a 4 bit data bus when communicating with the card
+RCA: a pointer to the location to store the card's Relative Card Address, preshifted up by 16 bits.
+*/
+bool _SD_InitCard (_SD_FN_CMD_6BYTE_RESPONSE cmd_6byte_response, 
+					_SD_FN_CMD_17BYTE_RESPONSE cmd_17byte_response,
+					bool use4bitBus,
+					u32 *RCA)
+{
+	u8 responseBuffer[17] = {0};
+	int i;
+	
+	for (i = 0; i < MAX_STARTUP_TRIES ; i++) {
+		cmd_6byte_response (responseBuffer, APP_CMD, 0);
+		// Check that the card gave the correct response
+		if (responseBuffer[0] != APP_CMD) {
+			return false;
+		}
+		if ( 
+			cmd_6byte_response (responseBuffer, SD_APP_OP_COND, SD_OCR_VALUE) &&
+			((responseBuffer[1] & 0x80) != 0))
+		{	
+			// Card is ready to receive commands now
+			break;
+		}
+	}
+	if (i >= MAX_STARTUP_TRIES) {
+		return false;
+	}
+ 
+	// The card's name, as assigned by the manufacturer
+	cmd_17byte_response (responseBuffer, ALL_SEND_CID, 0);
+ 
+	// Get a new address
+	for (i = 0; i < MAX_STARTUP_TRIES ; i++) {
+		cmd_6byte_response (responseBuffer, SEND_RELATIVE_ADDR, 0);
+		*RCA = (responseBuffer[1] << 24) | (responseBuffer[2] << 16);
+		if ((responseBuffer[3] & 0x1e) != (SD_STATE_STBY << 1)) {
+			break;
+		}
+	}
+ 	if (i >= MAX_STARTUP_TRIES) {
+		return false;
+	}
+
+	// Some cards won't go to higher speeds unless they think you checked their capabilities
+	cmd_17byte_response (responseBuffer, SEND_CSD, *RCA);
+ 
+	// Only this card should respond to all future commands
+	cmd_6byte_response (responseBuffer, SELECT_CARD, *RCA);
+ 
+	if (use4bitBus) {
+		// Set a 4 bit data bus
+		cmd_6byte_response (responseBuffer, APP_CMD, *RCA);
+		cmd_6byte_response (responseBuffer, SET_BUS_WIDTH, 2); // 4-bit mode.
+	}
+
+	// Use 512 byte blocks
+	cmd_6byte_response (responseBuffer, SET_BLOCKLEN, 512); // 512 byte blocks
+	
+	// Wait until card is ready for data
+	i = 0;
+	do {
+		if (i >= RESPONSE_TIMEOUT) {
+			return false;
+		}
+		i++;
+	} while (!cmd_6byte_response (responseBuffer, SEND_STATUS, *RCA) && ((responseBuffer[3] & 0x1f) != ((SD_STATE_TRAN << 1) | READY_FOR_DATA)));
+ 
+	return true;
+}
+
+

package/src/platforms/gba/lib/libgba/src/disc_io/io_sd_common.h

@@ -0,0 +1,108 @@
+/*
+ io_sd_common.h
+
+ By chishm (Michael Chisholm)
+
+ Common SD card routines
+
+ SD routines partially based on sd.s by Romman
+
+ Copyright (c) 2006 Michael "Chishm" Chisholm
+	
+ Redistribution and use in source and binary forms, with or without modification,
+ are permitted provided that the following conditions are met:
+
+  1. Redistributions of source code must retain the above copyright notice,
+     this list of conditions and the following disclaimer.
+  2. Redistributions in binary form must reproduce the above copyright notice,
+     this list of conditions and the following disclaimer in the documentation and/or
+     other materials provided with the distribution.
+  3. The name of the author may not be used to endorse or promote products derived
+     from this software without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
+ WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY
+ AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE
+ LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
+ LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#ifndef IO_SD_COMMON_H
+#define IO_SD_COMMON_H
+
+#include <disc_io.h>
+
+/* SD commands */
+#define GO_IDLE_STATE 0
+#define ALL_SEND_CID 2
+#define SEND_RELATIVE_ADDR 3
+#define SELECT_CARD 7
+#define SEND_CSD 9
+#define STOP_TRANSMISSION 12
+#define SEND_STATUS 13
+#define GO_INACTIVE_STATE 15
+#define SET_BLOCKLEN 16
+#define READ_SINGLE_BLOCK 17
+#define READ_MULTIPLE_BLOCK 18
+#define WRITE_BLOCK 24
+#define WRITE_MULTIPLE_BLOCK 25
+#define APP_CMD 55
+
+/* SD App commands */
+#define SET_BUS_WIDTH 6
+#define SD_APP_OP_COND 41
+
+/* OCR (Operating Conditions Register) send value */
+#define SD_OCR_VALUE 0x00030000 /* 2.8V to 3.0V */
+//#define SD_OCR_VALUE 0x003F8000 /* 2.7V to 3.4V */
+//#define SD_OCR_VALUE 0x00FC0000
+
+/* SD Data repsonses */
+#define SD_CARD_BUSY 0xff
+
+/* SD states */
+#define SD_STATE_IDLE 0		// Idle state, after power on or GO_IDLE_STATE command
+#define SD_STATE_READY 1	// Ready state, after card replies non-busy to SD_APP_OP_COND
+#define SD_STATE_IDENT 2	// Identification state, after ALL_SEND_CID
+#define SD_STATE_STBY 3		// Standby state, when card is deselected
+#define SD_STATE_TRAN 4		// Transfer state, after card is selected and ready for data transfer
+#define SD_STATE_DATA 5		// 
+#define SD_STATE_RCV 6		// Receive data state
+#define SD_STATE_PRG 7		// Programming state
+#define SD_STATE_DIS 8		// Disconnect state
+#define SD_STATE_INA 9		// Inactive state, after GO_INACTIVE_STATE
+
+#define READY_FOR_DATA 1	// bit 8 in card status
+
+/*
+Calculate the CRC7 of a command and return it preshifted with 
+an end bit added
+*/
+extern u8 _SD_CRC7(u8* data, int size);
+
+/*
+Calculate the CRC16 of a block of data, ready for transmission on
+four data lines at once
+*/
+extern void _SD_CRC16 (u8* buff, int buffLength, u8* crc16buff);
+
+typedef bool (*_SD_FN_CMD_6BYTE_RESPONSE) (u8* responseBuffer, u8 command, u32 data);
+typedef bool (*_SD_FN_CMD_17BYTE_RESPONSE) (u8* responseBuffer, u8 command, u32 data);
+
+/*
+Initialise the SD card, after it has been sent into an Idle state
+cmd_6byte_response: a pointer to a function that sends the SD card a command and gets a 6 byte response
+cmd_17byte_response: a pointer to a function that sends the SD card a command and gets a 17 byte response
+use4bitBus: initialise card to use a 4 bit data bus when communicating with the card
+RCA: a pointer to the location to store the card's Relative Card Address, preshifted up by 16 bits.
+*/
+extern bool _SD_InitCard (_SD_FN_CMD_6BYTE_RESPONSE cmd_6byte_response, 
+							_SD_FN_CMD_17BYTE_RESPONSE cmd_17byte_response,
+							bool use4bitBus,
+							u32 *RCA);
+
+#endif // define IO_SD_COMMON_H

package/src/platforms/gba/lib/libgba/src/fade.c

@@ -0,0 +1,185 @@
+/*
+
+	libgba 256 color fade routines
+
+	Copyright 2003-2004 by Dave Murphy.
+
+	This library is free software; you can redistribute it and/or
+	modify it under the terms of the GNU Library General Public
+	License as published by the Free Software Foundation; either
+	version 2 of the License, or (at your option) any later version.
+
+	This library is distributed in the hope that it will be useful,
+	but WITHOUT ANY WARRANTY; without even the implied warranty of
+	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+	Library General Public License for more details.
+
+	You should have received a copy of the GNU Library General Public
+	License along with this library; if not, write to the Free Software
+	Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
+	USA.
+
+	Please report all bugs and problems through the bug tracker at
+	"http://sourceforge.net/tracker/?group_id=114505&atid=668551".
+
+
+*/
+
+/*---------------------------------------------------------------------------------
+	Fade to black implemented as a special case
+	Calling FadeToPalette with a buffer of all zeros will do the same thing
+
+	FadeToPalette will also perform a cross fade effect
+
+---------------------------------------------------------------------------------*/
+#include <gba_video.h>
+#include <gba_systemcalls.h>
+#include <fade.h>
+
+//---------------------------------------------------------------------------------
+// Global variables
+//---------------------------------------------------------------------------------
+u16 CurrentPalette[512] EWRAM_BSS;
+
+//---------------------------------------------------------------------------------
+// fade table consists of color components & offsets in 8:8 form
+// Red offset, Red component ...
+//---------------------------------------------------------------------------------
+s16 FadeTable[512*3*2] EWRAM_BSS;
+
+//---------------------------------------------------------------------------------
+static void GetCurrentPalette() {
+//---------------------------------------------------------------------------------
+	int i;
+	u16 * Src = BG_COLORS;
+	u16 * Dest = (u16 *)CurrentPalette;
+	for (i = 0; i<512; i++) {
+		*(Dest++) = *(Src++);
+	}
+}
+
+//---------------------------------------------------------------------------------
+void SetPalette(u16 *Palette) {
+//---------------------------------------------------------------------------------
+	u16 *From, *To;
+	From = (u16 *)Palette;
+	To = (u16 *)BG_COLORS;
+	int i;
+
+	for (i = 0; i<512; i++) {
+		*(To++) = *(From++);
+	}
+}
+
+//---------------------------------------------------------------------------------
+static void DoFade(u32 FadeCount) {
+//---------------------------------------------------------------------------------
+	int r,g,b,index,count,color;
+
+
+	for (count=0; count<FadeCount;count++) {
+		s16 *Src = FadeTable;
+		u16 *Dest = CurrentPalette;
+
+		for (index=0; index<512;index++) {
+			r = *(Src++);
+			r += *(Src);
+			*(Src++)=r;
+
+			g = *(Src++);
+			g += *(Src);
+			*(Src++)=g;
+
+			b = *(Src++);
+			b += *(Src);
+			*(Src++)=b;
+
+			color = (r>>8) | ((g>>8)<<5) | ((b>>8)<<10);
+			*(Dest++) = color;
+		}
+
+		VBlankIntrWait();
+		SetPalette(CurrentPalette);
+	}
+}
+
+//---------------------------------------------------------------------------------
+/// Fade to a shade of grey
+//---------------------------------------------------------------------------------
+/**	Special case function for fade to Grey
+	gray = 0 - 31 - final value of all components
+*/
+//---------------------------------------------------------------------------------
+void FadeToGrayScale(int gray, int FrameCount) {
+//---------------------------------------------------------------------------------
+	int index,r,g,b,color;
+	u16 *Src;
+	s16 *Table;
+
+	GetCurrentPalette();
+	Src = CurrentPalette;
+	Table = FadeTable;
+
+	for (index=0;index<512; index++) {
+
+		color = *(Src++);
+		r = (color & 0x1f) << 8;
+		g = (color>>5 & 0x1f) << 8;
+		b = (color>>10 & 0x1f) << 8;
+
+		*Table++ = ((gray<<8)-r) / FrameCount;
+		*Table++ = r;
+
+		*Table++ = ((gray<<8)-g) / FrameCount;
+		*Table++ = g;
+
+		*Table++ = ((gray<<8)-b) / FrameCount;
+		*Table++ = b;
+	}
+
+	DoFade( FrameCount);
+}
+
+//---------------------------------------------------------------------------------
+/// Fade to a specific palette
+//---------------------------------------------------------------------------------
+void FadeToPalette(const u16 *NewPalette, int FrameCount) {
+//---------------------------------------------------------------------------------
+	int index;
+	GetCurrentPalette();
+
+	u16 *Src;
+	u16 *Dest;
+	s16 *Table;
+
+	u16 color;
+	s16 r1,r2,g1,g2,b1,b2;
+
+	Src = CurrentPalette;
+	Dest = (u16 *)NewPalette;
+	Table = FadeTable;
+
+	for (index=0;index<512; index++) {
+
+		color = *(Src++);
+		r1 = (color & 0x1f) << 8;				// get component & convert to 8:8
+		g1 = (color>>5 & 0x1f) << 8;
+		b1 = (color>>10 & 0x1f) << 8;
+
+		color = *(Dest++);
+		r2 = (color & 0x1f) << 8;
+		g2 = (color>>5 & 0x1f) << 8;
+		b2 = (color>>10 & 0x1f) << 8;
+
+		*(Table++) = (r2 - r1) / FrameCount;	// Set component Delta
+		*(Table++) = r1;						// Set component start value
+		*(Table++) = (g2 - g1) / FrameCount;
+		*(Table++) = g1;
+		*(Table++) = (b2 - b1) / FrameCount;
+		*(Table++) = b1;
+	}
+
+	DoFade(FrameCount);
+
+}
+