52 lines
1.7 KiB
C++
52 lines
1.7 KiB
C++
#include "bmp.hpp"
|
|
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
#include <3ds.h>
|
|
extern "C"
|
|
{
|
|
#include "fs.h"
|
|
}
|
|
|
|
void BMP::PutPixel565(u8* dst, u8 x, u8 y, u16 v){
|
|
dst[(x+(47-y)*48)*3+0]=(v&0x1F)<<3;
|
|
dst[(x+(47-y)*48)*3+1]=((v>>5)&0x3F)<<2;
|
|
dst[(x+(47-y)*48)*3+2]=((v>>11)&0x1F)<<3;
|
|
}
|
|
|
|
void BMP::Save(std::string path, BMP::Bitmap *bitmap)
|
|
{
|
|
//Handle fileHandle;
|
|
FS_OpenArchive(&sdmc_archive, ARCHIVE_SDMC);
|
|
|
|
|
|
u32 bytesWritten;
|
|
u8 moltiplier = bitmap->bitperpixel >> 3;
|
|
u8* tempbuf = (u8*)malloc(0x36+(bitmap->width)*(bitmap->height)*moltiplier);
|
|
memset(tempbuf, 0, 0x36+(bitmap->width)*(bitmap->height)*moltiplier);
|
|
tempbuf[0x36+(bitmap->width)*(bitmap->height)*moltiplier]=0;
|
|
//FS_CreateFile(sdmc_archive, path.c_str(), (u16)(0x36+(bitmap->width)*(bitmap->height)*moltiplier))
|
|
//Result ret = FS_OpenFile(fileHandle, sdmc_archive, path.c_str(), (FS_OPEN_READ | FS_OPEN_WRITE), 0);
|
|
//if(ret) printf("error");
|
|
*(u16*)&tempbuf[0x0] = 0x4D42;
|
|
*(u32*)&tempbuf[0x2] = 0x36 + (bitmap->width)*(bitmap->height)*moltiplier;
|
|
*(u32*)&tempbuf[0xA] = 0x36;
|
|
*(u32*)&tempbuf[0xE] = 0x28;
|
|
*(u32*)&tempbuf[0x12] = bitmap->width;
|
|
*(u32*)&tempbuf[0x16] = bitmap->height;
|
|
if (moltiplier == 3) *(u32*)&tempbuf[0x1A] = 0x00180001;
|
|
else *(u32*)&tempbuf[0x1A] = 0x00200001;
|
|
*(u32*)&tempbuf[0x22] = (bitmap->width)*(bitmap->height)*moltiplier;
|
|
int i=0;
|
|
while (i<((bitmap->width)*(bitmap->height)*moltiplier)){
|
|
tempbuf[0x36+i] = bitmap->pixels[i];
|
|
i++;
|
|
}
|
|
//FSFILE_Write(fileHandle, &bytesWritten, 0, (u32*)tempbuf, 0x36 + (bitmap->width)*(bitmap->height)*moltiplier, 0x10001);
|
|
FS_Write(sdmc_archive, path.c_str(), (u32*)tempbuf, 0x36 + (bitmap->width)*(bitmap->height)*moltiplier);
|
|
|
|
free(tempbuf);
|
|
FS_CloseArchive(sdmc_archive);
|
|
} |