Redesigned main menu. Moved stuff from pixytest to a new helper file and to the new "photo mode"-screen.

common/app/pixy_helper.c

@@ -0,0 +1,140 @@
+#include "pixy_helper.h"
+#include "pixy.h"
+#include "tft.h"
+#include <stdlib.h>
+
+
+
+static int renderBA81(uint16_t xpos, uint16_t ypos, uint16_t width, uint16_t height, uint32_t frameLen, uint8_t *frame);
+
+
+int pixy_render_full_frame(uint16_t x, uint16_t y) {
+	return pixy_render_cropped_frame(x,y,0,0,320,200);
+}
+
+
+int pixy_render_cropped_frame(uint16_t x, uint16_t y, uint16_t xoffset, uint16_t yoffset, uint16_t width, uint16_t height) {
+	uint8_t* videodata;
+	int32_t response;
+	int32_t fourccc;
+	int8_t renderflags;
+	uint16_t xwidth;
+	uint16_t ywidth;
+	uint32_t size;
+
+
+	int return_value = pixy_command("cam_getFrame",  // String id for remote procedure
+								  INT8(0x21),     // mode
+								  INT16(xoffset),        // xoffset
+								  INT16(yoffset),         // yoffset
+								  INT16(width),       // width
+								  INT16(height),       // height
+								  END_OUT_ARGS,              // separator
+								  &response,      // pointer to mem address for return value
+								  &fourccc,
+								  &renderflags,
+								  &xwidth,
+								  &ywidth,
+								  &size,
+								  &videodata,        // pointer to mem address for returned frame
+								  END_IN_ARGS);
+
+	if(return_value==0) {
+		return_value = renderBA81(x,y,xwidth,ywidth,size,videodata);
+	}
+
+	return return_value;
+}
+
+
+
+
+static void interpolateBayer(uint16_t width, uint16_t x, uint16_t y, uint8_t *pixel, uint8_t* r, uint8_t* g, uint8_t* b)
+{
+    if (y&1)
+    {
+        if (x&1)
+        {
+            *r = *pixel;
+            *g = (*(pixel-1)+*(pixel+1)+*(pixel+width)+*(pixel-width))>>2;
+            *b = (*(pixel-width-1)+*(pixel-width+1)+*(pixel+width-1)+*(pixel+width+1))>>2;
+        }
+        else
+        {
+            *r = (*(pixel-1)+*(pixel+1))>>1;
+            *g = *pixel;
+            *b = (*(pixel-width)+*(pixel+width))>>1;
+        }
+    }
+    else
+    {
+        if (x&1)
+        {
+            *r = (*(pixel-width)+*(pixel+width))>>1;
+            *g = *pixel;
+            *b = (*(pixel-1)+*(pixel+1))>>1;
+        }
+        else
+        {
+            *r = (*(pixel-width-1)+*(pixel-width+1)+*(pixel+width-1)+*(pixel+width+1))>>2;
+            *g = (*(pixel-1)+*(pixel+1)+*(pixel+width)+*(pixel-width))>>2;
+            *b = *pixel;
+        }
+    }
+
+}
+
+
+
+
+
+
+static int renderBA81(uint16_t xpos, uint16_t ypos, uint16_t width, uint16_t height, uint32_t frameLen, uint8_t *frame)
+{
+    uint16_t x, y;
+    uint8_t r, g, b;
+
+
+    // skip first line
+    frame += width;
+
+    // don't render top and bottom rows, and left and rightmost columns because of color
+    // interpolation
+    //uint32_t decodedimage[(width-2)*(height-2)];
+    uint16_t* decodedimage = malloc(sizeof(uint16_t)*(width-2)*(height-2));
+
+    if(decodedimage==NULL) { //not enough free space to decode image in memory
+        //decode & render image pixel by pixel
+        uint16_t* line = decodedimage;
+        for (y=1; y<height-1; y++)
+        {
+                frame++;
+                for (x=1; x<width-1; x++, frame++)
+                {
+                    interpolateBayer(width, x, y, frame, &r, &g, &b);
+                    tft_draw_pixel(xpos+x-1,ypos+y-1,RGB(r,g,b));
+                }
+                frame++;
+         }
+    } else { //enough space
+            uint16_t* line = decodedimage;
+            for (y=1; y<height-1; y++)
+            {
+                //line = (unsigned int *)img.scanLine(y-1);
+                frame++;
+                for (x=1; x<width-1; x++, frame++)
+                {
+                    interpolateBayer(width, x, y, frame, &r, &g, &b);
+                    //*line++ = (0xff<<24) | (r<<16) | (g<<8) | (b<<0);
+                    *line++ = RGB(r,g,b);
+                }
+                frame++;
+            }
+
+            tft_draw_bitmap_unscaled(xpos,ypos,width-2,height-2,decodedimage);
+
+            free(decodedimage);
+    }
+
+    return 0;
+}