ShuriZma
/
melonDS
mirror of https://github.com/melonDS-emu/melonDS.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

add YUV conversion. lay base for cropping support.

This commit is contained in:
Arisotura 2022-04-17 00:29:18 +02:00
parent 7ad4f39587
commit 4c2c10abc6
1 changed files with 106 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

125
src/DSi_Camera.cpp
View File

@ -31,6 +31,8 @@ Camera* Camera1; // 7A / selfie cam
u16 ModuleCnt;
u16 Cnt;
u32 CropStart, CropEnd;
/*u8 FrameBuffer[640*480*4];
u32 FrameLength;
u32 TransferPos;*/
@ -71,6 +73,9 @@ void Reset()
ModuleCnt = 0; // CHECKME
Cnt = 0;
CropStart = 0;
CropEnd = 0;
/*memset(FrameBuffer, 0, 640*480*4);
TransferPos = 0;
FrameLength = 256*192*2;*/ // TODO: make it check frame size, data type, etc
@ -131,12 +136,53 @@ void TransferScanline(u32 line)
{
u32* dstbuf = &DataBuffer[BufferWritePos];
u32 maxlen = 1024 - BufferWritePos;
u32 datalen = CurCamera->TransferScanline(dstbuf, maxlen);
// TODO HERE:
// convert to RGB5 if needed
// crop if needed
// etc
u32 tmpbuf[1024];
u32 datalen = CurCamera->TransferScanline(tmpbuf, 1024);
// TODO: cropping
u32 copystart = 0;
u32 copylen = datalen;
if (copylen > maxlen) copylen = maxlen;
if (Cnt & (1<<13))
{
// convert to RGB
for (u32 i = 0; i < copylen; i++)
{
u32 val = tmpbuf[copystart + i];
int y1 = val & 0xFF;
int u = (val >> 8) & 0xFF;
int y2 = (val >> 16) & 0xFF;
int v = (val >> 24) & 0xFF;
int r1 = y1 + (((v-0x80) * 91881) >> 16);
int g1 = y1 - (((v-0x80) * 46793) >> 16) - (((u-0x80) * 22544) >> 16);
int b1 = y1 + (((u-0x80) * 116129) >> 16);
int r2 = y2 + (((v-0x80) * 91881) >> 16);
int g2 = y2 - (((v-0x80) * 46793) >> 16) - (((u-0x80) * 22544) >> 16);
int b2 = y2 + (((u-0x80) * 116129) >> 16);
#define CLAMP(v) if (v < 0) v = 0; else if (v > 255) v = 255;
CLAMP(r1); CLAMP(g1); CLAMP(b1);
CLAMP(r2); CLAMP(g2); CLAMP(b2);
#undef CLAMP
u32 col1 = (r1 >> 3) | ((g1 >> 3) << 5) | ((b1 >> 3) << 10) | 0x8000;
u32 col2 = (r2 >> 3) | ((g2 >> 3) << 5) | ((b2 >> 3) << 10) | 0x8000;
dstbuf[i] = col1 | (col2 << 16);
}
}
else
{
// return raw data
memcpy(dstbuf, &tmpbuf[copystart], copylen);
}
// data overrun
if (datalen > maxlen)
@ -204,6 +250,9 @@ u32 Read32(u32 addr)
return ret;
}
case 0x04004210: return CropStart;
case 0x04004214: return CropEnd;
}
printf("unknown DSi cam read32 %08X\n", addr);
@ -243,6 +292,9 @@ void Write16(u32 addr, u16 val)
case 0x04004202:
{
// TODO: during a transfer, clearing bit15 does not reflect immediately
// maybe it needs to finish the trasnfer or atleast the current block
// checkme
u16 oldmask;
if (Cnt & 0x8000)
@ -271,6 +323,23 @@ void Write16(u32 addr, u16 val)
}
}
return;
case 0x04004210:
if (Cnt & (1<<15)) return;
CropStart = (CropStart & 0x01FF0000) | (val & 0x03FE);
return;
case 0x04004212:
if (Cnt & (1<<15)) return;
CropStart = (CropStart & 0x03FE) | ((val & 0x01FF) << 16);
return;
case 0x04004214:
if (Cnt & (1<<15)) return;
CropEnd = (CropEnd & 0x01FF0000) | (val & 0x03FE);
return;
case 0x04004216:
if (Cnt & (1<<15)) return;
CropEnd = (CropEnd & 0x03FE) | ((val & 0x01FF) << 16);
return;
}
printf("unknown DSi cam write16 %08X %04X\n", addr, val);
@ -278,7 +347,17 @@ void Write16(u32 addr, u16 val)
void Write32(u32 addr, u32 val)
{
//
switch (addr)
{
case 0x04004210:
if (Cnt & (1<<15)) return;
CropStart = val & 0x01FF03FE;
return;
case 0x04004214:
if (Cnt & (1<<15)) return;
CropEnd = val & 0x01FF03FE;
return;
}
printf("unknown DSi cam write32 %08X %08X\n", addr, val);
}
@ -429,27 +508,35 @@ int Camera::TransferScanline(u32* buffer, int maxlen)
sx = ((dx*2 + 1) * 640) / FrameWidth;
u32 pixel2 = FrameBuffer[sy*640 + sx];
u32 r1 = (pixel1 >> 16) & 0xFF;
u32 g1 = (pixel1 >> 8) & 0xFF;
u32 b1 = pixel1 & 0xFF;
int r1 = (pixel1 >> 16) & 0xFF;
int g1 = (pixel1 >> 8) & 0xFF;
int b1 = pixel1 & 0xFF;
u32 r2 = (pixel1 >> 16) & 0xFF;
u32 g2 = (pixel1 >> 8) & 0xFF;
u32 b2 = pixel1 & 0xFF;
int r2 = (pixel2 >> 16) & 0xFF;
int g2 = (pixel2 >> 8) & 0xFF;
int b2 = pixel2 & 0xFF;
u32 y1 = ((r1 * 19595) + (g1 * 38470) + (b1 * 7471)) >> 16;
u32 u1 = ((b1 - y1) * 32244) >> 16;
u32 v1 = ((r1 - y1) * 57475) >> 16;
int y1 = ((r1 * 19595) + (g1 * 38470) + (b1 * 7471)) >> 16;
int u1 = ((b1 - y1) * 32244) >> 16;
int v1 = ((r1 - y1) * 57475) >> 16;
u32 y2 = ((r2 * 19595) + (g2 * 38470) + (b2 * 7471)) >> 16;
u32 u2 = ((b2 - y2) * 32244) >> 16;
u32 v2 = ((r2 - y2) * 57475) >> 16;
int y2 = ((r2 * 19595) + (g2 * 38470) + (b2 * 7471)) >> 16;
int u2 = ((b2 - y2) * 32244) >> 16;
int v2 = ((r2 - y2) * 57475) >> 16;
u1 += 128; v1 += 128;
u2 += 128; v2 += 128;
#define CLAMP(v) if (v < 0) v = 0; else if (v > 255) v = 255;
CLAMP(y1); CLAMP(u1); CLAMP(v1);
CLAMP(y2); CLAMP(u2); CLAMP(v2);
#undef CLAMP
// huh
u1 = (u1 + u2) >> 1;
v1 = (v1 + v2) >> 1;
buffer[dx] = y1 | (u1 << 8) | (y2 << 16) | (u1 << 24);
buffer[dx] = y1 | (u1 << 8) | (y2 << 16) | (v1 << 24);
}
TransferY++;