From ae0e3d6a882a9fee96ac2494056c41959b9e4ca3 Mon Sep 17 00:00:00 2001
From: Thuc Chi Do <thucchi.code@gmail.com>
Date: Mon, 11 Aug 2025 04:04:35 -0400
Subject: [PATCH] find pixel color

---
 image/source/main.c | 16 +++++++++++++---
 1 file changed, 13 insertions(+), 3 deletions(-)

diff --git a/image/source/main.c b/image/source/main.c
index ca37138..3a0268d 100644
--- a/image/source/main.c
+++ b/image/source/main.c
@@ -56,9 +56,8 @@ void writePictureToFramebufferRGB565(void *fb, void *img, u16 x, u16 y, u16 widt
 			uint8_t b = ((data >> 11) & 0x1F) << 3;
 			uint8_t g = ((data >> 5) & 0x3F) << 2;
 			uint8_t r = (data & 0x1F) << 3;
-			if ((j == 120) && (i == 200)) {
-				printf("\n-----RGB----- %08X %08X %08X\n", r, g, b);
-				printf("\n-----RGB2----- %u %u %u\n", r, g, b);
+			if ((j == 100) && (i == 170)) {
+				printf("\n---RGB--- %u %u %u\n", r, g, b);
 			} 
 			fb_8[v] = r;
 			fb_8[v+1] = g;
@@ -67,6 +66,15 @@ void writePictureToFramebufferRGB565(void *fb, void *img, u16 x, u16 y, u16 widt
 	}
 }
 
+void getColor(void *fb, int row, int col) {
+	u8 *fb_8 = (u8*) fb;
+	u32 v = ((HEIGHT - col) + (row*HEIGHT)) * 3;
+	uint8_t r = fb_8[v];
+	uint8_t g = fb_8[v+1];
+	uint8_t b = fb_8[v+2];
+	printf("\n---RGB2---%u %u %u\n", r, g, b);
+}
+
 // TODO: Figure out how to use CAMU_GetStereoCameraCalibrationData
 void takePicture3D(u8 *buf) {
 	u32 bufSize;
@@ -179,6 +187,8 @@ int main() {
 			writePictureToFramebufferRGB565(gfxGetFramebuffer(GFX_TOP, GFX_LEFT, NULL, NULL), buf, 0, 0, WIDTH, HEIGHT);
 		}
 
+		getColor(gfxGetFramebuffer(GFX_TOP, GFX_LEFT, NULL, NULL), 170, 100);
+
 		// Flush and swap framebuffers
 		gfxFlushBuffers();
 		gspWaitForVBlank();