Add screenshot feature

source/tegraexplorer/utils/utils.c

@@ -6,12 +6,15 @@
 #include "../../mem/heap.h"
 #include "../gfx/gfxutils.h"
 #include "../../hid/hid.h"
-/*
 #include "../../utils/util.h"
 #include "../../utils/sprintf.h"
 #include "../../libs/fatfs/ff.h"
 #include "../fs/fsutils.h"
-*/
+#include "../../mem/minerva.h"
+#include "../../storage/nx_sd.h"
+#include "../../gfx/di.h"
+
+extern bool sd_mounted;
 
 int utils_mmcMenu(){
     if (emu_cfg.enabled)
@@ -26,18 +29,66 @@ void utils_copystring(const char *in, char **out){
     strcpy(*out, in);
 }
 
-/*
+
 void utils_takeScreenshot(){
+    static u32 timer = 0;
+
+    if (!minerva_cfg || !sd_mounted)
+		return;
+
+    if (timer + 3 < get_tmr_s())
+        timer = get_tmr_s();
+    else 
+        return;
+
     char *name, *path;
     char basepath[] = "sd:/tegraexplorer/screenshots";
-    name = malloc(35);
-    sprintf(name, "Screenshot_%d", get_tmr_s());
+    name = malloc(40);
+    sprintf(name, "Screenshot_%08X.bmp", get_tmr_us());
 
     f_mkdir("sd:/tegraexplorer");
     f_mkdir(basepath);
     path = fsutil_getnextloc(basepath, name);
+    free(name);
+
+    const u32 file_size = 0x384000 + 0x36;
+    u8 *bitmap = malloc(file_size);
+    u32 *fb = malloc(0x384000);
+    u32 *fb_ptr = gfx_ctxt.fb;
+
+    for (int x = 1279; x >= 0; x--)
+	{
+		for (int y = 719; y >= 0; y--)
+			fb[y * 1280 + x] = *fb_ptr++;
+	}
+
+    memcpy(bitmap + 0x36, fb, 0x384000);
+    bmp_t *bmp = (bmp_t *)bitmap;
+
+	bmp->magic    = 0x4D42;
+	bmp->size     = file_size;
+	bmp->rsvd     = 0;
+	bmp->data_off = 0x36;
+	bmp->hdr_size = 40;
+	bmp->width    = 1280;
+	bmp->height   = 720;
+	bmp->planes   = 1;
+	bmp->pxl_bits = 32;
+	bmp->comp     = 0;
+	bmp->img_size = 0x384000;
+	bmp->res_h    = 2834;
+	bmp->res_v    = 2834;
+	bmp->rsvd2    = 0;
+
+    sd_save_to_file(bitmap, file_size, path);
+    free(bitmap);
+    free(fb);
+
+    display_backlight_brightness(255, 1000);
+	msleep(100);
+	display_backlight_brightness(100, 1000);
 }
-*/
+
 
 char *utils_InputText(char *start, int maxLen){
     if (!hidConnected())