mirror of
https://github.com/wiidev/usbloadergx.git
synced 2024-11-09 13:05:24 +01:00
455 lines
8.1 KiB
C++
455 lines
8.1 KiB
C++
/****************************************************************************
|
|
* Copyright (C) 2012 giantpune
|
|
*
|
|
* 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 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program 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 General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
****************************************************************************/
|
|
#include "ash.h"
|
|
#include "gecko.h"
|
|
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
//#include <memory.h>
|
|
#include <malloc.h>
|
|
#include <string.h>
|
|
|
|
|
|
|
|
bool IsAshCompressed( const u8 *stuff, u32 len )
|
|
{
|
|
return ( len > 0x10 &&
|
|
((*(u32*)( stuff )) & 0xFFFFFF00 ) == 0x41534800 );
|
|
}
|
|
|
|
u8* DecompressAsh( const u8 *stuff, u32 &len )
|
|
{
|
|
if( !IsAshCompressed( stuff, len ) )
|
|
{
|
|
return NULL;
|
|
}
|
|
|
|
unsigned int r[32];
|
|
unsigned int count = 0;
|
|
unsigned int t;
|
|
|
|
r[4] = (u32)stuff; //in
|
|
|
|
r[5] = 0x415348;
|
|
r[6] = 0x415348;
|
|
|
|
r[5] = s32(*(unsigned int *)(r[4]+4));
|
|
r[5] = r[5] & 0x00FFFFFF;
|
|
|
|
u32 size = r[5];
|
|
//gprintf("Decompressed size: %d\n", size);
|
|
u8* buf1 = (u8*)memalign( 32, size );
|
|
if( !buf1 )
|
|
{
|
|
gprintf( "ASH: no memory\n" );
|
|
return NULL;
|
|
}
|
|
r[3] = (u32)buf1; //out
|
|
memset( (void*)buf1, 0, size );
|
|
//printf("r[3] :%08X\n", r[3]);
|
|
|
|
//printf("\n\n");
|
|
|
|
r[24] = 0x10;
|
|
r[28] = s32(*(unsigned int *)(r[4]+8));
|
|
r[25] = 0;
|
|
r[29] = 0;
|
|
r[26] = s32(*(unsigned int *)(r[4]+0xC));
|
|
r[30] = s32(*(unsigned int *)(r[4]+r[28]));
|
|
r[28] = r[28] + 4;
|
|
//r[8] = 0x8108<<16;
|
|
//HACK, pointer to RAM
|
|
u8* workingBuffer = (u8*)memalign( 32, 0x100000 );
|
|
if( !workingBuffer )
|
|
{
|
|
gprintf( "ASH: no memory 2\n" );
|
|
free( buf1 );
|
|
return NULL;
|
|
}
|
|
r[8] = (u32)workingBuffer;
|
|
memset( (void*)workingBuffer, 0, 0x100000 );
|
|
//printf("r[8] :%08X\n", r[8]);
|
|
|
|
r[9] = r[8] + 0x07FE;
|
|
r[10] = r[9] + 0x07FE;
|
|
r[11] = r[10] + 0x1FFE;
|
|
r[31] = r[11] + 0x1FFE;
|
|
r[23] = 0x200;
|
|
r[22] = 0x200;
|
|
r[27] = 0;
|
|
|
|
loc_81332124:
|
|
|
|
if( r[25] != 0x1F )
|
|
goto loc_81332140;
|
|
|
|
r[0] = r[26] >> 31;
|
|
r[26]= s32(*(unsigned int *)(r[4] + r[24]));
|
|
r[25]= 0;
|
|
r[24]= r[24] + 4;
|
|
goto loc_8133214C;
|
|
|
|
loc_81332140:
|
|
|
|
r[0] = r[26] >> 31;
|
|
r[25]= r[25] + 1;
|
|
r[26]= r[26] << 1;
|
|
|
|
loc_8133214C:
|
|
|
|
if( r[0] == 0 )
|
|
goto loc_81332174;
|
|
|
|
r[0] = r[23] | 0x8000;
|
|
*(unsigned short *)(r[31]) = s16(r[0]);
|
|
r[0] = r[23] | 0x4000;
|
|
*(unsigned short *)(r[31]+2) = s16(r[0]);
|
|
|
|
r[31] = r[31] + 4;
|
|
r[27] = r[27] + 2;
|
|
r[23] = r[23] + 1;
|
|
r[22] = r[22] + 1;
|
|
|
|
goto loc_81332124;
|
|
|
|
loc_81332174:
|
|
|
|
r[12] = 9;
|
|
r[21] = r[25] + r[12];
|
|
t = r[21];
|
|
if( r[21] > 0x20 )
|
|
goto loc_813321AC;
|
|
|
|
r[21] = (~(r[12] - 0x20))+1;
|
|
r[6] = r[26] >> r[21];
|
|
if( t == 0x20 )
|
|
goto loc_8133219C;
|
|
|
|
r[26] = r[26] << r[12];
|
|
r[25] = r[25] + r[12];
|
|
goto loc_813321D0;
|
|
|
|
loc_8133219C:
|
|
|
|
r[26]= s32(*(unsigned int *)(r[4] + r[24]));
|
|
r[25]= 0;
|
|
r[24]= r[24] + 4;
|
|
goto loc_813321D0;
|
|
|
|
loc_813321AC:
|
|
|
|
r[0] = (~(r[12] - 0x20))+1;
|
|
r[6] = r[26] >> r[0];
|
|
r[26]= s32(*(unsigned int *)(r[4] + r[24]));
|
|
r[0] = (~(r[21] - 0x40))+1;
|
|
r[24]= r[24] + 4;
|
|
r[0] = r[26] >> r[0];
|
|
r[6] = r[6] | r[0];
|
|
r[25] = r[21] - 0x20;
|
|
r[26] = r[26] << r[25];
|
|
|
|
loc_813321D0:
|
|
|
|
r[12]= s16(*(unsigned short *)(r[31] - 2));
|
|
r[31] -= 2;
|
|
r[27]= r[27] - 1;
|
|
r[0] = r[12] & 0x8000;
|
|
r[12]= (r[12] & 0x1FFF) << 1;
|
|
if( r[0] == 0 )
|
|
goto loc_813321F8;
|
|
|
|
*(unsigned short *)(r[9]+r[12]) = s16(r[6]);
|
|
r[6] = (r[12] & 0x3FFF)>>1; // extrwi %r6, %r12, 14,17
|
|
if( r[27] != 0 )
|
|
goto loc_813321D0;
|
|
|
|
goto loc_81332204;
|
|
|
|
loc_813321F8:
|
|
|
|
*(unsigned short *)(r[8]+r[12]) = s16(r[6]);
|
|
r[23] = r[22];
|
|
goto loc_81332124;
|
|
|
|
loc_81332204:
|
|
|
|
r[23] = 0x800;
|
|
r[22] = 0x800;
|
|
|
|
loc_8133220C:
|
|
|
|
if( r[29] != 0x1F )
|
|
goto loc_81332228;
|
|
|
|
r[0] = r[30] >> 31;
|
|
r[30]= s32(*(unsigned int *)(r[4] + r[28]));
|
|
r[29]= 0;
|
|
r[28]= r[28] + 4;
|
|
goto loc_81332234;
|
|
|
|
loc_81332228:
|
|
|
|
r[0] = r[30] >> 31;
|
|
r[29]= r[29] + 1;
|
|
r[30]= r[30] << 1;
|
|
|
|
loc_81332234:
|
|
|
|
if( r[0] == 0 )
|
|
goto loc_8133225C;
|
|
|
|
r[0] = r[23] | 0x8000;
|
|
*(unsigned short *)(r[31]) = s16(r[0]);
|
|
r[0] = r[23] | 0x4000;
|
|
*(unsigned short *)(r[31]+2) = s16(r[0]);
|
|
|
|
r[31] = r[31] + 4;
|
|
r[27] = r[27] + 2;
|
|
r[23] = r[23] + 1;
|
|
r[22] = r[22] + 1;
|
|
|
|
goto loc_8133220C;
|
|
|
|
loc_8133225C:
|
|
|
|
r[12] = 0xB;
|
|
r[21] = r[29] + r[12];
|
|
t = r[21];
|
|
if( r[21] > 0x20 )
|
|
goto loc_81332294;
|
|
|
|
r[21] = (~(r[12] - 0x20))+1;
|
|
r[7] = r[30] >> r[21];
|
|
if( t == 0x20 )
|
|
goto loc_81332284;
|
|
|
|
r[30] = r[30] << r[12];
|
|
r[29] = r[29] + r[12];
|
|
goto loc_813322B8;
|
|
|
|
loc_81332284:
|
|
|
|
r[30]= s32(*(unsigned int *)(r[4] + r[28]));
|
|
r[29]= 0;
|
|
r[28]= r[28] + 4;
|
|
goto loc_813322B8;
|
|
|
|
loc_81332294:
|
|
|
|
r[0] = (~(r[12] - 0x20))+1;
|
|
r[7] = r[30] >> r[0];
|
|
r[30]= s32(*(unsigned int *)(r[4] + r[28]));
|
|
r[0] = (~(r[21] - 0x40))+1;
|
|
r[28]= r[28] + 4;
|
|
r[0] = r[30] >> r[0];
|
|
r[7] = r[7] | r[0];
|
|
r[29]= r[21] - 0x20;
|
|
r[30]= r[30] << r[29];
|
|
|
|
loc_813322B8:
|
|
|
|
r[12]= s16(*(unsigned short *)(r[31] - 2));
|
|
r[31] -= 2;
|
|
r[27]= r[27] - 1;
|
|
r[0] = r[12] & 0x8000;
|
|
r[12]= (r[12] & 0x1FFF) << 1;
|
|
if( r[0] == 0 )
|
|
goto loc_813322E0;
|
|
|
|
*(unsigned short *)(r[11]+r[12]) = s16(r[7]);
|
|
r[7] = (r[12] & 0x3FFF)>>1; // extrwi %r7, %r12, 14,17
|
|
if( r[27] != 0 )
|
|
goto loc_813322B8;
|
|
|
|
goto loc_813322EC;
|
|
|
|
loc_813322E0:
|
|
|
|
*(unsigned short *)(r[10]+r[12]) = s16(r[7]);
|
|
r[23] = r[22];
|
|
goto loc_8133220C;
|
|
|
|
loc_813322EC:
|
|
|
|
r[0] = r[5];
|
|
|
|
loc_813322F0:
|
|
|
|
r[12]= r[6];
|
|
|
|
loc_813322F4:
|
|
|
|
if( r[12] < 0x200 )
|
|
goto loc_8133233C;
|
|
|
|
if( r[25] != 0x1F )
|
|
goto loc_81332318;
|
|
|
|
r[31] = r[26] >> 31;
|
|
r[26] = s32(*(unsigned int *)(r[4] + r[24]));
|
|
r[24] = r[24] + 4;
|
|
r[25] = 0;
|
|
goto loc_81332324;
|
|
|
|
loc_81332318:
|
|
|
|
r[31] = r[26] >> 31;
|
|
r[25] = r[25] + 1;
|
|
r[26] = r[26] << 1;
|
|
|
|
loc_81332324:
|
|
|
|
r[27] = r[12] << 1;
|
|
if( r[31] != 0 )
|
|
goto loc_81332334;
|
|
|
|
r[12] = s16(*(unsigned short *)(r[8] + r[27]));
|
|
goto loc_813322F4;
|
|
|
|
loc_81332334:
|
|
|
|
r[12] = s16(*(unsigned short *)(r[9] + r[27]));
|
|
goto loc_813322F4;
|
|
|
|
loc_8133233C:
|
|
|
|
if( r[12] >= 0x100 )
|
|
goto loc_8133235C;
|
|
|
|
*(unsigned char *)(r[3]) = r[12];
|
|
r[3] = r[3] + 1;
|
|
r[5] = r[5] - 1;
|
|
if( r[5] != 0 )
|
|
goto loc_813322F0;
|
|
|
|
goto loc_81332434;
|
|
|
|
loc_8133235C:
|
|
|
|
r[23] = r[7];
|
|
|
|
loc_81332360:
|
|
|
|
if( r[23] < 0x800 )
|
|
goto loc_813323A8;
|
|
|
|
if( r[29] != 0x1F )
|
|
goto loc_81332384;
|
|
|
|
r[31] = r[30] >> 31;
|
|
r[30] = s32(*(unsigned int *)(r[4] + r[28]));
|
|
r[28] = r[28] + 4;
|
|
r[29] = 0;
|
|
goto loc_81332390;
|
|
|
|
loc_81332384:
|
|
|
|
r[31] = r[30] >> 31;
|
|
r[29] = r[29] + 1;
|
|
r[30] = r[30] << 1;
|
|
|
|
loc_81332390:
|
|
|
|
r[27] = r[23] << 1;
|
|
if( r[31] != 0 )
|
|
goto loc_813323A0;
|
|
|
|
r[23] = s16(*(unsigned short *)(r[10] + r[27]));
|
|
goto loc_81332360;
|
|
|
|
loc_813323A0:
|
|
|
|
r[23] = s16(*(unsigned short *)(r[11] + r[27]));
|
|
goto loc_81332360;
|
|
|
|
loc_813323A8:
|
|
|
|
r[12] = r[12] - 0xFD;
|
|
r[23] = ~r[23] + r[3] + 1;
|
|
r[5] = ~r[12] + r[5] + 1;
|
|
r[31] = r[12] >> 3;
|
|
|
|
if( r[31] == 0 )
|
|
goto loc_81332414;
|
|
|
|
count = r[31];
|
|
|
|
loc_813323C0:
|
|
|
|
r[31] = *(unsigned char *)(r[23] - 1);
|
|
*(unsigned char *)(r[3]) = r[31];
|
|
|
|
r[31] = *(unsigned char *)(r[23]);
|
|
*(unsigned char *)(r[3]+1) = r[31];
|
|
|
|
r[31] = *(unsigned char *)(r[23] + 1);
|
|
*(unsigned char *)(r[3]+2) = r[31];
|
|
|
|
r[31] = *(unsigned char *)(r[23] + 2);
|
|
*(unsigned char *)(r[3]+3) = r[31];
|
|
|
|
r[31] = *(unsigned char *)(r[23] + 3);
|
|
*(unsigned char *)(r[3]+4) = r[31];
|
|
|
|
r[31] = *(unsigned char *)(r[23] + 4);
|
|
*(unsigned char *)(r[3]+5) = r[31];
|
|
|
|
r[31] = *(unsigned char *)(r[23] + 5);
|
|
*(unsigned char *)(r[3]+6) = r[31];
|
|
|
|
r[31] = *(unsigned char *)(r[23] + 6);
|
|
*(unsigned char *)(r[3]+7) = r[31];
|
|
|
|
r[23] = r[23] + 8;
|
|
r[3] = r[3] + 8;
|
|
|
|
if( --count )
|
|
goto loc_813323C0;
|
|
|
|
r[12] = r[12] & 7;
|
|
if( r[12] == 0 )
|
|
goto loc_8133242C;
|
|
|
|
loc_81332414:
|
|
|
|
count = r[12];
|
|
|
|
loc_81332418:
|
|
|
|
r[31] = *(unsigned char *)(r[23] - 1);
|
|
r[23] = r[23] + 1;
|
|
*(unsigned char *)(r[3]) = r[31];
|
|
r[3] = r[3] + 1;
|
|
|
|
if( --count )
|
|
goto loc_81332418;
|
|
|
|
loc_8133242C:
|
|
|
|
if( r[5] != 0 )
|
|
goto loc_813322F0;
|
|
|
|
loc_81332434:
|
|
|
|
r[3] = r[0];
|
|
len = r[3];
|
|
|
|
//gprintf("Decompressed %d bytes\n", r[3]);
|
|
free( workingBuffer );
|
|
return buf1;
|
|
}
|